#include "FT245.h" #include #include #include "circular_buffer.h" #include static void data_out(ft245_t *ft245); static void data_in(ft245_t *ft245); static void bit_set(ft245_t *ft245, uint8_t bit); static void bit_reset(ft245_t *ft245, uint8_t bit); static bool full_word_enabled(ft245_t *ft245); static bool read_byte(ft245_t *ft245, uint8_t byte, uint8_t *value); static bool tx_word(ft245_t *ft245); static bool rx_word(ft245_t *ft245); static atomic_flag lock = ATOMIC_FLAG_INIT; static void data_out(ft245_t *ft245) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) ft245->DATA0_to_output(); ft245->DATA1_to_output(); ft245->DATA2_to_output(); ft245->DATA3_to_output(); ft245->DATA4_to_output(); ft245->DATA5_to_output(); ft245->DATA6_to_output(); ft245->DATA7_to_output(); ft245->DATA8_to_output(); ft245->DATA9_to_output(); ft245->DATA10_to_output(); ft245->DATA11_to_output(); ft245->DATA12_to_output(); ft245->DATA13_to_output(); ft245->DATA14_to_output(); ft245->DATA15_to_output(); ft245->DATA16_to_output(); ft245->DATA17_to_output(); ft245->DATA18_to_output(); ft245->DATA19_to_output(); ft245->DATA20_to_output(); ft245->DATA21_to_output(); ft245->DATA22_to_output(); ft245->DATA23_to_output(); ft245->DATA24_to_output(); ft245->DATA25_to_output(); ft245->DATA26_to_output(); ft245->DATA27_to_output(); ft245->DATA28_to_output(); ft245->DATA29_to_output(); ft245->DATA30_to_output(); ft245->DATA31_to_output(); ft245->BE0_to_output(); ft245->BE1_to_output(); ft245->BE2_to_output(); ft245->BE3_to_output(); #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) FT245_DATA0_to_output(); FT245_DATA1_to_output(); FT245_DATA2_to_output(); FT245_DATA3_to_output(); FT245_DATA4_to_output(); FT245_DATA5_to_output(); FT245_DATA6_to_output(); FT245_DATA7_to_output(); FT245_DATA8_to_output(); FT245_DATA9_to_output(); FT245_DATA10_to_output(); FT245_DATA11_to_output(); FT245_DATA12_to_output(); FT245_DATA13_to_output(); FT245_DATA14_to_output(); FT245_DATA15_to_output(); FT245_DATA16_to_output(); FT245_DATA17_to_output(); FT245_DATA18_to_output(); FT245_DATA19_to_output(); FT245_DATA20_to_output(); FT245_DATA21_to_output(); FT245_DATA22_to_output(); FT245_DATA23_to_output(); FT245_DATA24_to_output(); FT245_DATA25_to_output(); FT245_DATA26_to_output(); FT245_DATA27_to_output(); FT245_DATA28_to_output(); FT245_DATA29_to_output(); FT245_DATA30_to_output(); FT245_DATA31_to_output(); FT245_BE0_to_output(); FT245_BE1_to_output(); FT245_BE2_to_output(); FT245_BE3_to_output(); #endif // (FT245_DRIVER_MODE_STATIC == 1) } static void data_in(ft245_t *ft245) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) ft245->DATA0_to_input(); ft245->DATA1_to_input(); ft245->DATA2_to_input(); ft245->DATA3_to_input(); ft245->DATA4_to_input(); ft245->DATA5_to_input(); ft245->DATA6_to_input(); ft245->DATA7_to_input(); ft245->DATA8_to_input(); ft245->DATA9_to_input(); ft245->DATA10_to_input(); ft245->DATA11_to_input(); ft245->DATA12_to_input(); ft245->DATA13_to_input(); ft245->DATA14_to_input(); ft245->DATA15_to_input(); ft245->DATA16_to_input(); ft245->DATA17_to_input(); ft245->DATA18_to_input(); ft245->DATA19_to_input(); ft245->DATA20_to_input(); ft245->DATA21_to_input(); ft245->DATA22_to_input(); ft245->DATA23_to_input(); ft245->DATA24_to_input(); ft245->DATA25_to_input(); ft245->DATA26_to_input(); ft245->DATA27_to_input(); ft245->DATA28_to_input(); ft245->DATA29_to_input(); ft245->DATA30_to_input(); ft245->DATA31_to_input(); ft245->BE0_to_input(); ft245->BE1_to_input(); ft245->BE2_to_input(); ft245->BE3_to_input(); #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) FT245_DATA0_to_input(); FT245_DATA1_to_input(); FT245_DATA2_to_input(); FT245_DATA3_to_input(); FT245_DATA4_to_input(); FT245_DATA5_to_input(); FT245_DATA6_to_input(); FT245_DATA7_to_input(); FT245_DATA8_to_input(); FT245_DATA9_to_input(); FT245_DATA10_to_input(); FT245_DATA11_to_input(); FT245_DATA12_to_input(); FT245_DATA13_to_input(); FT245_DATA14_to_input(); FT245_DATA15_to_input(); FT245_DATA16_to_input(); FT245_DATA17_to_input(); FT245_DATA18_to_input(); FT245_DATA19_to_input(); FT245_DATA20_to_input(); FT245_DATA21_to_input(); FT245_DATA22_to_input(); FT245_DATA23_to_input(); FT245_DATA24_to_input(); FT245_DATA25_to_input(); FT245_DATA26_to_input(); FT245_DATA27_to_input(); FT245_DATA28_to_input(); FT245_DATA29_to_input(); FT245_DATA30_to_input(); FT245_DATA31_to_input(); FT245_BE0_to_input(); FT245_BE1_to_input(); FT245_BE2_to_input(); FT245_BE3_to_input(); #endif // (FT245_DRIVER_MODE_STATIC == 1) } static void bit_set(ft245_t *ft245, uint8_t bit) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) switch(bit) { case 0: ft245->DATA0_set(); break; case 1: ft245->DATA1_set(); break; case 2: ft245->DATA2_set(); break; case 3: ft245->DATA3_set(); break; case 4: ft245->DATA4_set(); break; case 5: ft245->DATA5_set(); break; case 6: ft245->DATA6_set(); break; case 7: ft245->DATA7_set(); break; case 8: ft245->DATA8_set(); break; case 9: ft245->DATA9_set(); break; case 10: ft245->DATA10_set(); break; case 11: ft245->DATA11_set(); break; case 12: ft245->DATA12_set(); break; case 13: ft245->DATA13_set(); break; case 14: ft245->DATA14_set(); break; case 15: ft245->DATA15_set(); break; case 16: ft245->DATA16_set(); break; case 17: ft245->DATA17_set(); break; case 18: ft245->DATA18_set(); break; case 19: ft245->DATA19_set(); break; case 20: ft245->DATA20_set(); break; case 21: ft245->DATA21_set(); break; case 22: ft245->DATA22_set(); break; case 23: ft245->DATA23_set(); break; case 24: ft245->DATA24_set(); break; case 25: ft245->DATA25_set(); break; case 26: ft245->DATA26_set(); break; case 27: ft245->DATA27_set(); break; case 28: ft245->DATA28_set(); break; case 29: ft245->DATA29_set(); break; case 30: ft245->DATA30_set(); break; case 31: ft245->DATA31_set(); break; } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) switch(bit) { case 0: FT245_DATA0_set(); break; case 1: FT245_DATA1_set(); break; case 2: FT245_DATA2_set(); break; case 3: FT245_DATA3_set(); break; case 4: FT245_DATA4_set(); break; case 5: FT245_DATA5_set(); break; case 6: FT245_DATA6_set(); break; case 7: FT245_DATA7_set(); break; case 8: FT245_DATA8_set(); break; case 9: FT245_DATA9_set(); break; case 10: FT245_DATA10_set(); break; case 11: FT245_DATA11_set(); break; case 12: FT245_DATA12_set(); break; case 13: FT245_DATA13_set(); break; case 14: FT245_DATA14_set(); break; case 15: FT245_DATA15_set(); break; case 16: FT245_DATA16_set(); break; case 17: FT245_DATA17_set(); break; case 18: FT245_DATA18_set(); break; case 19: FT245_DATA19_set(); break; case 20: FT245_DATA20_set(); break; case 21: FT245_DATA21_set(); break; case 22: FT245_DATA22_set(); break; case 23: FT245_DATA23_set(); break; case 24: FT245_DATA24_set(); break; case 25: FT245_DATA25_set(); break; case 26: FT245_DATA26_set(); break; case 27: FT245_DATA27_set(); break; case 28: FT245_DATA28_set(); break; case 29: FT245_DATA29_set(); break; case 30: FT245_DATA30_set(); break; case 31: FT245_DATA31_set(); break; } #endif // (FT245_DRIVER_MODE_STATIC == 1) } static void bit_reset(ft245_t *ft245, uint8_t bit) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) switch(bit) { case 0: ft245->DATA0_reset(); break; case 1: ft245->DATA1_reset(); break; case 2: ft245->DATA2_reset(); break; case 3: ft245->DATA3_reset(); break; case 4: ft245->DATA4_reset(); break; case 5: ft245->DATA5_reset(); break; case 6: ft245->DATA6_reset(); break; case 7: ft245->DATA7_reset(); break; case 8: ft245->DATA8_reset(); break; case 9: ft245->DATA9_reset(); break; case 10: ft245->DATA10_reset(); break; case 11: ft245->DATA11_reset(); break; case 12: ft245->DATA12_reset(); break; case 13: ft245->DATA13_reset(); break; case 14: ft245->DATA14_reset(); break; case 15: ft245->DATA15_reset(); break; case 16: ft245->DATA16_reset(); break; case 17: ft245->DATA17_reset(); break; case 18: ft245->DATA18_reset(); break; case 19: ft245->DATA19_reset(); break; case 20: ft245->DATA20_reset(); break; case 21: ft245->DATA21_reset(); break; case 22: ft245->DATA22_reset(); break; case 23: ft245->DATA23_reset(); break; case 24: ft245->DATA24_reset(); break; case 25: ft245->DATA25_reset(); break; case 26: ft245->DATA26_reset(); break; case 27: ft245->DATA27_reset(); break; case 28: ft245->DATA28_reset(); break; case 29: ft245->DATA29_reset(); break; case 30: ft245->DATA30_reset(); break; case 31: ft245->DATA31_reset(); break; } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) switch(bit) { case 0: FT245_DATA0_reset(); break; case 1: FT245_DATA1_reset(); break; case 2: FT245_DATA2_reset(); break; case 3: FT245_DATA3_reset(); break; case 4: FT245_DATA4_reset(); break; case 5: FT245_DATA5_reset(); break; case 6: FT245_DATA6_reset(); break; case 7: FT245_DATA7_reset(); break; case 8: FT245_DATA8_reset(); break; case 9: FT245_DATA9_reset(); break; case 10: FT245_DATA10_reset(); break; case 11: FT245_DATA11_reset(); break; case 12: FT245_DATA12_reset(); break; case 13: FT245_DATA13_reset(); break; case 14: FT245_DATA14_reset(); break; case 15: FT245_DATA15_reset(); break; case 16: FT245_DATA16_reset(); break; case 17: FT245_DATA17_reset(); break; case 18: FT245_DATA18_reset(); break; case 19: FT245_DATA19_reset(); break; case 20: FT245_DATA20_reset(); break; case 21: FT245_DATA21_reset(); break; case 22: FT245_DATA22_reset(); break; case 23: FT245_DATA23_reset(); break; case 24: FT245_DATA24_reset(); break; case 25: FT245_DATA25_reset(); break; case 26: FT245_DATA26_reset(); break; case 27: FT245_DATA27_reset(); break; case 28: FT245_DATA28_reset(); break; case 29: FT245_DATA29_reset(); break; case 30: FT245_DATA30_reset(); break; case 31: FT245_DATA31_reset(); break; } #endif // (FT245_DRIVER_MODE_STATIC == 1) } static bool byte_enabled_get(ft245_t *ft245, uint8_t byte) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) switch(byte) { case 0: ft245->BE0_to_input(); return (ft245->BE0_read() != 0); case 1: ft245->BE1_to_input(); return (ft245->BE1_read() != 0); case 2: ft245->BE2_to_input(); return (ft245->BE2_read() != 0); case 3: ft245->BE3_to_input(); return (ft245->BE3_read() != 0); } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) switch(byte) { case 0: FT245_BE0_to_input(); return (FT245_BE0_read() != 0); case 1: FT245_BE1_to_input(); return (FT245_BE1_read() != 0); case 2: FT245_BE2_to_input(); return (FT245_BE2_read() != 0); case 3: FT245_BE3_to_input(); return (FT245_BE3_read() != 0); } #endif // (FT245_DRIVER_MODE_STATIC == 1) return false; } static void byte_enabled_set(ft245_t *ft245, uint8_t byte, bool enabled) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) switch(byte) { case 0: ft245->BE0_to_output(); if(enabled) ft245->BE0_set(); else ft245->BE0_reset(); break; case 1: ft245->BE1_to_output(); if(enabled) ft245->BE1_set(); else ft245->BE1_reset(); break; case 2: ft245->BE2_to_output(); if(enabled) ft245->BE2_set(); else ft245->BE2_reset(); break; case 3: ft245->BE3_to_output(); if(enabled) ft245->BE3_set(); else ft245->BE3_reset(); break; } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) switch(byte) { case 0: FT245_BE0_to_output(); if(enabled) FT245_BE0_set(); else FT245_BE0_reset(); break; case 1: FT245_BE1_to_output(); if(enabled) FT245_BE1_set(); else FT245_BE1_reset(); break; case 2: FT245_BE2_to_output(); if(enabled) FT245_BE2_set(); else FT245_BE2_reset(); break; case 3: FT245_BE3_to_output(); if(enabled) FT245_BE3_set(); else FT245_BE3_reset(); break; } #endif // (FT245_DRIVER_MODE_STATIC == 1) } static bool full_word_enabled(ft245_t *ft245) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) return (ft245->BE3_read() && ft245->BE2_read() && ft245->BE1_read() && ft245->BE0_read()); #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) return (FT245_BE3_read() && FT245_BE2_read() && FT245_BE1_read() && FT245_BE0_read()); #endif // (FT245_DRIVER_MODE_STATIC == 1) } static bool read_byte(ft245_t *ft245, uint8_t byte, uint8_t *value) { #if(FT245_DRIVER_MODE_DYNAMIC == 1) switch(byte) { case 0: if(ft245->BE0_read()) { *value = ((((ft245->DATA7_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((ft245->DATA6_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((ft245->DATA5_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((ft245->DATA4_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((ft245->DATA3_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((ft245->DATA2_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((ft245->DATA1_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((ft245->DATA0_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 1: if(ft245->BE1_read()) { *value = ((((ft245->DATA15_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((ft245->DATA14_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((ft245->DATA13_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((ft245->DATA12_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((ft245->DATA11_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((ft245->DATA10_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((ft245->DATA9_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((ft245->DATA8_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 2: if(ft245->BE2_read()) { *value = ((((ft245->DATA23_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((ft245->DATA22_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((ft245->DATA21_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((ft245->DATA20_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((ft245->DATA19_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((ft245->DATA18_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((ft245->DATA17_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((ft245->DATA16_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 3: if(ft245->BE3_read()) { *value = ((((ft245->DATA31_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((ft245->DATA30_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((ft245->DATA29_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((ft245->DATA28_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((ft245->DATA27_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((ft245->DATA26_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((ft245->DATA25_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((ft245->DATA24_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) switch(byte) { case 0: if(FT245_BE0_read()) { *value = ((((FT245_DATA7_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((FT245_DATA6_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((FT245_DATA5_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((FT245_DATA4_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((FT245_DATA3_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((FT245_DATA2_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((FT245_DATA1_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((FT245_DATA0_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 1: if(FT245_BE1_read()) { *value = ((((FT245_DATA15_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((FT245_DATA14_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((FT245_DATA13_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((FT245_DATA12_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((FT245_DATA11_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((FT245_DATA10_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((FT245_DATA9_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((FT245_DATA8_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 2: if(FT245_BE2_read()) { *value = ((((FT245_DATA23_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((FT245_DATA22_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((FT245_DATA21_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((FT245_DATA20_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((FT245_DATA19_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((FT245_DATA18_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((FT245_DATA17_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((FT245_DATA16_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; case 3: if(FT245_BE3_read()) { *value = ((((FT245_DATA31_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 7) | (((FT245_DATA30_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 6) | (((FT245_DATA29_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 5) | (((FT245_DATA28_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 4) | (((FT245_DATA27_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 3) | (((FT245_DATA26_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 2) | (((FT245_DATA25_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 1) | (((FT245_DATA24_read() == 0) ? ((uint32_t) 0) : ((uint32_t) 1)) << 0)); } else { *value = 0; return false; } return true; } #endif // (FT245_DRIVER_MODE_STATIC == 1) } static bool tx_word(ft245_t *ft245) { if(!cb_occupation(ft245->buffer_tx)) return false; if(ft245->full_word_mode && (cb_occupation(ft245->buffer_tx) < 4)) return false; data_out(ft245); uint8_t data = 0; uint32_t word = 0; for(uint8_t i = 0; i < 4; i++) { if(cb_occupation(ft245->buffer_tx)) { cb_pop(ft245->buffer_tx, data); byte_enabled_set(ft245, 3 - i, true); } else { data = 0; byte_enabled_set(ft245, 3 - i, false); } word |= ((uint32_t) data) << (i * 8); } for(uint8_t i = 0; i < 32; i++) { if((word >> i) & 0b1) bit_set(ft245, i); else bit_reset(ft245, i); } return true; } static bool rx_word(ft245_t *ft245) { data_in(ft245); if((cb_size(ft245->buffer_rx) - cb_occupation(ft245->buffer_rx)) < 4) return false; if(ft245->full_word_mode && !full_word_enabled(ft245)) return false; uint8_t data[4]; for(uint8_t i = 0; i < 4; i++) read_byte(ft245, i, &data[i]); cb_push(ft245->buffer_rx, data[3]); cb_push(ft245->buffer_rx, data[2]); cb_push(ft245->buffer_rx, data[1]); cb_push(ft245->buffer_rx, data[0]); // Check for sync word 0x66665555 if((data[3] == 0x55) && (data[2] == 0x55) && (data[1] == 0x66) && (data[0] == 0x66)) cb_reset(ft245->buffer_rx); return true; } void ft245_init(ft245_t *ft245) { data_in(ft245); cb_init(ft245->buffer_rx, FT245_BUFFER_SIZE_RX); cb_init(ft245->buffer_tx, FT245_BUFFER_SIZE_TX); ft245->clk_state = false; ft245->clk_count = 0; } void ft245_periodic(ft245_t *ft245) { static size_t oe_n = 0; static size_t rd_n = 0; static size_t wr_n = 0; static size_t rst_n = 0; bool rxf_n = false; bool txe_n = false; #if(FT245_DRIVER_MODE_DYNAMIC == 1) if(ft245->clk_state) { ft245->CLK_reset(); ft245->clk_state = false; } else { ft245->CLK_set(); ft245->clk_state = true; oe_n = ft245->OE_N_read() ? 0 : (oe_n + 1); rd_n = ft245->RD_N_read() ? 0 : (rd_n + 1); wr_n = ft245->WR_N_read() ? 0 : (wr_n + 1); rst_n = ft245->RST_N_read() ? 0 : (rst_n + 1); if(rst_n) return; rxf_n = (cb_occupation(ft245->buffer_tx) > (ft245->full_word_mode ? 3 : 0)); txe_n = !cb_full(ft245->buffer_rx); if(rxf_n) ft245->RXF_N_reset(); else ft245->RXF_N_set(); if(txe_n) ft245->TXE_N_reset(); else ft245->TXE_N_set(); // OE_N low => Output Enable // RD_N low => Read access for master // Both required to drive data if(rxf_n && oe_n && rd_n) { tx_word(ft245); } else if(txe_n && wr_n) { rx_word(ft245); } else { data_in(ft245); } } #endif // (FT245_DRIVER_MODE_DYNAMIC == 1) #if(FT245_DRIVER_MODE_STATIC == 1) if(ft245->clk_state) { FT245_CLK_reset(); ft245->clk_state = false; } else { FT245_CLK_set(); ft245->clk_state = true; oe_n = FT245_OE_N_read() ? 0 : (oe_n + 1); rd_n = FT245_RD_N_read() ? 0 : (rd_n + 1); wr_n = FT245_WR_N_read() ? 0 : (wr_n + 1); rst_n = FT245_RST_N_read() ? 0 : (rst_n + 1); if(rst_n) return; rxf_n = (cb_occupation(ft245->buffer_tx) > (ft245->full_word_mode ? 3 : 0)); txe_n = !cb_full(ft245->buffer_rx); if(rxf_n) FT245_RXF_N_reset(); else FT245_RXF_N_set(); if(txe_n) FT245_TXE_N_reset(); else FT245_TXE_N_set(); // OE_N low => Output Enable // RD_N low => Read access for master // Both required to drive data if(rxf_n && oe_n && rd_n) { tx_word(ft245); } else if(txe_n && wr_n) { rx_word(ft245); } else { data_in(ft245); } } #endif // (FT245_DRIVER_MODE_STATIC == 1) } bool ft245_write_buffered(ft245_t *ft245, uint8_t *data, size_t size) { if(cb_full(ft245->buffer_tx)) return false; if(cb_size(ft245->buffer_tx) - cb_occupation(ft245->buffer_tx) < size) return false; for(size_t i = 0; i < size; i++) cb_push(ft245->buffer_tx, data[i]); return true; } bool ft245_read_buffered(ft245_t *ft245, uint8_t *data, size_t size) { if(cb_occupation(ft245->buffer_rx) < size) return false; for(size_t i = 0; i < size; i++) cb_pop(ft245->buffer_rx, data[i]); return true; } bool ft245_write_word_buffered(ft245_t *ft245, uint32_t word) { while(atomic_flag_test_and_set_explicit(&lock, memory_order_acquire)); if(cb_size(ft245->buffer_tx) - cb_occupation(ft245->buffer_tx) < 4) { atomic_flag_clear_explicit(&lock, memory_order_release); return false; } cb_push(ft245->buffer_tx, (word >> 0) & 0xFF); cb_push(ft245->buffer_tx, (word >> 8) & 0xFF); cb_push(ft245->buffer_tx, (word >> 16) & 0xFF); cb_push(ft245->buffer_tx, (word >> 24) & 0xFF); atomic_flag_clear_explicit(&lock, memory_order_release); return true; } bool ft245_read_word_buffered(ft245_t *ft245, uint32_t *word) { while(atomic_flag_test_and_set_explicit(&lock, memory_order_acquire)); if(cb_occupation(ft245->buffer_rx) < 4) { atomic_flag_clear_explicit(&lock, memory_order_release); return false; } uint8_t data = 0; cb_pop(ft245->buffer_rx, data); *word |= ((uint32_t) data) << 24; cb_pop(ft245->buffer_rx, data); *word |= ((uint32_t) data) << 16; cb_pop(ft245->buffer_rx, data); *word |= ((uint32_t) data) << 8; cb_pop(ft245->buffer_rx, data); *word |= ((uint32_t) data) << 0; atomic_flag_clear_explicit(&lock, memory_order_release); return true; } size_t ft245_available_read(ft245_t *ft245) { return cb_occupation(ft245->buffer_rx); } size_t ft245_available_write(ft245_t *ft245) { return (cb_size(ft245->buffer_tx) - cb_occupation(ft245->buffer_tx)); }