main.c 14.3 KB
Newer Older
Damien's avatar
Damien committed
1
2
#include <stm32f4xx.h>
#include <stm32f4xx_rcc.h>
3
4
#include <stm32f4xx_gpio.h>
#include <stm_misc.h>
Damien's avatar
Damien committed
5
6
#include "std.h"

7
#include "misc.h"
8
#include "systick.h"
9
#include "led.h"
10
#include "lcd.h"
11
#include "storage.h"
12
#include "mma.h"
Damien's avatar
Damien committed
13
#include "usb.h"
Damien's avatar
Damien committed
14

15
static void impl02_c_version() {
Damien's avatar
Damien committed
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
    int x = 0;
    while (x < 400) {
        int y = 0;
        while (y < 400) {
            volatile int z = 0;
            while (z < 400) {
                z = z + 1;
            }
            y = y + 1;
        }
        x = x + 1;
    }
}

#define PYB_USRSW_PORT (GPIOA)
31
#define PYB_USRSW_PIN (GPIO_Pin_13)
Damien's avatar
Damien committed
32
33
34

void sw_init() {
    // make it an input with pull-up
35
36
37
38
39
    GPIO_InitTypeDef GPIO_InitStructure;
    GPIO_InitStructure.GPIO_Pin = PYB_USRSW_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN;
    GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
    GPIO_Init(PYB_USRSW_PORT, &GPIO_InitStructure);
Damien's avatar
Damien committed
40
41
42
}

int sw_get() {
43
    if (PYB_USRSW_PORT->IDR & PYB_USRSW_PIN) {
Damien's avatar
Damien committed
44
45
46
47
48
49
50
51
52
53
54
55
56
        // pulled high, so switch is not pressed
        return 0;
    } else {
        // pulled low, so switch is pressed
        return 1;
    }
}

void __fatal_error(const char *msg) {
    lcd_print_strn("\nFATAL ERROR:\n", 14);
    lcd_print_strn(msg, strlen(msg));

    for (;;) {
57
58
        led_state(PYB_LED_R1, 1);
        led_state(PYB_LED_R2, 0);
59
        sys_tick_delay_ms(150);
60
61
        led_state(PYB_LED_R1, 0);
        led_state(PYB_LED_R2, 1);
62
        sys_tick_delay_ms(150);
Damien's avatar
Damien committed
63
64
65
66
67
68
69
70
71
72
73
    }
}

#include "misc.h"
#include "lexer.h"
#include "mpyconfig.h"
#include "parse.h"
#include "compile.h"
#include "runtime.h"

py_obj_t pyb_delay(py_obj_t count) {
74
    sys_tick_delay_ms(rt_get_int(count));
Damien's avatar
Damien committed
75
76
77
78
    return py_const_none;
}

py_obj_t pyb_led(py_obj_t state) {
79
    led_state(PYB_LED_G1, rt_is_true(state));
Damien's avatar
Damien committed
80
81
82
83
84
85
86
87
88
89
90
91
92
93
    return state;
}

py_obj_t pyb_sw() {
    if (sw_get()) {
        return py_const_true;
    } else {
        return py_const_false;
    }
}

#include "ff.h"
FATFS fatfs0;

94
#include "nlr.h"
95
96

/*
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
void g(uint i) {
    printf("g:%d\n", i);
    if (i & 1) {
        nlr_jump((void*)(42 + i));
    }
}
void f() {
    nlr_buf_t nlr;
    int i;
    for (i = 0; i < 4; i++) {
        printf("f:loop:%d:%p\n", i, &nlr);
        if (nlr_push(&nlr) == 0) {
            // normal
            //printf("a:%p:%p %p %p %u\n", &nlr, nlr.ip, nlr.sp, nlr.prev, nlr.ret_val);
            g(i);
            printf("f:lp:%d:nrm\n", i);
            nlr_pop();
        } else {
            // nlr
            //printf("b:%p:%p %p %p %u\n", &nlr, nlr.ip, nlr.sp, nlr.prev, nlr.ret_val);
            printf("f:lp:%d:nlr:%d\n", i, (int)nlr.ret_val);
        }
    }
}
void nlr_test() {
    f(1);
}
124
125
*/

126
127
128
129
130
131
132
void fatality() {
    led_state(PYB_LED_R1, 1);
    led_state(PYB_LED_G1, 1);
    led_state(PYB_LED_R2, 1);
    led_state(PYB_LED_G2, 1);
}

