123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331 |
- #include <stdint.h>
- #include <stdbool.h>
- #include <string.h>
- #include "console.h"
- #include "led.h"
- #include "mini-printf.h"
- #include "spi.h"
- #include "utils.h"
- #include "registers.h"
- #include "generation.h"
- #define FLASH_MAILBOX_STORAGE 0x0F0000
- static uint32_t copy_array[16];
- static tweaked_params_union_s out_params;
- static inline uint32_t rdcycle(void)
- {
- uint32_t cycle;
- __asm__ volatile ("rdcycle %0" : "=r" (cycle));
- return cycle;
- }
- #define CYCLES_DIV 24000000.0f
- #define UPDATE_MS 0.1f
- static uint32_t last_rdcycle;
- static bool timer_expired()
- {
- bool success = false;
- uint32_t current = rdcycle();
- uint32_t diff = current - last_rdcycle;
-
-
- float elapsed_seconds = (float)(diff) / CYCLES_DIV;
- if (elapsed_seconds > UPDATE_MS)
- {
- last_rdcycle = current;
-
- success = true;;
- }
- return success;
- }
- static void write_regs_to_mailbox()
- {
- mailbox_regs->regs.period1 = out_params.regs._period1;
-
- mailbox_regs->regs.delay1 = out_params.regs.D1 / FXP_SCALING;
-
- mailbox_regs->regs.delay2 = out_params.regs.D2 / FXP_SCALING;
-
- mailbox_regs->regs.delay3 = out_params.regs.D3 / FXP_SCALING;
- mailbox_regs->regs.npuls3 = out_params.regs.N3;
- mailbox_regs->regs.odd_train_flag = N_PULSE_TRAINS;
- mailbox_regs->regs.ena_odd_out3 = out_params.regs.ena;
- }
- static void clear_button_regs()
- {
- for (int i = 0; i < 16; ++i)
- mailbox_button_regs->data[i] = 0x0;
- }
- static void print_mailbox_contents()
- {
- int i = 0;
- printf("Mailbox contents:\n");
- for(i = 0; i < 16; ++i)
- printf("Mailbox[%d]: %d\n", i, mailbox_regs->data[i]);
- }
- static void read_generation_values_from_flash()
- {
- flash_read((void*)copy_array, FLASH_MAILBOX_STORAGE, sizeof(copy_array));
-
- for (int i = 0; i < 14; ++i)
- out_params.data[i] = copy_array[i];
- }
- static void store_generation_values_flash()
- {
-
-
-
- for (int i = 0; i < 16; ++i)
- copy_array[i] = out_params.data[i];
- flash_write_enable();
- flash_sector_erase(FLASH_MAILBOX_STORAGE);
-
- while (flash_read_sr() & 0x01) ;
- flash_write_enable();
- flash_page_program((void*)copy_array, FLASH_MAILBOX_STORAGE, sizeof(copy_array));
- while (flash_read_sr() & 0x01) ;
- }
- static void
- serial_no_init()
- {
- uint8_t buf[8];
- flash_manuf_id(buf);
- printf("Flash Manufacturer : %s\n", hexstr(buf, 3, true));
- flash_unique_id(buf);
- printf("Flash Unique ID : %s\n", hexstr(buf, 8, true));
-
-
- }
- static void write_period1()
- {
- printf("Writing period1 0x1\n");
- mailbox_regs->regs.period1 = 0x1;
- printf("Done writing\n");
- print_mailbox_contents();
-
- }
- static void write_period1_2()
- {
- printf("Writing period1 0x2\n");
- mailbox_regs->regs.period1 = 0x2;
- printf("Done writing\n");
- print_mailbox_contents();
-
- }
- static void write_period1_4()
- {
- printf("Writing period1 0x4\n");
- mailbox_regs->regs.period1 = 0x4;
- printf("Done writing\n");
- printf("Reading now \n");
- printf("value: %d\n", mailbox_regs->regs.period1);
- print_mailbox_contents();
-
- }
- static void clear_period1()
- {
- printf("Clearing period1 val: %d\n", mailbox_regs->regs.period1);
- mailbox_regs->regs.period1 = 0x0;
- printf("Done clearing\n");
- }
- static void write_delay1()
- {
- printf("Writing delay1 0x1234\n");
- mailbox_regs->regs.delay1 = 0x1234;
- printf("Done writing\n");
-
- }
- static void clear_delay1()
- {
- printf("Clearing delay1 val: %d\n", mailbox_regs->regs.delay1);
- mailbox_regs->regs.delay1 = 0x0;
- printf("Done clearing\n");
- }
- static void print_flash_contents()
- {
- read_generation_values_from_flash();
- print_mailbox_contents();
- }
- static void
- boot_dfu(void)
- {
-
- volatile uint32_t *boot = (void*)0x80000000;
- *boot = (1 << 2) | (1 << 0);
- }
- void
- usb_dfu_rt_cb_reboot(void)
- {
- boot_dfu();
- }
- void main()
- {
- int cmd = 0;
-
- console_init();
- puts("Booting App image..\n");
-
- led_init();
- led_color(48, 96, 5);
- led_blink(true, 200, 1000);
- led_breathe(true, 100, 200);
- led_state(true);
-
- spi_init();
-
- serial_no_init();
-
- read_generation_values_from_flash();
-
- if (validate_generation_values(&out_params.regs) != 0)
- init_params(&out_params.regs);
- write_regs_to_mailbox();
-
- while (1)
- {
-
- if (timer_expired())
- {
- update_three_signal_values(&out_params.regs, mailbox_button_regs);
-
- clear_button_regs();
- write_regs_to_mailbox();
- if (mailbox_regs->regs.write_flash)
- {
- store_generation_values_flash();
- mailbox_regs->regs.write_flash = 0x0;
- }
- }
-
- #ifdef USE_KEYBOARD
-
- if (cmd >= 0)
- printf("Command> ");
-
- cmd = getchar_nowait();
- if (cmd >= 0) {
- if (cmd > 32 && cmd < 127) {
- putchar(cmd);
- putchar('\r');
- putchar('\n');
- }
- switch (cmd)
- {
- case 'q':
- printf("Current rdcycle %d\n", rdcycle());
- break;
- case 'b':
- boot_dfu();
- break;
- case 'w':
- write_period1();
- break;
- case 'k':
- clear_period1();
- break;
- case 'a':
- write_period1_2();
- break;
- case 's':
- write_period1_4();
- break;
- case 'o':
- write_delay1();
- break;
- case 'm':
- clear_delay1();
- break;
- case 'f':
- print_flash_contents();
- break;
- default:
- break;
- }
- }
- #endif
- }
- }
|