Signed-off-by: Pavel Pisa <pisa@cmp.felk.cvut.cz>
break;
dr = 0;
if(msg->tx_buf) {
break;
dr = 0;
if(msg->tx_buf) {
- dr = msg->tx_buf[txcnt++];
- if(data16_fl)
- dr |= msg->rx_buf[rxcnt++] << 8;
+ dr = msg->tx_buf[txcnt++];
+ if(data16_fl)
+ dr |= msg->rx_buf[txcnt++] << 8;
+ } else {
+ txcnt += data16_fl? 2: 1;
}
lpcssp_drv->ssp_regs->DR = dr;
if(lpcssp_drv->ssp_regs->SR & SSP_SR_RNE_m)
}
lpcssp_drv->ssp_regs->DR = dr;
if(lpcssp_drv->ssp_regs->SR & SSP_SR_RNE_m)