133
static const char fresh_boot_py[] =
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
"# boot.py -- run on boot-up\n"
"# can run arbitrary Python, but best to keep it minimal\n"
"\n"
"pyb.source_dir('/src')\n"
"pyb.main('main.py')\n"
"#pyb.usb_usr('VCP')\n"
"#pyb.usb_msd(True, 'dual partition')\n"
"#pyb.flush_cache(False)\n"
"#pyb.error_log('error.txt')\n"
;

// get lots of info about the board
static void board_info() {
    // get and print clock speeds
    // SYSCLK=168MHz, HCLK=168MHz, PCLK1=42MHz, PCLK2=84MHz
    {
        RCC_ClocksTypeDef rcc_clocks;
        RCC_GetClocksFreq(&rcc_clocks);
        printf("S=%lu\nH=%lu\nP1=%lu\nP2=%lu\n", rcc_clocks.SYSCLK_Frequency, rcc_clocks.HCLK_Frequency, rcc_clocks.PCLK1_Frequency, rcc_clocks.PCLK2_Frequency);
    }

    // to print info about memory
    {
        extern void *_sidata;
        extern void *_sdata;
        extern void *_edata;
        extern void *_sbss;
        extern void *_ebss;
        extern void *_estack;
        extern void *_etext;
        extern void *_heap_start;
        printf("_sidata=%p\n", &_sidata);
        printf("_sdata=%p\n", &_sdata);
        printf("_edata=%p\n", &_edata);
        printf("_sbss=%p\n", &_sbss);
        printf("_ebss=%p\n", &_ebss);
        printf("_estack=%p\n", &_estack);
        printf("_etext=%p\n", &_etext);
        printf("_heap_start=%p\n", &_heap_start);
    }

    // free space on flash
    {
        DWORD nclst;
        FATFS *fatfs;
        f_getfree("0:", &nclst, &fatfs);
        printf("free=%u\n", (uint)(nclst * fatfs->csize * 512));
    }
}

Damien's avatar
Damien committed
184
int main() {
185
    // TODO disable JTAG
Damien's avatar
Damien committed
186

187
188
189
190
191
192
    // set interrupt priority config to use all 4 bits for pre-empting
    NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4);

    // enable the CCM RAM and the GPIO's
    RCC->AHB1ENR |= RCC_AHB1ENR_CCMDATARAMEN | RCC_AHB1ENR_GPIOAEN | RCC_AHB1ENR_GPIOBEN | RCC_AHB1ENR_GPIOCEN;

193
194
    // basic sub-system init
    sys_tick_init();
Damien's avatar
Damien committed
195
    led_init();
196
197
198
199
200

    // turn on LED to indicate bootup
    led_state(PYB_LED_G1, 1);

    // more sub-system init
Damien's avatar
Damien committed
201
202
    sw_init();
    lcd_init();
203
    storage_init();
Damien's avatar
Damien committed
204

205
    // Python init
206
207
    qstr_init();
    rt_init();
208

Damien's avatar
Damien committed
209
210
211
    // print a message
    printf(" micro py board\n");

212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
    // local filesystem init
    {
        // try to mount the flash
        FRESULT res = f_mount(&fatfs0, "0:", 1);
        if (res == FR_OK) {
            // mount sucessful
        } else if (res == FR_NO_FILESYSTEM) {
            // no filesystem, so create a fresh one

            // LED on to indicate creation of LFS
            led_state(PYB_LED_R2, 1);
            uint32_t stc = sys_tick_counter;

            res = f_mkfs("0:", 0, 0);
            if (res == FR_OK) {
                // success creating fresh LFS
            } else {
                __fatal_error("could not create LFS");
            }

232
233
            // keep LED on for at least 200ms
            sys_tick_wait_at_least(stc, 200);
234
235
236
237
            led_state(PYB_LED_R2, 0);
        } else {
            __fatal_error("could not access LFS");
        }
Damien's avatar
Damien committed
238
239
    }

240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
    // make sure we have a /boot.py
    {
        FILINFO fno;
        FRESULT res = f_stat("0:/boot.py", &fno);
        if (res == FR_OK) {
            if (fno.fattrib & AM_DIR) {
                // exists as a directory
                // TODO handle this case
                // see http://elm-chan.org/fsw/ff/img/app2.c for a "rm -rf" implementation
            } else {
                // exists as a file, good!
            }
        } else {
            // doesn't exist, create fresh file

            // LED on to indicate creation of boot.py
            led_state(PYB_LED_R2, 1);
            uint32_t stc = sys_tick_counter;

            FIL fp;
            f_open(&fp, "0:/boot.py", FA_WRITE | FA_CREATE_ALWAYS);
            UINT n;
            f_write(&fp, fresh_boot_py, sizeof(fresh_boot_py), &n);
            // TODO check we could write n bytes
            f_close(&fp);

266
267
            // keep LED on for at least 200ms
            sys_tick_wait_at_least(stc, 200);
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
            led_state(PYB_LED_R2, 0);
        }
    }

    // run /boot.py
    if (0) {
        FIL fp;
        f_open(&fp, "0:/boot.py", FA_READ);
        UINT n;
        char buf[20];
        f_read(&fp, buf, 18, &n);
        buf[n + 1] = 0;
        printf("read %d\n%s", n, buf);
        f_close(&fp);
    }

    // turn boot-up LED off
