diff options
Diffstat (limited to 'driver_fw/src/main.c')
| -rw-r--r-- | driver_fw/src/main.c | 104 |
1 files changed, 87 insertions, 17 deletions
diff --git a/driver_fw/src/main.c b/driver_fw/src/main.c index 0b3c869..136e0c7 100644 --- a/driver_fw/src/main.c +++ b/driver_fw/src/main.c @@ -2,6 +2,9 @@ #include <global.h> #include <string.h> #include "8b10b.h" +#include "crc32.h" +#include "xorshift.h" +#include "protocol.h" #include "generated/waveform_tables.h" volatile uint64_t sys_time_us; @@ -12,23 +15,27 @@ static void set_status_leds(uint32_t leds); static void dma_tx_constant(size_t table_size, uint16_t constant); static void dma_tx_waveform(size_t table_size, const uint16_t *table); -static int tx_datagram[33] = { - /* FIXME test data */ -/* - 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, - 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, - 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, - 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa, 0xaa}; -*/ - -K28_1, - 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, - 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, - 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, - 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10 }; +#define SYNC_INTERVAL 2 + +static size_t time_to_sync = 0; static size_t tx_bitpos = 0; static size_t tx_sympos = 0; static int tx_last_bit = 0; static struct state_8b10b_enc encoder_state_8b10b; +static uint32_t packet_rng_state; + +union tx_buf_union { + struct data_packet packet; + uint8_t bytes[sizeof(struct data_packet)]; +}; + +static union tx_buf_union tx_buf[3]; +static union tx_buf_union *tx_buf_read = &tx_buf[0]; +static union tx_buf_union *tx_buf_idle = &tx_buf[1]; +static union tx_buf_union *tx_buf_write = &tx_buf[2]; +static bool idle_buf_ready = false; + +void update_tx_buf(void); int main(void) { @@ -169,6 +176,16 @@ int main(void) { NVIC_SetPriority(DMA1_Channel1_IRQn, 0); dma_tx_constant(COUNT_OF(waveform_zero_one), 0x00); xfr_8b10b_encode_reset(&encoder_state_8b10b); + + memset(tx_buf_write, 0, sizeof(*tx_buf_write)); + for (size_t i=0; i<COUNT_OF(tx_buf_write->packet.channels); i++) { + tx_buf_write->packet.channels[i] = 0x33; + } + for (size_t i=0; i<COUNT_OF(tx_buf_write->packet.brightness); i++) { + tx_buf_write->packet.brightness[i] = 0xff; + } + update_tx_buf(); + int i = 0; int j = 0; while (23) { @@ -204,10 +221,14 @@ void dma_tx_constant(size_t table_size, uint16_t constant) { int8_t bit_arr[4096]; size_t bit_pos = 0; +int16_t sym_arr[512]; +size_t sym_pos = 0; +uint16_t cnd_arr[512]; +size_t cnd_pos = 0; void DMA1_Channel1_IRQHandler() { static int transfer_errors = 0; - static int current_symbol = 0x2aa; + static int current_symbol = 0; if (DMA1->ISR & DMA_ISR_TEIF1) { transfer_errors ++; @@ -233,16 +254,65 @@ void DMA1_Channel1_IRQHandler() { if (tx_bitpos == 0) { tx_bitpos = 9; - current_symbol = xfr_8b10b_encode(&encoder_state_8b10b, tx_datagram[tx_sympos]); - tx_sympos ++; - if (tx_sympos >= COUNT_OF(tx_datagram)) { + + sym_arr[sym_pos] = -255; + + if (tx_sympos == sizeof(struct data_packet)) { + if (time_to_sync > 0) { + current_symbol = xfr_8b10b_encode(&encoder_state_8b10b, -K27_7); + sym_arr[sym_pos] = current_symbol; + time_to_sync--; + + } else { + current_symbol = xfr_8b10b_encode(&encoder_state_8b10b, -K28_1); + sym_arr[sym_pos] = current_symbol; + packet_rng_state = xorshift32(1); + time_to_sync = SYNC_INTERVAL; + } + + if (idle_buf_ready) { + union tx_buf_union *tmp = tx_buf_idle; + tx_buf_idle = tx_buf_read; + tx_buf_read = tmp; + idle_buf_ready = false; + } + tx_sympos = 0; + + } else { + uint8_t b = tx_buf_read->bytes[tx_sympos]; + packet_rng_state = xorshift32(packet_rng_state); + //b ^= packet_rng_state; FIXME DEBUG + current_symbol = xfr_8b10b_encode(&encoder_state_8b10b, b); + sym_arr[sym_pos] = current_symbol; + tx_sympos ++; + } + + sym_pos++; + if (sym_pos == COUNT_OF(sym_arr)) { + sym_pos = 0; } + } else { tx_bitpos --; } } +void update_tx_buf() { + uint32_t crc = crc32_reset(); + for (size_t i=0; i<offsetof(struct data_packet, crc); i++) { + crc = crc32_update(crc, tx_buf_write->bytes[i]); + } + tx_buf_write->packet.crc = crc32_finalize(crc); + + __disable_irq(); + union tx_buf_union *tmp = tx_buf_idle; + tx_buf_idle = tx_buf_write; + tx_buf_write = tmp; + idle_buf_ready = true; + __enable_irq(); +} + uint32_t read_fuse_monitor() { uint32_t idr_a = GPIOA->IDR; uint32_t idr_c = GPIOC->IDR; |