123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529 |
- #ifndef F_CPU
- # define F_CPU 16000000
- #endif
- #include <avr/io.h>
- #include <avr/interrupt.h>
- #include <util/delay.h>
- #include <stddef.h>
- #include <stdbool.h>
- #include "serial.h"
- #ifdef SOFT_SERIAL_PIN
- # if !(defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__))
- # error serial.c is not supported for the currently selected MCU
- # endif
- # if defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__) || defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
- # if defined(USE_AVR_I2C) && (SOFT_SERIAL_PIN == D0 || SOFT_SERIAL_PIN == D1)
- # error Using I2C, so can not use PD0, PD1
- # endif
- # endif
- # if SOFT_SERIAL_PIN == D0
- # define EIMSK_BIT _BV(INT0)
- # define EICRx_BIT (~(_BV(ISC00) | _BV(ISC01)))
- # define SERIAL_PIN_INTERRUPT INT0_vect
- # define EICRx EICRA
- # elif SOFT_SERIAL_PIN == D1
- # define EIMSK_BIT _BV(INT1)
- # define EICRx_BIT (~(_BV(ISC10) | _BV(ISC11)))
- # define SERIAL_PIN_INTERRUPT INT1_vect
- # define EICRx EICRA
- # elif SOFT_SERIAL_PIN == D2
- # define EIMSK_BIT _BV(INT2)
- # define EICRx_BIT (~(_BV(ISC20) | _BV(ISC21)))
- # define SERIAL_PIN_INTERRUPT INT2_vect
- # define EICRx EICRA
- # elif SOFT_SERIAL_PIN == D3
- # define EIMSK_BIT _BV(INT3)
- # define EICRx_BIT (~(_BV(ISC30) | _BV(ISC31)))
- # define SERIAL_PIN_INTERRUPT INT3_vect
- # define EICRx EICRA
- # endif
- # if defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega32U2__) || defined(__AVR_AT90USB162__)
- # if SOFT_SERIAL_PIN == D4
- # define EIMSK_BIT _BV(INT5)
- # define EICRx_BIT (~(_BV(ISC50) | _BV(ISC51)))
- # define SERIAL_PIN_INTERRUPT INT5_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == D6
- # define EIMSK_BIT _BV(INT6)
- # define EICRx_BIT (~(_BV(ISC60) | _BV(ISC61)))
- # define SERIAL_PIN_INTERRUPT INT6_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == D7
- # define EIMSK_BIT _BV(INT7)
- # define EICRx_BIT (~(_BV(ISC70) | _BV(ISC71)))
- # define SERIAL_PIN_INTERRUPT INT7_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == C7
- # define EIMSK_BIT _BV(INT4)
- # define EICRx_BIT (~(_BV(ISC40) | _BV(ISC41)))
- # define SERIAL_PIN_INTERRUPT INT4_vect
- # define EICRx EICRB
- # endif
- # endif
- # if defined(__AVR_ATmega16U4__) || defined(__AVR_ATmega32U4__)
- # if SOFT_SERIAL_PIN == E6
- # define EIMSK_BIT _BV(INT6)
- # define EICRx_BIT (~(_BV(ISC60) | _BV(ISC61)))
- # define SERIAL_PIN_INTERRUPT INT6_vect
- # define EICRx EICRB
- # endif
- # endif
- # if defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) || defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__)
- # if SOFT_SERIAL_PIN == E4
- # define EIMSK_BIT _BV(INT4)
- # define EICRx_BIT (~(_BV(ISC40) | _BV(ISC41)))
- # define SERIAL_PIN_INTERRUPT INT4_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == E5
- # define EIMSK_BIT _BV(INT5)
- # define EICRx_BIT (~(_BV(ISC50) | _BV(ISC51)))
- # define SERIAL_PIN_INTERRUPT INT5_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == E6
- # define EIMSK_BIT _BV(INT6)
- # define EICRx_BIT (~(_BV(ISC60) | _BV(ISC61)))
- # define SERIAL_PIN_INTERRUPT INT6_vect
- # define EICRx EICRB
- # elif SOFT_SERIAL_PIN == E7
- # define EIMSK_BIT _BV(INT7)
- # define EICRx_BIT (~(_BV(ISC70) | _BV(ISC71)))
- # define SERIAL_PIN_INTERRUPT INT7_vect
- # define EICRx EICRB
- # endif
- # endif
- # ifndef SERIAL_PIN_INTERRUPT
- # error invalid SOFT_SERIAL_PIN value
- # endif
- # define setPinInputHigh(pin) (DDRx_ADDRESS(pin) &= ~_BV((pin)&0xF), PORTx_ADDRESS(pin) |= _BV((pin)&0xF))
- # define setPinOutput(pin) (DDRx_ADDRESS(pin) |= _BV((pin)&0xF))
- # define writePinHigh(pin) (PORTx_ADDRESS(pin) |= _BV((pin)&0xF))
- # define writePinLow(pin) (PORTx_ADDRESS(pin) &= ~_BV((pin)&0xF))
- # define readPin(pin) ((bool)(PINx_ADDRESS(pin) & _BV((pin)&0xF)))
- # define ALWAYS_INLINE __attribute__((always_inline))
- # define NO_INLINE __attribute__((noinline))
- # define _delay_sub_us(x) __builtin_avr_delay_cycles(x)
- # define ODD_PARITY 1
- # define EVEN_PARITY 0
- # define PARITY EVEN_PARITY
- # ifdef SERIAL_DELAY
- # else
- # ifndef SELECT_SOFT_SERIAL_SPEED
- # define SELECT_SOFT_SERIAL_SPEED 1
- # endif
- # if __GNUC__ < 6
- # define TID_SEND_ADJUST 14
- # else
- # define TID_SEND_ADJUST 2
- # endif
- # if SELECT_SOFT_SERIAL_SPEED == 0
- # define SERIAL_DELAY 4
- # if __GNUC__ < 6
- # define READ_WRITE_START_ADJUST 33
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_START_ADJUST 34
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # elif SELECT_SOFT_SERIAL_SPEED == 1
- # define SERIAL_DELAY 6
- # if __GNUC__ < 6
- # define READ_WRITE_START_ADJUST 30
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_START_ADJUST 33
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # elif SELECT_SOFT_SERIAL_SPEED == 2
- # define SERIAL_DELAY 12
- # define READ_WRITE_START_ADJUST 30
- # if __GNUC__ < 6
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # elif SELECT_SOFT_SERIAL_SPEED == 3
- # define SERIAL_DELAY 24
- # define READ_WRITE_START_ADJUST 30
- # if __GNUC__ < 6
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # elif SELECT_SOFT_SERIAL_SPEED == 4
- # define SERIAL_DELAY 36
- # define READ_WRITE_START_ADJUST 30
- # if __GNUC__ < 6
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # elif SELECT_SOFT_SERIAL_SPEED == 5
- # define SERIAL_DELAY 48
- # define READ_WRITE_START_ADJUST 30
- # if __GNUC__ < 6
- # define READ_WRITE_WIDTH_ADJUST 3
- # else
- # define READ_WRITE_WIDTH_ADJUST 7
- # endif
- # else
- # error invalid SELECT_SOFT_SERIAL_SPEED value
- # endif
- # endif
- # define SERIAL_DELAY_HALF1 (SERIAL_DELAY / 2)
- # define SERIAL_DELAY_HALF2 (SERIAL_DELAY - SERIAL_DELAY / 2)
- # define SLAVE_INT_WIDTH_US 1
- # define SLAVE_INT_ACK_WIDTH_UNIT 2
- # define SLAVE_INT_ACK_WIDTH 4
- inline static void serial_delay(void) ALWAYS_INLINE;
- inline static void serial_delay(void) { _delay_us(SERIAL_DELAY); }
- inline static void serial_delay_half1(void) ALWAYS_INLINE;
- inline static void serial_delay_half1(void) { _delay_us(SERIAL_DELAY_HALF1); }
- inline static void serial_delay_half2(void) ALWAYS_INLINE;
- inline static void serial_delay_half2(void) { _delay_us(SERIAL_DELAY_HALF2); }
- inline static void serial_output(void) ALWAYS_INLINE;
- inline static void serial_output(void) { setPinOutput(SOFT_SERIAL_PIN); }
- inline static void serial_input_with_pullup(void) ALWAYS_INLINE;
- inline static void serial_input_with_pullup(void) { setPinInputHigh(SOFT_SERIAL_PIN); }
- inline static uint8_t serial_read_pin(void) ALWAYS_INLINE;
- inline static uint8_t serial_read_pin(void) { return !!readPin(SOFT_SERIAL_PIN); }
- inline static void serial_low(void) ALWAYS_INLINE;
- inline static void serial_low(void) { writePinLow(SOFT_SERIAL_PIN); }
- inline static void serial_high(void) ALWAYS_INLINE;
- inline static void serial_high(void) { writePinHigh(SOFT_SERIAL_PIN); }
- void soft_serial_initiator_init(void) {
- serial_output();
- serial_high();
- }
- void soft_serial_target_init(void) {
- serial_input_with_pullup();
-
- EIMSK |= EIMSK_BIT;
- EICRx &= EICRx_BIT;
- }
- static void sync_recv(void) NO_INLINE;
- static void sync_recv(void) {
- for (uint8_t i = 0; i < SERIAL_DELAY * 5 && serial_read_pin(); i++) {
- }
-
-
- while (!serial_read_pin())
- ;
- }
- static void sync_send(void) NO_INLINE;
- static void sync_send(void) {
- serial_low();
- serial_delay();
- serial_high();
- }
- static uint8_t serial_read_chunk(uint8_t *pterrcount, uint8_t bit) NO_INLINE;
- static uint8_t serial_read_chunk(uint8_t *pterrcount, uint8_t bit) {
- uint8_t byte, i, p, pb;
- _delay_sub_us(READ_WRITE_START_ADJUST);
- for (i = 0, byte = 0, p = PARITY; i < bit; i++) {
- serial_delay_half1();
- if (serial_read_pin()) {
- byte = (byte << 1) | 1;
- p ^= 1;
- } else {
- byte = (byte << 1) | 0;
- p ^= 0;
- }
- _delay_sub_us(READ_WRITE_WIDTH_ADJUST);
- serial_delay_half2();
- }
-
- serial_delay_half1();
- pb = serial_read_pin();
- _delay_sub_us(READ_WRITE_WIDTH_ADJUST);
- serial_delay_half2();
- *pterrcount += (p != pb) ? 1 : 0;
- return byte;
- }
- void serial_write_chunk(uint8_t data, uint8_t bit) NO_INLINE;
- void serial_write_chunk(uint8_t data, uint8_t bit) {
- uint8_t b, p;
- for (p = PARITY, b = 1 << (bit - 1); b; b >>= 1) {
- if (data & b) {
- serial_high();
- p ^= 1;
- } else {
- serial_low();
- p ^= 0;
- }
- serial_delay();
- }
-
- if (p & 1) {
- serial_high();
- } else {
- serial_low();
- }
- serial_delay();
- serial_low();
- }
- static void serial_send_packet(uint8_t *buffer, uint8_t size) NO_INLINE;
- static void serial_send_packet(uint8_t *buffer, uint8_t size) {
- for (uint8_t i = 0; i < size; ++i) {
- uint8_t data;
- data = buffer[i];
- sync_send();
- serial_write_chunk(data, 8);
- }
- }
- static uint8_t serial_recive_packet(uint8_t *buffer, uint8_t size) NO_INLINE;
- static uint8_t serial_recive_packet(uint8_t *buffer, uint8_t size) {
- uint8_t pecount = 0;
- for (uint8_t i = 0; i < size; ++i) {
- uint8_t data;
- sync_recv();
- data = serial_read_chunk(&pecount, 8);
- buffer[i] = data;
- }
- return pecount == 0;
- }
- inline static void change_sender2reciver(void) {
- sync_send();
- serial_delay_half1();
- serial_low();
- serial_input_with_pullup();
- serial_delay_half1();
- }
- inline static void change_reciver2sender(void) {
- sync_recv();
- serial_delay();
- serial_low();
- serial_output();
- serial_delay_half1();
- }
- static inline uint8_t nibble_bits_count(uint8_t bits) {
- bits = (bits & 0x5) + (bits >> 1 & 0x5);
- bits = (bits & 0x3) + (bits >> 2 & 0x3);
- return bits;
- }
- ISR(SERIAL_PIN_INTERRUPT) {
-
- uint8_t tid, bits;
- uint8_t pecount = 0;
- sync_recv();
- bits = serial_read_chunk(&pecount, 8);
- tid = bits >> 3;
- bits = (bits & 7) != (nibble_bits_count(tid) & 7);
- if (bits || pecount > 0 || tid > NUM_TOTAL_TRANSACTIONS) {
- return;
- }
- serial_delay_half1();
- serial_high();
- serial_output();
- _delay_sub_us(SLAVE_INT_ACK_WIDTH_UNIT * SLAVE_INT_ACK_WIDTH);
- split_transaction_desc_t *trans = &split_transaction_table[tid];
- serial_low();
-
- if (trans->slave_callback) {
- trans->slave_callback(trans->initiator2target_buffer_size, split_trans_initiator2target_buffer(trans), trans->target2initiator_buffer_size, split_trans_target2initiator_buffer(trans));
- }
-
- if (trans->target2initiator_buffer_size > 0) serial_send_packet((uint8_t *)split_trans_target2initiator_buffer(trans), trans->target2initiator_buffer_size);
-
- change_sender2reciver();
-
- if (trans->initiator2target_buffer_size > 0) {
- if (serial_recive_packet((uint8_t *)split_trans_initiator2target_buffer(trans), trans->initiator2target_buffer_size)) {
- *trans->status = TRANSACTION_ACCEPTED;
- } else {
- *trans->status = TRANSACTION_DATA_ERROR;
- }
- } else {
- *trans->status = TRANSACTION_ACCEPTED;
- }
- sync_recv();
- }
- int soft_serial_transaction(int sstd_index) {
- if (sstd_index > NUM_TOTAL_TRANSACTIONS) return TRANSACTION_TYPE_ERROR;
- split_transaction_desc_t *trans = &split_transaction_table[sstd_index];
- if (!trans->status) return TRANSACTION_TYPE_ERROR;
- cli();
-
- serial_output();
- serial_low();
- _delay_us(SLAVE_INT_WIDTH_US);
-
- int tid = (sstd_index << 3) | (7 & nibble_bits_count(sstd_index));
- sync_send();
- _delay_sub_us(TID_SEND_ADJUST);
- serial_write_chunk(tid, 8);
- serial_delay_half1();
-
- serial_input_with_pullup();
- while (!serial_read_pin()) {
- _delay_sub_us(2);
- }
-
- for (int i = 0; serial_read_pin(); i++) {
- if (i > SLAVE_INT_ACK_WIDTH + 1) {
-
- serial_output();
- serial_high();
- *trans->status = TRANSACTION_NO_RESPONSE;
- sei();
- return TRANSACTION_NO_RESPONSE;
- }
- _delay_sub_us(SLAVE_INT_ACK_WIDTH_UNIT);
- }
-
-
- if (trans->target2initiator_buffer_size > 0) {
- if (!serial_recive_packet((uint8_t *)split_trans_target2initiator_buffer(trans), trans->target2initiator_buffer_size)) {
- serial_output();
- serial_high();
- *trans->status = TRANSACTION_DATA_ERROR;
- sei();
- return TRANSACTION_DATA_ERROR;
- }
- }
-
- change_reciver2sender();
-
- if (trans->initiator2target_buffer_size > 0) {
- serial_send_packet((uint8_t *)split_trans_initiator2target_buffer(trans), trans->initiator2target_buffer_size);
- }
-
- sync_send();
- *trans->status = TRANSACTION_END;
- sei();
- return TRANSACTION_END;
- }
- int soft_serial_get_and_clean_status(int sstd_index) {
- split_transaction_desc_t *trans = &split_transaction_table[sstd_index];
- cli();
- int retval = *trans->status;
- *trans->status = 0;
- ;
- sei();
- return retval;
- }
- #endif
|