cleaner main, random nums, perfect script run
Clyne Sullivan
7 years ago
parent
9f61013faf
commit
4614429f57
@ -0,0 +1,9 @@
|
||||
#ifndef RANDOM_H_
|
||||
#define RANDOM_H_
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
void random_init(void);
|
||||
uint32_t random_get(void);
|
||||
|
||||
#endif // RANDOM_H_
|
||||
@ -0,0 +1,8 @@
|
||||
#ifndef SCRIPT_H_
|
||||
#define SCRIPT_H_
|
||||
|
||||
#include <parser.h>
|
||||
|
||||
void script_loadlib(interpreter *it);
|
||||
|
||||
#endif // SCRIPT_H_
|
||||
@ -0,0 +1,8 @@
|
||||
#ifndef STDLIB_H_
|
||||
#define STDLIB_H_
|
||||
|
||||
char *snprintf(char *buf, unsigned int max, const char *format, ...);
|
||||
float strtof(const char *s, char **endptr);
|
||||
int atoi(const char *s);
|
||||
|
||||
#endif // STDLIB_H_
|
||||
Binary file not shown.
@ -1,7 +1,4 @@
|
||||
#!/bin/bash
|
||||
|
||||
#openocd -f /usr/share/openocd/scripts/board/st_nucleo_l476rg.cfg \
|
||||
# -c "init; reset halt; flash write_image erase main.hex; reset run; exit"
|
||||
|
||||
openocd -f /usr/share/openocd/scripts/board/st_nucleo_l476rg.cfg > /dev/null &
|
||||
gdb-multiarch -iex "target remote localhost:3333" out/main.elf
|
||||
|
||||
@ -1,203 +0,0 @@
|
||||
#include <stm32l476xx.h>
|
||||
#include <clock.h>
|
||||
#include <heap.h>
|
||||
#include <task.h>
|
||||
#include <gpio.h>
|
||||
#include <lcd.h>
|
||||
#include <display.h>
|
||||
#include <display_draw.h>
|
||||
#include <initrd.h>
|
||||
#include <serial.h>
|
||||
#include <parser.h>
|
||||
#include <stack.h>
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
void kmain(void);
|
||||
void task_interpreter(void);
|
||||
|
||||
int main(void)
|
||||
{
|
||||
asm("cpsid i");
|
||||
|
||||
// prepare flash latency for 40MHz operation
|
||||
FLASH->ACR &= ~(FLASH_ACR_LATENCY);
|
||||
FLASH->ACR |= FLASH_ACR_LATENCY_4WS;
|
||||
|
||||
//MPU->CTRL |= MPU_CTRL_ENABLE_Msk | MPU_CTRL_PRIVDEFENA_Msk;
|
||||
clock_init();
|
||||
gpio_init();
|
||||
|
||||
gpio_mode(GPIOA, 5, OUTPUT);
|
||||
|
||||
serial_init();
|
||||
|
||||
// enable FPU
|
||||
SCB->CPACR |= (0xF << 20);
|
||||
|
||||
task_init(kmain);
|
||||
|
||||
while (1);
|
||||
}
|
||||
|
||||
int script_puts(interpreter *it)
|
||||
{
|
||||
char *s = igetarg_string(it, 0);
|
||||
dsp_puts(s);
|
||||
//dsp_puts("\n");
|
||||
//asm("mov r0, %0; svc 2" :: "r" (s));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_gets(interpreter *it)
|
||||
{
|
||||
char *s = malloc(64), c[2] = {0, 0};
|
||||
uint16_t index = 0;
|
||||
|
||||
do {
|
||||
c[0] = serial_get();
|
||||
s[index] = c[0];
|
||||
if (c[0] != '\r')
|
||||
dsp_puts(c);
|
||||
} while (s[index] != '\r' && index++ < 23);
|
||||
s[index] = '\0';
|
||||
|
||||
variable *v = igetarg(it, 0);
|
||||
v->valtype = STRING;
|
||||
v->svalue = s;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_delay(interpreter *it)
|
||||
{
|
||||
int ms = igetarg_integer(it, 0);
|
||||
delay(ms);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_rect(interpreter *it)
|
||||
{
|
||||
dsp_rect(igetarg_integer(it, 0), igetarg_integer(it, 1),
|
||||
igetarg_integer(it, 2), igetarg_integer(it, 3),
|
||||
igetarg_integer(it, 4));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_line(interpreter *it)
|
||||
{
|
||||
dsp_line(igetarg_integer(it, 0), igetarg_integer(it, 1),
|
||||
igetarg_integer(it, 2), igetarg_integer(it, 3),
|
||||
igetarg_integer(it, 4));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_ppos(interpreter *it)
|
||||
{
|
||||
dsp_cpos(0, 0);
|
||||
dsp_coff(igetarg_integer(it, 0), igetarg_integer(it, 1));
|
||||
return 0;
|
||||
}
|
||||
|
||||
void task_interpreter(void)
|
||||
{
|
||||
interpreter it;
|
||||
iinit(&it);
|
||||
inew_cfunc(&it, "print", script_puts);
|
||||
inew_cfunc(&it, "gets", script_gets);
|
||||
inew_cfunc(&it, "delay", script_delay);
|
||||
inew_cfunc(&it, "rect", script_rect);
|
||||
inew_cfunc(&it, "ppos", script_ppos);
|
||||
inew_cfunc(&it, "line", script_line);
|
||||
|
||||
/*int ret = 0;
|
||||
char *linebuf = malloc(100), c[2] = {0, 0};
|
||||
while (1) {
|
||||
uint16_t index = 0;
|
||||
if (it.indent > 0)
|
||||
dsp_puts(">");
|
||||
dsp_puts("> ");
|
||||
do {
|
||||
c[0] = serial_get();
|
||||
if (c[0] >= ' ' || c[0] == '\r') {
|
||||
linebuf[index] = c[0];
|
||||
if (c[0] >= ' ')
|
||||
dsp_puts(c);
|
||||
}
|
||||
} while (linebuf[index] != '\r' && index++ < 100);
|
||||
linebuf[index] = '\0';
|
||||
dsp_puts("\n");
|
||||
ret = idoline(&it, linebuf);
|
||||
if (ret < 0)
|
||||
break;
|
||||
}*/
|
||||
|
||||
char *s = initrd_getfile("init");
|
||||
if (s == 0)
|
||||
goto end;
|
||||
|
||||
char *linebuf = (char *)malloc(120);
|
||||
uint32_t i = 0, prev = 0, lc;
|
||||
uint32_t size = initrd_getfilesize("init");
|
||||
int ret;
|
||||
while (i < size) {
|
||||
for (; s[i] != '\n' && s[i] != '\0'; i++);
|
||||
lc = i - prev;
|
||||
if (lc == 0) {
|
||||
prev = ++i;
|
||||
continue;
|
||||
}
|
||||
strncpy(linebuf, s + prev, lc + 1);
|
||||
linebuf[lc] = '\0';
|
||||
ret = idoline(&it, linebuf);
|
||||
if (ret < 0)
|
||||
break;
|
||||
prev = ++i;
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
dsp_puts("\nError: ");
|
||||
dsp_puts(itoa(ret, linebuf, 10));
|
||||
}
|
||||
free(linebuf);
|
||||
//iend(&it); // nah
|
||||
|
||||
end:
|
||||
while (1)
|
||||
delay(10);
|
||||
}
|
||||
|
||||
void kmain(void)
|
||||
{
|
||||
asm("cpsie i");
|
||||
|
||||
dsp_init();
|
||||
|
||||
//dsp_rect(0, 0, 40, 40, dsp_color(0x7F, 0, 0x7F));
|
||||
|
||||
//dsp_set_addr_read(0, 0, 39, 39);
|
||||
//dsp_dmode(INPUT);
|
||||
//uint8_t *buf = (uint8_t *)malloc(40 * 40 * 2);
|
||||
//for (int i = 0; i < 180; i++)
|
||||
// buf[i] = dsp_read_data();
|
||||
//dsp_dmode(OUTPUT);
|
||||
//dsp_set_addr(40, 40, 79, 79);
|
||||
//for (int i = 0; i < 320; i++)
|
||||
// dsp_write_data(buf[i]);
|
||||
//dsp_rect(80, 80, 40, 40, dsp_color(0x7F, 0x7F, 0));
|
||||
|
||||
dsp_rect(0, 0, LCD_WIDTH, LCD_HEIGHT, dsp_color(0, 0, 0));
|
||||
dsp_cursoron();
|
||||
|
||||
task_start(task_interpreter, 4096);
|
||||
|
||||
//char *s = initrd_getfile("test.txt");
|
||||
|
||||
while (1) {
|
||||
gpio_dout(GPIOA, 5, 1);
|
||||
delay(500);
|
||||
gpio_dout(GPIOA, 5, 0);
|
||||
delay(500);
|
||||
}
|
||||
}
|
||||
|
||||
@ -0,0 +1,24 @@
|
||||
#include <random.h>
|
||||
|
||||
#include <stm32l476xx.h>
|
||||
#include <clock.h>
|
||||
|
||||
void random_init(void)
|
||||
{
|
||||
// setup and enable RNG clock
|
||||
RCC->CCIPR &= ~(RCC_CCIPR_CLK48SEL);
|
||||
RCC->CCIPR |= RCC_CCIPR_CLK48SEL_1;
|
||||
RCC->AHB2ENR |= RCC_AHB2ENR_RNGEN;
|
||||
RNG->CR |= RNG_CR_RNGEN;
|
||||
}
|
||||
|
||||
uint32_t random_get(void)
|
||||
{
|
||||
if (RNG->SR & (RNG_SR_SEIS | RNG_SR_CEIS))
|
||||
return 0;
|
||||
|
||||
while (!(RNG->SR & RNG_SR_DRDY))
|
||||
delay(1);
|
||||
|
||||
return RNG->DR;
|
||||
}
|
||||
@ -0,0 +1,120 @@
|
||||
#include <script.h>
|
||||
|
||||
#include <builtins.h>
|
||||
#include <clock.h>
|
||||
#include <display.h>
|
||||
#include <display_draw.h>
|
||||
#include <heap.h>
|
||||
#include <random.h>
|
||||
#include <serial.h>
|
||||
#include <stack.h>
|
||||
|
||||
int script_puts(interpreter *it);
|
||||
int script_gets(interpreter *it);
|
||||
int script_delay(interpreter *it);
|
||||
int script_rect(interpreter *it);
|
||||
int script_ppos(interpreter *it);
|
||||
int script_line(interpreter *it);
|
||||
int script_color(interpreter *it);
|
||||
int script_rand(interpreter *it);
|
||||
|
||||
void script_loadlib(interpreter *it)
|
||||
{
|
||||
inew_cfunc(it, "print", script_puts);
|
||||
inew_cfunc(it, "gets", script_gets);
|
||||
inew_cfunc(it, "delay", script_delay);
|
||||
inew_cfunc(it, "rect", script_rect);
|
||||
inew_cfunc(it, "ppos", script_ppos);
|
||||
inew_cfunc(it, "line", script_line);
|
||||
inew_cfunc(it, "color", script_color);
|
||||
inew_cfunc(it, "rand", script_rand);
|
||||
}
|
||||
|
||||
int script_puts(interpreter *it)
|
||||
{
|
||||
char *s = igetarg_string(it, 0);
|
||||
dsp_puts(s);
|
||||
//dsp_puts("\n");
|
||||
//asm("mov r0, %0; svc 2" :: "r" (s));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_gets(interpreter *it)
|
||||
{
|
||||
char *s = malloc(64), c[2] = {0, 0};
|
||||
uint16_t index = 0;
|
||||
|
||||
do {
|
||||
c[0] = serial_get();
|
||||
s[index] = c[0];
|
||||
if (c[0] != '\r')
|
||||
dsp_puts(c);
|
||||
} while (s[index] != '\r' && index++ < 23);
|
||||
s[index] = '\0';
|
||||
|
||||
variable *v = igetarg(it, 0);
|
||||
v->valtype = STRING;
|
||||
v->svalue = s;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_delay(interpreter *it)
|
||||
{
|
||||
int ms = igetarg_integer(it, 0);
|
||||
delay(ms);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_rect(interpreter *it)
|
||||
{
|
||||
dsp_rect(igetarg_integer(it, 0), igetarg_integer(it, 1),
|
||||
igetarg_integer(it, 2), igetarg_integer(it, 3),
|
||||
igetarg_integer(it, 4));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_line(interpreter *it)
|
||||
{
|
||||
int x = igetarg_integer(it, 0);
|
||||
int y = igetarg_integer(it, 1);
|
||||
int i = igetarg_integer(it, 2);
|
||||
int j = igetarg_integer(it, 3);
|
||||
int c = igetarg_integer(it, 4);
|
||||
dsp_line(x, y, i, j, c);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_ppos(interpreter *it)
|
||||
{
|
||||
dsp_cpos(0, 0);
|
||||
dsp_coff(igetarg_integer(it, 0), igetarg_integer(it, 1));
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_color(interpreter *it)
|
||||
{
|
||||
uint16_t c = dsp_color(igetarg_integer(it, 0), igetarg_integer(it, 1),
|
||||
igetarg_integer(it, 2));
|
||||
variable v;
|
||||
v.valtype = INTEGER;
|
||||
INT(&v) = c;
|
||||
v.svalue = 0;
|
||||
isetstr(&v);
|
||||
iret(it, &v);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int script_rand(interpreter *it)
|
||||
{
|
||||
variable *v = (variable *)malloc(sizeof(variable));
|
||||
unsigned int mod = igetarg_integer(it, 0);
|
||||
unsigned int val = random_get();
|
||||
v->valtype = INTEGER;
|
||||
INT(v) = val % mod;
|
||||
v->svalue = 0;
|
||||
isetstr(v);
|
||||
iret(it, v);
|
||||
free(v->svalue);
|
||||
free(v);
|
||||
return 0;
|
||||
}
|
||||
@ -1,6 +1,80 @@
|
||||
#include <stdlib.h>
|
||||
|
||||
#include <ctype.h>
|
||||
#include <stdarg.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
extern char *itoa(int, char *, int);
|
||||
|
||||
void _exit(int code)
|
||||
{
|
||||
(void)code;
|
||||
for (;;);
|
||||
}
|
||||
|
||||
char *snprintf(char *buf, unsigned int max, const char *format, ...)
|
||||
{
|
||||
va_list args;
|
||||
va_start(args, format);
|
||||
|
||||
if (buf == 0 || max == 0)
|
||||
return 0;
|
||||
|
||||
static char nbuf[32];
|
||||
unsigned int off = 0;
|
||||
for (unsigned int i = 0; format[i] != '\0' && off < max; i++) {
|
||||
if (format[i] == '%') {
|
||||
i++;
|
||||
nbuf[0] = '\0';
|
||||
switch (format[i]) {
|
||||
case 'd':
|
||||
itoa(va_arg(args, int), nbuf, 10);
|
||||
break;
|
||||
case 'u':
|
||||
itoa(va_arg(args, unsigned int), nbuf, 10);
|
||||
break;
|
||||
case 'x':
|
||||
case 'p':
|
||||
itoa(va_arg(args, unsigned int), nbuf, 16);
|
||||
break;
|
||||
case 'f':
|
||||
itoa((int)va_arg(args, double), nbuf, 10);
|
||||
break;
|
||||
default:
|
||||
buf[off++] = format[i];
|
||||
nbuf[0] = '\0';
|
||||
break;
|
||||
}
|
||||
if (nbuf[0] != '\0') {
|
||||
for (unsigned int j = 0; off < max &&
|
||||
nbuf[j] != '\0'; off++, j++)
|
||||
buf[off] = nbuf[j];
|
||||
}
|
||||
} else {
|
||||
buf[off++] = format[i];
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
buf[off >= max ? max - 1 : off] = '\0';
|
||||
va_end(args);
|
||||
return buf;
|
||||
}
|
||||
|
||||
float strtof(const char *s, char **endptr)
|
||||
{
|
||||
(void)s;
|
||||
(void)endptr;
|
||||
return 0.0f;
|
||||
}
|
||||
|
||||
int atoi(const char *s)
|
||||
{
|
||||
int n = 0;
|
||||
for (unsigned int i = 0; isdigit(s[i]); i++) {
|
||||
n *= 10;
|
||||
n += s[i] - '0';
|
||||
}
|
||||
return n;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue