72 lines
1.7 KiB
C++
72 lines
1.7 KiB
C++
#ifdef HAS_SPI
|
|
|
|
#include "spisend.h"
|
|
|
|
// Local logging tag
|
|
static const char TAG[] = "main";
|
|
|
|
MessageBuffer_t SendBuffer;
|
|
|
|
QueueHandle_t SPISendQueue;
|
|
TaskHandle_t SpiTask;
|
|
|
|
// SPI feed Task
|
|
void spi_loop(void *pvParameters) {
|
|
|
|
uint8_t buf[32];
|
|
|
|
configASSERT(((uint32_t)pvParameters) == 1); // FreeRTOS check
|
|
|
|
while (1) {
|
|
// check if data to send on SPI interface
|
|
if (xQueueReceive(SPISendQueue, &SendBuffer, (TickType_t)0) == pdTRUE) {
|
|
hal_spi_write(SendBuffer.MessagePort, SendBuffer.Message,
|
|
SendBuffer.MessageSize);
|
|
ESP_LOGI(TAG, "%d bytes sent to SPI", SendBuffer.MessageSize);
|
|
}
|
|
|
|
// check if command is received on SPI command port, then call interpreter
|
|
hal_spi_read(RCMDPORT, buf, 32);
|
|
if (buf[0])
|
|
rcommand(buf, sizeof(buf));
|
|
|
|
vTaskDelay(2 / portTICK_PERIOD_MS); // yield to CPU
|
|
} // end of infinite loop
|
|
|
|
vTaskDelete(NULL); // shoud never be reached
|
|
|
|
} // spi_loop()
|
|
|
|
// SPI hardware abstraction layer
|
|
|
|
void hal_spi_init() { SPI.begin(SCK, MISO, MOSI, SS); }
|
|
|
|
void hal_spi_trx(uint8_t port, uint8_t *buf, int len, uint8_t is_read) {
|
|
|
|
SPISettings settings(1E6, MSBFIRST, SPI_MODE0);
|
|
SPI.beginTransaction(settings);
|
|
digitalWrite(SS, 0);
|
|
|
|
SPI.transfer(port);
|
|
|
|
for (uint8_t i = 0; i < len; i++) {
|
|
uint8_t *p = buf + i;
|
|
uint8_t data = is_read ? 0x00 : *p;
|
|
data = SPI.transfer(data);
|
|
if (is_read)
|
|
*p = data;
|
|
}
|
|
|
|
digitalWrite(SS, 1);
|
|
SPI.endTransaction();
|
|
}
|
|
|
|
void hal_spi_write(uint8_t port, const uint8_t *buf, int len) {
|
|
hal_spi_trx(port, (uint8_t *)buf, len, 0);
|
|
}
|
|
|
|
void hal_spi_read(uint8_t port, uint8_t *buf, int len) {
|
|
hal_spi_trx(port, buf, len, 1);
|
|
}
|
|
|
|
#endif // HAS_SPI
|