diff options
Diffstat (limited to 'driver_fw/src')
| -rw-r--r-- | driver_fw/src/main.c | 33 |
1 files changed, 23 insertions, 10 deletions
diff --git a/driver_fw/src/main.c b/driver_fw/src/main.c index 6c63f4f..765c55a 100644 --- a/driver_fw/src/main.c +++ b/driver_fw/src/main.c @@ -1,6 +1,7 @@ #include <global.h> #include <string.h> +#include "8b10b.h" #include "generated/waveform_tables.h" volatile uint64_t sys_time_us; @@ -11,8 +12,15 @@ 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 uint8_t tx_datagram[32] = { +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_0, 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, 0x00, 0xff, 0xAA, 0x55, 0xfe, 0x18, 0xcc, 0x10, @@ -20,6 +28,7 @@ static uint8_t tx_datagram[32] = { 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; int main(void) { @@ -144,11 +153,11 @@ int main(void) { TIM1->CCMR1 = (6<<TIM_CCMR1_OC2M_Pos) | TIM_CCMR1_OC2PE; TIM1->CCMR2 = (6<<TIM_CCMR2_OC3M_Pos) | TIM_CCMR2_OC3PE; - TIM1->CCER = TIM_CCER_CC2E | TIM_CCER_CC2NE | TIM_CCER_CC3E | TIM_CCER_CC3NE; - TIM1->BDTR = TIM_BDTR_MOE | (32<<TIM_BDTR_DTG_Pos) | TIM_BDTR_MOE; + TIM1->CCER = TIM_CCER_CC2E | TIM_CCER_CC2NE | TIM_CCER_CC2NP | TIM_CCER_CC3E | TIM_CCER_CC3NE | TIM_CCER_CC3P; + TIM1->BDTR = (8<<TIM_BDTR_DTG_Pos) | TIM_BDTR_MOE; TIM1->DCR = (14<<TIM_DCR_DBA_Pos) | (1<<TIM_DCR_DBL_Pos); - TIM1->PSC = 4; - TIM1->ARR = 256; + TIM1->PSC = 3; + TIM1->ARR = 250; TIM1->CCR2 = 64; TIM1->CCR3 = 192; TIM1->DIER = TIM_DIER_UDE; @@ -159,7 +168,7 @@ int main(void) { NVIC_EnableIRQ(DMA1_Channel1_IRQn); NVIC_SetPriority(DMA1_Channel1_IRQn, 0); dma_tx_constant(COUNT_OF(waveform_zero_one), 0x00); - + xfr_8b10b_encode_reset(&encoder_state_8b10b); int i = 0; int j = 0; while (23) { @@ -182,8 +191,9 @@ void dma_tx_waveform(size_t table_size, const uint16_t *table) { } void dma_tx_constant(size_t table_size, uint16_t constant) { - static uint16_t tx_constant; - tx_constant = constant; + static uint16_t tx_constant[2]; + tx_constant[0] = constant; + tx_constant[1] = constant; DMA1_Channel1->CCR = 0; DMA1_Channel1->CCR = (1<<DMA_CCR_MSIZE_Pos) | (1<<DMA_CCR_PSIZE_Pos) | DMA_CCR_DIR | DMA_CCR_TCIE; @@ -194,13 +204,15 @@ void dma_tx_constant(size_t table_size, uint16_t constant) { void DMA1_Channel1_IRQHandler() { static int transfer_errors = 0; + static int current_symbol = 0x2aa; + if (DMA1->ISR & DMA_ISR_TEIF1) { transfer_errors ++; } DMA1->IFCR = DMA_IFCR_CGIF1; - int bit = !!(tx_datagram[tx_sympos] & (1<<tx_bitpos)); + int bit = !!(current_symbol & (1<<tx_bitpos)); if (tx_last_bit == bit) { dma_tx_constant(COUNT_OF(waveform_zero_one), bit ? WAVEFORM_CONST_ONE : WAVEFORM_CONST_ZERO); @@ -213,9 +225,10 @@ void DMA1_Channel1_IRQHandler() { tx_last_bit = bit; tx_bitpos ++; - if (tx_bitpos >= 8) { + if (tx_bitpos >= 10) { tx_bitpos = 0; tx_sympos ++; + current_symbol = xfr_8b10b_encode(&encoder_state_8b10b, tx_datagram[tx_sympos]); if (tx_sympos >= COUNT_OF(tx_datagram)) { tx_sympos = 0; } |