2021-05-27 05:37:54 +02:00
/* Copyright 2021 QMK
*
* This program is free software : you can redistribute it and / or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation , either version 3 of the License , or
* ( at your option ) any later version .
*
* This program is distributed in the hope that it will be useful ,
* but WITHOUT ANY WARRANTY ; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE . See the
* GNU General Public License for more details .
*
* You should have received a copy of the GNU General Public License
* along with this program . If not , see < http : //www.gnu.org/licenses/>.
*/
2020-05-21 19:00:21 +02:00
2021-05-27 05:37:54 +02:00
# include "serial_usart.h"
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
# if defined(SERIAL_USART_CONFIG)
static SerialConfig serial_config = SERIAL_USART_CONFIG ;
# else
static SerialConfig serial_config = {
. speed = ( SERIAL_USART_SPEED ) , /* speed - mandatory */
. cr1 = ( SERIAL_USART_CR1 ) ,
. cr2 = ( SERIAL_USART_CR2 ) ,
# if !defined(SERIAL_USART_FULL_DUPLEX)
. cr3 = ( ( SERIAL_USART_CR3 ) | USART_CR3_HDSEL ) /* activate half-duplex mode */
# else
. cr3 = ( SERIAL_USART_CR3 )
2020-05-21 19:00:21 +02:00
# endif
2021-07-02 00:24:08 +02:00
} ;
2020-05-21 19:00:21 +02:00
# endif
2021-07-02 00:24:08 +02:00
static SerialDriver * serial_driver = & SERIAL_USART_DRIVER ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
static inline bool react_to_transactions ( void ) ;
static inline bool __attribute__ ( ( nonnull ) ) receive ( uint8_t * destination , const size_t size ) ;
static inline bool __attribute__ ( ( nonnull ) ) send ( const uint8_t * source , const size_t size ) ;
2022-01-27 06:13:27 +01:00
static inline bool initiate_transaction ( uint8_t sstd_index ) ;
2021-07-02 00:24:08 +02:00
static inline void usart_clear ( void ) ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/**
* @ brief Clear the receive input queue .
*/
static inline void usart_clear ( void ) {
osalSysLock ( ) ;
bool volatile queue_not_empty = ! iqIsEmptyI ( & serial_driver - > iqueue ) ;
osalSysUnlock ( ) ;
while ( queue_not_empty ) {
osalSysLock ( ) ;
/* Hard reset the input queue. */
iqResetI ( & serial_driver - > iqueue ) ;
osalSysUnlock ( ) ;
/* Allow pending interrupts to preempt.
* Do not merge the lock / unlock blocks into one
* or the code will not work properly .
* The empty read adds a tiny amount of delay . */
( void ) queue_not_empty ;
osalSysLock ( ) ;
queue_not_empty = ! iqIsEmptyI ( & serial_driver - > iqueue ) ;
osalSysUnlock ( ) ;
}
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/**
* @ brief Blocking send of buffer with timeout .
*
* @ return true Send success .
* @ return false Send failed .
*/
static inline bool send ( const uint8_t * source , const size_t size ) {
bool success = ( size_t ) sdWriteTimeout ( serial_driver , source , size , TIME_MS2I ( SERIAL_USART_TIMEOUT ) ) = = size ;
# if !defined(SERIAL_USART_FULL_DUPLEX)
if ( success ) {
/* Half duplex fills the input queue with the data we wrote - just throw it away.
Under the right circumstances ( e . g . bad cables paired with high baud rates )
less bytes can be present in the input queue , therefore a timeout is needed . */
uint8_t dump [ size ] ;
return receive ( dump , size ) ;
}
# endif
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
return success ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/**
* @ brief Blocking receive of size * bytes with timeout .
*
* @ return true Receive success .
* @ return false Receive failed .
*/
static inline bool receive ( uint8_t * destination , const size_t size ) {
bool success = ( size_t ) sdReadTimeout ( serial_driver , destination , size , TIME_MS2I ( SERIAL_USART_TIMEOUT ) ) = = size ;
return success ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
# if !defined(SERIAL_USART_FULL_DUPLEX)
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/**
* @ brief Initiate pins for USART peripheral . Half - duplex configuration .
2020-05-21 19:00:21 +02:00
*/
2021-07-02 00:24:08 +02:00
__attribute__ ( ( weak ) ) void usart_init ( void ) {
# if defined(MCU_STM32)
# if defined(USE_GPIOV1)
2021-09-15 03:19:51 +02:00
palSetLineMode ( SERIAL_USART_TX_PIN , PAL_MODE_ALTERNATE_OPENDRAIN ) ;
2021-07-02 00:24:08 +02:00
# else
2021-09-16 00:18:58 +02:00
palSetLineMode ( SERIAL_USART_TX_PIN , PAL_MODE_ALTERNATE ( SERIAL_USART_TX_PAL_MODE ) | PAL_OUTPUT_TYPE_OPENDRAIN ) ;
2021-07-02 00:24:08 +02:00
# endif
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
# if defined(USART_REMAP)
USART_REMAP ;
# endif
# else
# pragma message "usart_init: MCU Familiy not supported by default, please supply your own init code by implementing usart_init() in your keyboard files."
# endif
2020-05-21 19:00:21 +02:00
}
# else
2021-05-27 05:37:54 +02:00
2021-07-02 00:24:08 +02:00
/**
* @ brief Initiate pins for USART peripheral . Full - duplex configuration .
*/
__attribute__ ( ( weak ) ) void usart_init ( void ) {
# if defined(MCU_STM32)
# if defined(USE_GPIOV1)
2021-09-15 03:19:51 +02:00
palSetLineMode ( SERIAL_USART_TX_PIN , PAL_MODE_ALTERNATE_PUSHPULL ) ;
2021-07-02 00:24:08 +02:00
palSetLineMode ( SERIAL_USART_RX_PIN , PAL_MODE_INPUT ) ;
# else
2021-09-16 00:18:58 +02:00
palSetLineMode ( SERIAL_USART_TX_PIN , PAL_MODE_ALTERNATE ( SERIAL_USART_TX_PAL_MODE ) | PAL_OUTPUT_TYPE_PUSHPULL | PAL_OUTPUT_SPEED_HIGHEST ) ;
palSetLineMode ( SERIAL_USART_RX_PIN , PAL_MODE_ALTERNATE ( SERIAL_USART_RX_PAL_MODE ) | PAL_OUTPUT_TYPE_PUSHPULL | PAL_OUTPUT_SPEED_HIGHEST ) ;
2021-07-02 00:24:08 +02:00
# endif
# if defined(USART_REMAP)
2021-05-27 05:37:54 +02:00
USART_REMAP ;
2021-07-02 00:24:08 +02:00
# endif
# else
# pragma message "usart_init: MCU Familiy not supported by default, please supply your own init code by implementing usart_init() in your keyboard files."
# endif
}
2021-05-27 05:37:54 +02:00
# endif
2021-07-02 00:24:08 +02:00
/**
* @ brief Overridable master specific initializations .
*/
__attribute__ ( ( weak , nonnull ) ) void usart_master_init ( SerialDriver * * driver ) {
( void ) driver ;
usart_init ( ) ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/**
* @ brief Overridable slave specific initializations .
*/
__attribute__ ( ( weak , nonnull ) ) void usart_slave_init ( SerialDriver * * driver ) {
( void ) driver ;
2020-05-21 19:00:21 +02:00
usart_init ( ) ;
2021-07-02 00:24:08 +02:00
}
/**
* @ brief This thread runs on the slave and responds to transactions initiated
* by the master .
*/
static THD_WORKING_AREA ( waSlaveThread , 1024 ) ;
static THD_FUNCTION ( SlaveThread , arg ) {
( void ) arg ;
chRegSetThreadName ( " usart_tx_rx " ) ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
while ( true ) {
if ( ! react_to_transactions ( ) ) {
/* Clear the receive queue, to start with a clean slate.
* Parts of failed transactions or spurious bytes could still be in it . */
usart_clear ( ) ;
}
}
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/**
* @ brief Slave specific initializations .
*/
void soft_serial_target_init ( void ) {
usart_slave_init ( & serial_driver ) ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
sdStart ( serial_driver , & serial_config ) ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/* Start transport thread. */
2020-05-21 19:00:21 +02:00
chThdCreateStatic ( waSlaveThread , sizeof ( waSlaveThread ) , HIGHPRIO , SlaveThread , NULL ) ;
}
2021-07-02 00:24:08 +02:00
/**
* @ brief React to transactions started by the master .
*/
static inline bool react_to_transactions ( void ) {
/* Wait until there is a transaction for us. */
uint8_t sstd_index = ( uint8_t ) sdGet ( serial_driver ) ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/* Sanity check that we are actually responding to a valid transaction. */
if ( sstd_index > = NUM_TOTAL_TRANSACTIONS ) {
return false ;
}
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
split_transaction_desc_t * trans = & split_transaction_table [ sstd_index ] ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/* Send back the handshake which is XORed as a simple checksum,
to signal that the slave is ready to receive possible transaction buffers */
2020-05-21 19:00:21 +02:00
sstd_index ^ = HANDSHAKE_MAGIC ;
2021-07-02 00:24:08 +02:00
if ( ! send ( & sstd_index , sizeof ( sstd_index ) ) ) {
return false ;
}
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/* Receive transaction buffer from the master. If this transaction requires it.*/
2020-05-21 19:00:21 +02:00
if ( trans - > initiator2target_buffer_size ) {
2021-07-02 00:24:08 +02:00
if ( ! receive ( split_trans_initiator2target_buffer ( trans ) , trans - > initiator2target_buffer_size ) ) {
return false ;
}
2021-06-18 01:10:06 +02:00
}
2021-07-02 00:24:08 +02:00
/* Allow any slave processing to occur. */
2021-06-18 01:10:06 +02:00
if ( trans - > slave_callback ) {
2021-07-02 00:24:08 +02:00
trans - > slave_callback ( trans - > initiator2target_buffer_size , split_trans_initiator2target_buffer ( trans ) , trans - > initiator2target_buffer_size , split_trans_target2initiator_buffer ( trans ) ) ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/* Send transaction buffer to the master. If this transaction requires it. */
2020-05-21 19:00:21 +02:00
if ( trans - > target2initiator_buffer_size ) {
2021-07-02 00:24:08 +02:00
if ( ! send ( split_trans_target2initiator_buffer ( trans ) , trans - > target2initiator_buffer_size ) ) {
return false ;
}
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
return true ;
}
/**
* @ brief Master specific initializations .
*/
void soft_serial_initiator_init ( void ) {
usart_master_init ( & serial_driver ) ;
# if defined(MCU_STM32) && defined(SERIAL_USART_PIN_SWAP)
serial_config . cr2 | = USART_CR2_SWAP ; // master has swapped TX/RX pins
# endif
sdStart ( serial_driver , & serial_config ) ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/**
* @ brief Start transaction from the master half to the slave half .
*
* @ param index Transaction Table index of the transaction to start .
2022-01-27 06:13:27 +01:00
* @ return bool Indicates success of transaction .
2021-07-02 00:24:08 +02:00
*/
2022-01-27 06:13:27 +01:00
bool soft_serial_transaction ( int index ) {
2021-07-02 00:24:08 +02:00
/* Clear the receive queue, to start with a clean slate.
* Parts of failed transactions or spurious bytes could still be in it . */
usart_clear ( ) ;
return initiate_transaction ( ( uint8_t ) index ) ;
}
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/**
* @ brief Initiate transaction to slave half .
*/
2022-01-27 06:13:27 +01:00
static inline bool initiate_transaction ( uint8_t sstd_index ) {
2021-07-02 00:24:08 +02:00
/* Sanity check that we are actually starting a valid transaction. */
if ( sstd_index > = NUM_TOTAL_TRANSACTIONS ) {
dprintln ( " USART: Illegal transaction Id. " ) ;
2022-01-27 06:13:27 +01:00
return false ;
2021-07-02 00:24:08 +02:00
}
2021-06-18 01:10:06 +02:00
2021-07-02 00:24:08 +02:00
split_transaction_desc_t * trans = & split_transaction_table [ sstd_index ] ;
2020-05-21 19:00:21 +02:00
2021-07-02 00:24:08 +02:00
/* Send transaction table index to the slave, which doubles as basic handshake token. */
if ( ! send ( & sstd_index , sizeof ( sstd_index ) ) ) {
dprintln ( " USART: Send Handshake failed. " ) ;
2022-01-27 06:13:27 +01:00
return false ;
2021-07-02 00:24:08 +02:00
}
2020-05-21 19:00:21 +02:00
uint8_t sstd_index_shake = 0xFF ;
2021-07-02 00:24:08 +02:00
/* Which we always read back first so that we can error out correctly.
* - due to the half duplex limitations on return codes , we always have to read * something * .
* - without the read , write only transactions * always * succeed , even during the boot process where the slave is not ready .
*/
if ( ! receive ( & sstd_index_shake , sizeof ( sstd_index_shake ) ) | | ( sstd_index_shake ! = ( sstd_index ^ HANDSHAKE_MAGIC ) ) ) {
dprintln ( " USART: Handshake failed. " ) ;
2022-01-27 06:13:27 +01:00
return false ;
2020-05-21 19:00:21 +02:00
}
2021-07-02 00:24:08 +02:00
/* Send transaction buffer to the slave. If this transaction requires it. */
2020-05-21 19:00:21 +02:00
if ( trans - > initiator2target_buffer_size ) {
2021-07-02 00:24:08 +02:00
if ( ! send ( split_trans_initiator2target_buffer ( trans ) , trans - > initiator2target_buffer_size ) ) {
dprintln ( " USART: Send failed. " ) ;
2022-01-27 06:13:27 +01:00
return false ;
2020-05-21 19:00:21 +02:00
}
}
2021-07-02 00:24:08 +02:00
/* Receive transaction buffer from the slave. If this transaction requires it. */
2020-05-21 19:00:21 +02:00
if ( trans - > target2initiator_buffer_size ) {
2021-07-02 00:24:08 +02:00
if ( ! receive ( split_trans_target2initiator_buffer ( trans ) , trans - > target2initiator_buffer_size ) ) {
dprintln ( " USART: Receive failed. " ) ;
2022-01-27 06:13:27 +01:00
return false ;
2020-05-21 19:00:21 +02:00
}
}
2022-01-27 06:13:27 +01:00
return true ;
2020-05-21 19:00:21 +02:00
}