alif/machine_spi: Improve transfer function to poll events.
Poll events during SPI transfer (USB fails during long transfers otherwise). And add a timeout for the blocking transfer. Signed-off-by: iabdalkader <i.abdalkader@gmail.com>
This commit is contained in:
parent
4a1edc4866
commit
16f9d7fdc3
1 changed files with 46 additions and 14 deletions
|
|
@ -39,6 +39,7 @@ typedef struct _machine_spi_obj_t {
|
||||||
uint8_t id;
|
uint8_t id;
|
||||||
SPI_Type *inst;
|
SPI_Type *inst;
|
||||||
bool is_lp;
|
bool is_lp;
|
||||||
|
uint32_t bits;
|
||||||
} machine_spi_obj_t;
|
} machine_spi_obj_t;
|
||||||
|
|
||||||
static machine_spi_obj_t machine_spi_obj[] = {
|
static machine_spi_obj_t machine_spi_obj[] = {
|
||||||
|
|
@ -246,6 +247,9 @@ mp_obj_t machine_spi_make_new(const mp_obj_type_t *type, size_t n_args, size_t n
|
||||||
// Get static peripheral object.
|
// Get static peripheral object.
|
||||||
machine_spi_obj_t *self = &machine_spi_obj[spi_id];
|
machine_spi_obj_t *self = &machine_spi_obj[spi_id];
|
||||||
|
|
||||||
|
// Set args
|
||||||
|
self->bits = args[ARG_bits].u_int;
|
||||||
|
|
||||||
// here we would check the sck/mosi/miso pins and configure them, but it's not implemented
|
// here we would check the sck/mosi/miso pins and configure them, but it's not implemented
|
||||||
if (args[ARG_sck].u_obj != MP_OBJ_NULL ||
|
if (args[ARG_sck].u_obj != MP_OBJ_NULL ||
|
||||||
args[ARG_mosi].u_obj != MP_OBJ_NULL ||
|
args[ARG_mosi].u_obj != MP_OBJ_NULL ||
|
||||||
|
|
@ -294,22 +298,50 @@ static void machine_spi_deinit(mp_obj_base_t *self_in) {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void machine_spi_poll_flag(SPI_Type *spi, uint32_t flag, uint32_t timeout) {
|
||||||
|
mp_uint_t tick_start = mp_hal_ticks_ms();
|
||||||
|
while (!(spi->SPI_SR & flag)) {
|
||||||
|
if (mp_hal_ticks_ms() - tick_start >= timeout) {
|
||||||
|
mp_raise_OSError(MP_ETIMEDOUT);
|
||||||
|
}
|
||||||
|
mp_event_handle_nowait();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
static void machine_spi_transfer(mp_obj_base_t *self_in, size_t len, const uint8_t *src, uint8_t *dest) {
|
static void machine_spi_transfer(mp_obj_base_t *self_in, size_t len, const uint8_t *src, uint8_t *dest) {
|
||||||
machine_spi_obj_t *self = (machine_spi_obj_t *)self_in;
|
machine_spi_obj_t *self = (machine_spi_obj_t *)self_in;
|
||||||
spi_transfer_t spi_xfer = {
|
volatile uint32_t *dr = self->inst->SPI_DR;
|
||||||
.tx_buff = src,
|
|
||||||
.tx_total_cnt = len,
|
spi_set_tmod(self->inst, SPI_TMOD_TX_AND_RX);
|
||||||
.rx_buff = dest,
|
|
||||||
.rx_total_cnt = len,
|
for (size_t i = 0; i < len; i++) {
|
||||||
.tx_default_val = 0xFF,
|
// Wait for space in the TX FIFO
|
||||||
.tx_default_enable = true,
|
machine_spi_poll_flag(self->inst, SPI_SR_TFNF, 100);
|
||||||
.mode = SPI_TMOD_TX_AND_RX,
|
|
||||||
};
|
// Send data
|
||||||
// TODO redo transfer_blocking to timeout and poll events.
|
if (src == NULL) {
|
||||||
if (!self->is_lp) {
|
*dr = 0xFFFFFFFFU;
|
||||||
spi_transfer_blocking(self->inst, &spi_xfer);
|
} else if (self->bits > 16) {
|
||||||
} else {
|
*dr = ((uint32_t *)src)[i];
|
||||||
lpspi_transfer_blocking(self->inst, &spi_xfer);
|
} else if (self->bits > 8) {
|
||||||
|
*dr = ((uint16_t *)src)[i];
|
||||||
|
} else {
|
||||||
|
*dr = ((uint8_t *)src)[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Wait for data in the RX FIFO
|
||||||
|
machine_spi_poll_flag(self->inst, SPI_SR_RFNE, 100);
|
||||||
|
|
||||||
|
// Recv data
|
||||||
|
if (dest == NULL) {
|
||||||
|
(void)*dr;
|
||||||
|
} else if (self->bits > 16) {
|
||||||
|
((uint32_t *)dest)[i] = *dr;
|
||||||
|
} else if (self->bits > 8) {
|
||||||
|
((uint16_t *)dest)[i] = *dr;
|
||||||
|
} else {
|
||||||
|
((uint8_t *)dest)[i] = *dr;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue