mirror of
https://github.com/isfshax/isfshax.git
synced 2024-09-09 17:13:18 +02:00
79 lines
2.1 KiB
C
79 lines
2.1 KiB
C
#ifdef LOLSERIAL_DEBUG
|
|
|
|
#include "lolserial.h"
|
|
#include "gpio.h"
|
|
#include "utils.h"
|
|
#include "latte.h"
|
|
#include <sys/iosupport.h>
|
|
#include <string.h>
|
|
|
|
#define LOLSERIAL_WAIT_TICKS 200
|
|
|
|
static int enable = 1;
|
|
static char suspend_buf[4096];
|
|
static int suspend_len = 0;
|
|
|
|
/* lolserial string output, now not in assembly... */
|
|
static void lolserial_lprint(const char *str, int len)
|
|
{
|
|
/* setup output pin */
|
|
clear32(LT_GPIO_OWNER, GP_SENSORBAR);
|
|
set32(LT_GPIO_ENABLE, GP_SENSORBAR);
|
|
set32(LT_GPIO_DIR, GP_SENSORBAR);
|
|
set32(LT_GPIO_OUT, GP_SENSORBAR);
|
|
|
|
/* loop until null terminator or string end */
|
|
for (const char *end = str + len; *str && (str != end); str++) {
|
|
for (u32 bits = 0x200 | (*str << 1); bits; bits >>= 1) {
|
|
/* set bit value */
|
|
mask32(LT_GPIO_OUT, GP_SENSORBAR, (bits & 1) ? GP_SENSORBAR : 0);
|
|
|
|
/* wait ticks for bit */
|
|
u32 now = read32(LT_TIMER), then = now + LOLSERIAL_WAIT_TICKS;
|
|
for (; then < now; now = read32(LT_TIMER)); /* wait overflow */
|
|
for (; now < then; now = read32(LT_TIMER)); /* wait */
|
|
}
|
|
}
|
|
}
|
|
|
|
/* lolserial is slow, for timing critical tasks it might change
|
|
* the outcome; as a workaround, output can be suspended and
|
|
* printed out at a later point in time */
|
|
void lolserial_suspend(void)
|
|
{
|
|
memset(suspend_buf, 0, sizeof(suspend_buf));
|
|
suspend_len = 0;
|
|
enable = 0;
|
|
}
|
|
|
|
void lolserial_resume(void)
|
|
{
|
|
enable = 1;
|
|
lolserial_lprint(suspend_buf, suspend_len);
|
|
}
|
|
|
|
/* devoptab output function */
|
|
static ssize_t lolserial_write(struct _reent *r, void *fd, const char *ptr, size_t len)
|
|
{
|
|
if (enable) {
|
|
lolserial_lprint(ptr, len);
|
|
} else {
|
|
for(size_t i = 0; (i < len) && (suspend_len < sizeof(suspend_buf)); i++)
|
|
suspend_buf[suspend_len++] = ptr[i];
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
/* register lolserial devoptab */
|
|
void lolserial_init() {
|
|
static devoptab_t lolserial_dotab = {
|
|
.name = "lolserial",
|
|
.write_r = &lolserial_write,
|
|
};
|
|
devoptab_list[STD_OUT] = &lolserial_dotab;
|
|
devoptab_list[STD_ERR] = &lolserial_dotab;
|
|
}
|
|
|
|
#endif /* LOLSERIAL_DEBUG */
|