285
    led_state(PYB_LED_G1, 0);
Damien's avatar
Damien committed
286

287
    // USB
Damien's avatar
Damien committed
288
    if (1) {
289
290
291
        usb_init();
    }

Damien's avatar
Damien committed
292
    //printf("init;al=%u\n", m_get_total_bytes_allocated()); // 1600, due to qstr_init
293
    //sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
294
295

    // Python!
296
    if (0) {
Damien's avatar
Damien committed
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
        //const char *pysrc = "def f():\n  x=x+1\nprint(42)\n";
        const char *pysrc =
            // impl01.py
            /*
            "x = 0\n"
            "while x < 400:\n"
            "    y = 0\n"
            "    while y < 400:\n"
            "        z = 0\n"
            "        while z < 400:\n"
            "            z = z + 1\n"
            "        y = y + 1\n"
            "    x = x + 1\n";
            */
            // impl02.py
312
            /*
Damien's avatar
Damien committed
313
314
315
316
317
318
319
320
321
322
323
324
            "#@micropython.native\n"
            "def f():\n"
            "    x = 0\n"
            "    while x < 400:\n"
            "        y = 0\n"
            "        while y < 400:\n"
            "            z = 0\n"
            "            while z < 400:\n"
            "                z = z + 1\n"
            "            y = y + 1\n"
            "        x = x + 1\n"
            "f()\n";
325
            */
Damien's avatar
Damien committed
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
            /*
            "print('in python!')\n"
            "x = 0\n"
            "while x < 4:\n"
            "    pyb_led(True)\n"
            "    pyb_delay(201)\n"
            "    pyb_led(False)\n"
            "    pyb_delay(201)\n"
            "    x = x + 1\n"
            "print('press me!')\n"
            "while True:\n"
            "    pyb_led(pyb_sw())\n";
            */
            /*
            // impl16.py
            "@micropython.asm_thumb\n"
            "def delay(r0):\n"
            "    b(loop_entry)\n"
            "    label(loop1)\n"
            "    movw(r1, 55999)\n"
            "    label(loop2)\n"
            "    subs(r1, r1, 1)\n"
            "    cmp(r1, 0)\n"
            "    bgt(loop2)\n"
            "    subs(r0, r0, 1)\n"
            "    label(loop_entry)\n"
            "    cmp(r0, 0)\n"
            "    bgt(loop1)\n"
            "print('in python!')\n"
            "@micropython.native\n"
            "def flash(n):\n"
            "    x = 0\n"
            "    while x < n:\n"
            "        pyb_led(True)\n"
            "        delay(249)\n"
            "        pyb_led(False)\n"
            "        delay(249)\n"
            "        x = x + 1\n"
            "flash(20)\n";
            */
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
            // impl18.py
            /*
            "# basic exceptions\n"
            "x = 1\n"
            "try:\n"
            "    x.a()\n"
            "except:\n"
            "    print(x)\n";
            */
            // impl19.py
            "# for loop\n"
            "def f():\n"
            "    for x in range(400):\n"
            "        for y in range(400):\n"
            "            for z in range(400):\n"
            "                pass\n"
            "f()\n";
Damien's avatar
Damien committed
383
384
385
386
387
388
389

        py_lexer_t *lex = py_lexer_from_str_len("<>", pysrc, strlen(pysrc), false);

        if (0) {
            while (!py_lexer_is_kind(lex, PY_TOKEN_END)) {
                py_token_show(py_lexer_cur(lex));
                py_lexer_to_next(lex);
390
                sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
391
392
393
394
            }
        } else {
            // nalloc=1740;6340;6836 -> 140;4600;496 bytes for lexer, parser, compiler
            printf("lex; al=%u\n", m_get_total_bytes_allocated());
395
            sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
396
397
398
            py_parse_node_t pn = py_parse(lex, 0);
            //printf("----------------\n");
            printf("pars;al=%u\n", m_get_total_bytes_allocated());
399
            sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
400
            //parse_node_show(pn, 0);
401
            py_compile(pn, false);
Damien's avatar
Damien committed
402
            printf("comp;al=%u\n", m_get_total_bytes_allocated());
403
            sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
404
405
406
407
408
409
410
411
412
413
414

            if (1) {
                // execute it!

                // add some functions to the python namespace
                rt_store_name(qstr_from_str_static("pyb_delay"), rt_make_function_1(pyb_delay));
                rt_store_name(qstr_from_str_static("pyb_led"), rt_make_function_1(pyb_led));
                rt_store_name(qstr_from_str_static("pyb_sw"), rt_make_function_0(pyb_sw));

                py_obj_t module_fun = rt_make_function_from_id(1);

415
                // flash once
416
                led_state(PYB_LED_G1, 1);
417
                sys_tick_delay_ms(100);
418
                led_state(PYB_LED_G1, 0);
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434

                nlr_buf_t nlr;
                if (nlr_push(&nlr) == 0) {
                    py_obj_t ret = rt_call_function_0(module_fun);
                    printf("done! got: ");
                    py_obj_print(ret);
                    printf("\n");
                    nlr_pop();
                } else {
                    // uncaught exception
                    printf("exception: ");
                    py_obj_print((py_obj_t)nlr.ret_val);
                    printf("\n");
                }

                // flash once
435
                led_state(PYB_LED_G1, 1);
436
                sys_tick_delay_ms(100);
437
                led_state(PYB_LED_G1, 0);
Damien's avatar
Damien committed
438

439
                sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
440
                printf("nalloc=%u\n", m_get_total_bytes_allocated());
441
                sys_tick_delay_ms(1000);
Damien's avatar
Damien committed
442
443
444
445
446
447
            }
        }
    }

    // benchmark C version of impl02.py
    if (0) {
448
        led_state(PYB_LED_G1, 1);
449
        sys_tick_delay_ms(100);
450
        led_state(PYB_LED_G1, 0);
Damien's avatar
Damien committed
451
        impl02_c_version();
452
        led_state(PYB_LED_G1, 1);
453
        sys_tick_delay_ms(100);
454
        led_state(PYB_LED_G1, 0);
Damien's avatar
Damien committed
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
    }

    // MMA testing
    if (0) {
        printf("1");
        mma_init();
        printf("2");
        mma_start(0x4c, 1);
        printf("3");
        mma_send_byte(0);
        printf("4");
        mma_stop();
        printf("5");
        mma_start(0x4c, 1);
        printf("6");
        mma_send_byte(0);
        printf("7");
        mma_restart(0x4c, 0);
        for (int i = 0; i <= 0xa; i++) {
            int data;
            if (i == 0xa) {
                data = mma_read_nack();
            } else {
                data = mma_read_ack();
            }
            printf(" %02x", data);
        }
        printf("\n");

        mma_start(0x4c, 1);
        mma_send_byte(7); // mode
        mma_send_byte(1); // active mode
        mma_stop();

        for (;;) {
490
            sys_tick_delay_ms(500);
Damien's avatar
Damien committed
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517

            mma_start(0x4c, 1);
            mma_send_byte(0);
            mma_restart(0x4c, 0);
            for (int i = 0; i <= 3; i++) {
                int data;
                if (i == 3) {
                    data = mma_read_nack();
                    printf(" %02x\n", data);
                } else {
                    data = mma_read_ack() & 0x3f;
                    if (data & 0x20) {
                        data |= 0xc0;
                    }
                    printf(" % 2d", data);
                }
            }
        }
    }

    // SD card testing
    if (0) {
        //sdio_init();
    }

    int i = 0;
    int n = 0;
518
    uint32_t stc = sys_tick_counter;
Damien's avatar
Damien committed
519
520

    for (;;) {
521
        sys_tick_delay_ms(10);
Damien's avatar
Damien committed
522
        if (sw_get()) {
523
            led_state(PYB_LED_G1, 1);
Damien's avatar
Damien committed
524
525
526
527
528
529
530
531
532
533
            i = 1 - i;
            if (i) {
                printf(" angel %05x.\n", n);
                //usb_vcp_send("hello!\r\n", 8);
            } else {
                printf(" mishka %4u.\n", n);
                //usb_vcp_send("angel!\r\n", 8);
            }
            n += 1;
        } else {
534
535
536
            led_state(PYB_LED_G1, 0);
        }
        if (sys_tick_has_passed(stc, 500)) {
537
            stc += 500;
538
            led_toggle(PYB_LED_G2);
Damien's avatar
Damien committed
539
540
541
542
543
        }
    }

    return 0;
}