94 lines
1.8 KiB
C
94 lines
1.8 KiB
C
#include <vx_print.h>
|
|
#include <vx_spawn.h>
|
|
#include <vx_intrinsics.h>
|
|
#include <stdlib.h>
|
|
#include <stdbool.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <math.h>
|
|
#include "tinyprintf.h"
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
typedef struct {
|
|
const char* format;
|
|
va_list* va;
|
|
int ret;
|
|
} printf_arg_t;
|
|
|
|
typedef struct {
|
|
int value;
|
|
int base;
|
|
} putint_arg_t;
|
|
|
|
typedef struct {
|
|
float value;
|
|
int precision;
|
|
} putfloat_arg_t;
|
|
|
|
static void __putint_cb(const putint_arg_t* arg) {
|
|
char tmp[33];
|
|
float value = arg->value;
|
|
int base = arg->base;
|
|
itoa(value, tmp, base);
|
|
for (int i = 0; i < 33; ++i) {
|
|
int c = tmp[i];
|
|
if (!c)
|
|
break;
|
|
vx_putchar(c);
|
|
}
|
|
}
|
|
|
|
static void __putfloat_cb(const putfloat_arg_t* arg) {
|
|
float value = arg->value;
|
|
int precision = arg->precision;
|
|
int ipart = (int)value;
|
|
vx_putint(ipart, 10);
|
|
if (precision != 0) {
|
|
vx_putchar('.');
|
|
float frac = value - (float)ipart;
|
|
float fscaled = frac * pow(10, precision);
|
|
vx_putint((int)fscaled, 10);
|
|
}
|
|
}
|
|
|
|
static void __vprintf_cb(printf_arg_t* arg) {
|
|
arg->ret = tiny_vprintf(arg->format, *arg->va);
|
|
}
|
|
|
|
void vx_putint(int value, int base) {
|
|
putint_arg_t arg;
|
|
arg.value = value;
|
|
arg.base = base;
|
|
vx_serial((vx_serial_cb)__putint_cb, &arg);
|
|
}
|
|
|
|
void vx_putfloat(float value, int precision) {
|
|
putfloat_arg_t arg;
|
|
arg.value = value;
|
|
arg.precision = precision;
|
|
vx_serial((vx_serial_cb)__putfloat_cb, &arg);
|
|
}
|
|
|
|
int vx_vprintf(const char* format, va_list va) {
|
|
printf_arg_t arg;
|
|
arg.format = format;
|
|
arg.va = &va;
|
|
vx_serial((vx_serial_cb)__vprintf_cb, &arg);
|
|
return arg.ret;
|
|
}
|
|
|
|
int vx_printf(const char * format, ...) {
|
|
int ret;
|
|
va_list va;
|
|
va_start(va, format);
|
|
ret = vx_vprintf(format, va);
|
|
va_end(va);
|
|
return ret;
|
|
}
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif |