|
|
|
@ -9,7 +9,8 @@ using namespace Pinetime::Drivers;
|
|
|
|
|
|
|
|
|
|
SpiMaster::SpiMaster(const SpiMaster::SpiModule spi, const SpiMaster::Parameters ¶ms) :
|
|
|
|
|
spi{spi}, params{params} {
|
|
|
|
|
|
|
|
|
|
mutex = xSemaphoreCreateBinary();
|
|
|
|
|
ASSERT(mutex != NULL);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool SpiMaster::Init() {
|
|
|
|
@ -67,6 +68,8 @@ bool SpiMaster::Init() {
|
|
|
|
|
|
|
|
|
|
NRFX_IRQ_PRIORITY_SET(SPIM0_SPIS0_TWIM0_TWIS0_SPI0_TWI0_IRQn,2);
|
|
|
|
|
NRFX_IRQ_ENABLE(SPIM0_SPIS0_TWIM0_TWIS0_SPI0_TWI0_IRQn);
|
|
|
|
|
|
|
|
|
|
xSemaphoreGive(mutex);
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@ -93,13 +96,17 @@ void SpiMaster::DisableWorkaroundForFtpan58(NRF_SPIM_Type *spim, uint32_t ppi_ch
|
|
|
|
|
NRF_PPI->CH[ppi_channel].EEP = 0;
|
|
|
|
|
NRF_PPI->CH[ppi_channel].TEP = 0;
|
|
|
|
|
NRF_PPI->CHENSET = ppi_channel;
|
|
|
|
|
spiBaseAddress->EVENTS_END = 0;
|
|
|
|
|
spim->INTENSET = (1<<6);
|
|
|
|
|
spim->INTENSET = (1<<1);
|
|
|
|
|
spim->INTENSET = (1<<19);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SpiMaster::OnEndEvent() {
|
|
|
|
|
if(!busy) return;
|
|
|
|
|
if(currentBufferAddr == 0) {
|
|
|
|
|
asm("nop");
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
auto s = currentBufferSize;
|
|
|
|
|
if(s > 0) {
|
|
|
|
@ -112,7 +119,7 @@ void SpiMaster::OnEndEvent() {
|
|
|
|
|
} else {
|
|
|
|
|
uint8_t* buffer = nullptr;
|
|
|
|
|
size_t size = 0;
|
|
|
|
|
busy = false;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if(taskToNotify != nullptr) {
|
|
|
|
@ -122,11 +129,14 @@ void SpiMaster::OnEndEvent() {
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
nrf_gpio_pin_set(this->pinCsn);
|
|
|
|
|
currentBufferAddr = 0;
|
|
|
|
|
BaseType_t xHigherPriorityTaskWoken = pdFALSE;
|
|
|
|
|
xSemaphoreGiveFromISR(mutex, &xHigherPriorityTaskWoken);
|
|
|
|
|
portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SpiMaster::OnStartedEvent() {
|
|
|
|
|
if(!busy) return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SpiMaster::PrepareTx(const volatile uint32_t bufferAddress, const volatile size_t size) {
|
|
|
|
@ -139,7 +149,7 @@ void SpiMaster::PrepareTx(const volatile uint32_t bufferAddress, const volatile
|
|
|
|
|
spiBaseAddress->EVENTS_END = 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SpiMaster::PrepareRx(const volatile uint32_t bufferAddress, const volatile size_t size) {
|
|
|
|
|
void SpiMaster::PrepareRx(const volatile uint32_t cmdAddress, const volatile size_t cmdSize, const volatile uint32_t bufferAddress, const volatile size_t size) {
|
|
|
|
|
spiBaseAddress->TXD.PTR = 0;
|
|
|
|
|
spiBaseAddress->TXD.MAXCNT = 0;
|
|
|
|
|
spiBaseAddress->TXD.LIST = 0;
|
|
|
|
@ -152,10 +162,10 @@ void SpiMaster::PrepareRx(const volatile uint32_t bufferAddress, const volatile
|
|
|
|
|
|
|
|
|
|
bool SpiMaster::Write(uint8_t pinCsn, const uint8_t *data, size_t size) {
|
|
|
|
|
if(data == nullptr) return false;
|
|
|
|
|
auto ok = xSemaphoreTake(mutex, portMAX_DELAY);
|
|
|
|
|
ASSERT(ok == true);
|
|
|
|
|
taskToNotify = xTaskGetCurrentTaskHandle();
|
|
|
|
|
while(busy) {
|
|
|
|
|
asm("nop");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
this->pinCsn = pinCsn;
|
|
|
|
|
|
|
|
|
@ -169,7 +179,6 @@ bool SpiMaster::Write(uint8_t pinCsn, const uint8_t *data, size_t size) {
|
|
|
|
|
|
|
|
|
|
currentBufferAddr = (uint32_t)data;
|
|
|
|
|
currentBufferSize = size;
|
|
|
|
|
busy = true;
|
|
|
|
|
|
|
|
|
|
auto currentSize = std::min((size_t)255, (size_t)currentBufferSize);
|
|
|
|
|
PrepareTx(currentBufferAddr, currentSize);
|
|
|
|
@ -179,34 +188,42 @@ bool SpiMaster::Write(uint8_t pinCsn, const uint8_t *data, size_t size) {
|
|
|
|
|
|
|
|
|
|
if(size == 1) {
|
|
|
|
|
while (spiBaseAddress->EVENTS_END == 0);
|
|
|
|
|
busy = false;
|
|
|
|
|
nrf_gpio_pin_set(this->pinCsn);
|
|
|
|
|
currentBufferAddr = 0;
|
|
|
|
|
xSemaphoreGive(mutex);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool SpiMaster::Read(uint8_t pinCsn, uint8_t *data, size_t size) {
|
|
|
|
|
while(busy) {
|
|
|
|
|
asm("nop");
|
|
|
|
|
}
|
|
|
|
|
bool SpiMaster::Read(uint8_t pinCsn, uint8_t* cmd, size_t cmdSize, uint8_t *data, size_t dataSize) {
|
|
|
|
|
xSemaphoreTake(mutex, portMAX_DELAY);
|
|
|
|
|
|
|
|
|
|
taskToNotify = nullptr;
|
|
|
|
|
|
|
|
|
|
this->pinCsn = pinCsn;
|
|
|
|
|
SetupWorkaroundForFtpan58(spiBaseAddress, 0,0);
|
|
|
|
|
DisableWorkaroundForFtpan58(spiBaseAddress, 0,0);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<6);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<1);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<19);
|
|
|
|
|
|
|
|
|
|
nrf_gpio_pin_clear(this->pinCsn);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
currentBufferAddr = 0;
|
|
|
|
|
currentBufferSize = 0;
|
|
|
|
|
busy = true;
|
|
|
|
|
|
|
|
|
|
PrepareRx((uint32_t)data, size);
|
|
|
|
|
PrepareTx((uint32_t)cmd, cmdSize);
|
|
|
|
|
spiBaseAddress->TASKS_START = 1;
|
|
|
|
|
while (spiBaseAddress->EVENTS_END == 0);
|
|
|
|
|
|
|
|
|
|
PrepareRx((uint32_t)cmd, cmdSize, (uint32_t)data, dataSize);
|
|
|
|
|
spiBaseAddress->TASKS_START = 1;
|
|
|
|
|
|
|
|
|
|
while (spiBaseAddress->EVENTS_END == 0);
|
|
|
|
|
nrf_gpio_pin_set(this->pinCsn);
|
|
|
|
|
|
|
|
|
|
busy = false;
|
|
|
|
|
xSemaphoreGive(mutex);
|
|
|
|
|
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
@ -225,5 +242,37 @@ void SpiMaster::Wakeup() {
|
|
|
|
|
Init();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool SpiMaster::WriteCmdAndBuffer(uint8_t pinCsn, uint8_t *cmd, size_t cmdSize, uint8_t *data, size_t dataSize) {
|
|
|
|
|
xSemaphoreTake(mutex, portMAX_DELAY);
|
|
|
|
|
|
|
|
|
|
taskToNotify = nullptr;
|
|
|
|
|
|
|
|
|
|
this->pinCsn = pinCsn;
|
|
|
|
|
DisableWorkaroundForFtpan58(spiBaseAddress, 0,0);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<6);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<1);
|
|
|
|
|
spiBaseAddress->INTENCLR = (1<<19);
|
|
|
|
|
|
|
|
|
|
nrf_gpio_pin_clear(this->pinCsn);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
currentBufferAddr = 0;
|
|
|
|
|
currentBufferSize = 0;
|
|
|
|
|
|
|
|
|
|
PrepareTx((uint32_t)cmd, cmdSize);
|
|
|
|
|
spiBaseAddress->TASKS_START = 1;
|
|
|
|
|
while (spiBaseAddress->EVENTS_END == 0);
|
|
|
|
|
|
|
|
|
|
PrepareTx((uint32_t)data, dataSize);
|
|
|
|
|
spiBaseAddress->TASKS_START = 1;
|
|
|
|
|
|
|
|
|
|
while (spiBaseAddress->EVENTS_END == 0);
|
|
|
|
|
nrf_gpio_pin_set(this->pinCsn);
|
|
|
|
|
|
|
|
|
|
xSemaphoreGive(mutex);
|
|
|
|
|
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|