Initial InfiniSim project
This commit is contained in:
Reinhold Gschweicher
296
sim/drivers/SpiMaster.cpp
Normal file
296
sim/drivers/SpiMaster.cpp
Normal file
@@ -0,0 +1,296 @@
|
||||
#include "drivers/SpiMaster.h"
|
||||
//#include <hal/nrf_gpio.h>
|
||||
//#include <hal/nrf_spim.h>
|
||||
#include <nrfx_log.h>
|
||||
#include <algorithm>
|
||||
|
||||
using namespace Pinetime::Drivers;
|
||||
|
||||
SpiMaster::SpiMaster(const SpiMaster::SpiModule spi, const SpiMaster::Parameters& params) : spi {spi}, params {params} {
|
||||
}
|
||||
|
||||
bool SpiMaster::Init() {
|
||||
// if(mutex == nullptr) {
|
||||
// mutex = xSemaphoreCreateBinary();
|
||||
// ASSERT(mutex != nullptr);
|
||||
// }
|
||||
//
|
||||
// /* Configure GPIO pins used for pselsck, pselmosi, pselmiso and pselss for SPI0 */
|
||||
// nrf_gpio_pin_set(params.pinSCK);
|
||||
// nrf_gpio_cfg_output(params.pinSCK);
|
||||
// nrf_gpio_pin_clear(params.pinMOSI);
|
||||
// nrf_gpio_cfg_output(params.pinMOSI);
|
||||
// nrf_gpio_cfg_input(params.pinMISO, NRF_GPIO_PIN_NOPULL);
|
||||
// // nrf_gpio_cfg_output(params.pinCSN);
|
||||
// // pinCsn = params.pinCSN;
|
||||
//
|
||||
// switch (spi) {
|
||||
// case SpiModule::SPI0:
|
||||
// spiBaseAddress = NRF_SPIM0;
|
||||
// break;
|
||||
// case SpiModule::SPI1:
|
||||
// spiBaseAddress = NRF_SPIM1;
|
||||
// break;
|
||||
// default:
|
||||
// return false;
|
||||
// }
|
||||
//
|
||||
// /* Configure pins, frequency and mode */
|
||||
// spiBaseAddress->PSELSCK = params.pinSCK;
|
||||
// spiBaseAddress->PSELMOSI = params.pinMOSI;
|
||||
// spiBaseAddress->PSELMISO = params.pinMISO;
|
||||
//
|
||||
// uint32_t frequency;
|
||||
// switch (params.Frequency) {
|
||||
// case Frequencies::Freq8Mhz:
|
||||
// frequency = 0x80000000;
|
||||
// break;
|
||||
// default:
|
||||
// return false;
|
||||
// }
|
||||
// spiBaseAddress->FREQUENCY = frequency;
|
||||
//
|
||||
// uint32_t regConfig = 0;
|
||||
// switch (params.bitOrder) {
|
||||
// case BitOrder::Msb_Lsb:
|
||||
// break;
|
||||
// case BitOrder::Lsb_Msb:
|
||||
// regConfig = 1;
|
||||
// break;
|
||||
// default:
|
||||
// return false;
|
||||
// }
|
||||
// switch (params.mode) {
|
||||
// case Modes::Mode0:
|
||||
// break;
|
||||
// case Modes::Mode1:
|
||||
// regConfig |= (0x01 << 1);
|
||||
// break;
|
||||
// case Modes::Mode2:
|
||||
// regConfig |= (0x02 << 1);
|
||||
// break;
|
||||
// case Modes::Mode3:
|
||||
// regConfig |= (0x03 << 1);
|
||||
// break;
|
||||
// default:
|
||||
// return false;
|
||||
// }
|
||||
//
|
||||
// spiBaseAddress->CONFIG = regConfig;
|
||||
// spiBaseAddress->EVENTS_ENDRX = 0;
|
||||
// spiBaseAddress->EVENTS_ENDTX = 0;
|
||||
// spiBaseAddress->EVENTS_END = 0;
|
||||
//
|
||||
// spiBaseAddress->INTENSET = ((unsigned) 1 << (unsigned) 6);
|
||||
// spiBaseAddress->INTENSET = ((unsigned) 1 << (unsigned) 1);
|
||||
// spiBaseAddress->INTENSET = ((unsigned) 1 << (unsigned) 19);
|
||||
//
|
||||
// spiBaseAddress->ENABLE = (SPIM_ENABLE_ENABLE_Enabled << SPIM_ENABLE_ENABLE_Pos);
|
||||
//
|
||||
// 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;
|
||||
}
|
||||
|
||||
//void SpiMaster::SetupWorkaroundForFtpan58(NRF_SPIM_Type* spim, uint32_t ppi_channel, uint32_t gpiote_channel) {
|
||||
// // Create an event when SCK toggles.
|
||||
// NRF_GPIOTE->CONFIG[gpiote_channel] = (GPIOTE_CONFIG_MODE_Event << GPIOTE_CONFIG_MODE_Pos) | (spim->PSEL.SCK << GPIOTE_CONFIG_PSEL_Pos) |
|
||||
// (GPIOTE_CONFIG_POLARITY_Toggle << GPIOTE_CONFIG_POLARITY_Pos);
|
||||
//
|
||||
// // Stop the spim instance when SCK toggles.
|
||||
// NRF_PPI->CH[ppi_channel].EEP = (uint32_t) &NRF_GPIOTE->EVENTS_IN[gpiote_channel];
|
||||
// NRF_PPI->CH[ppi_channel].TEP = (uint32_t) &spim->TASKS_STOP;
|
||||
// NRF_PPI->CHENSET = 1U << ppi_channel;
|
||||
// spiBaseAddress->EVENTS_END = 0;
|
||||
//
|
||||
// // Disable IRQ
|
||||
// spim->INTENCLR = (1 << 6);
|
||||
// spim->INTENCLR = (1 << 1);
|
||||
// spim->INTENCLR = (1 << 19);
|
||||
//}
|
||||
|
||||
//void SpiMaster::DisableWorkaroundForFtpan58(NRF_SPIM_Type* spim, uint32_t ppi_channel, uint32_t gpiote_channel) {
|
||||
// NRF_GPIOTE->CONFIG[gpiote_channel] = 0;
|
||||
// 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 (currentBufferAddr == 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
// auto s = currentBufferSize;
|
||||
// if (s > 0) {
|
||||
// auto currentSize = std::min((size_t) 255, s);
|
||||
// PrepareTx(currentBufferAddr, currentSize);
|
||||
// currentBufferAddr += currentSize;
|
||||
// currentBufferSize -= currentSize;
|
||||
//
|
||||
// spiBaseAddress->TASKS_START = 1;
|
||||
// } else {
|
||||
// BaseType_t xHigherPriorityTaskWoken = pdFALSE;
|
||||
// if (taskToNotify != nullptr) {
|
||||
// vTaskNotifyGiveFromISR(taskToNotify, &xHigherPriorityTaskWoken);
|
||||
// portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
|
||||
// }
|
||||
//
|
||||
// nrf_gpio_pin_set(this->pinCsn);
|
||||
// currentBufferAddr = 0;
|
||||
// BaseType_t xHigherPriorityTaskWoken2 = pdFALSE;
|
||||
// xSemaphoreGiveFromISR(mutex, &xHigherPriorityTaskWoken2);
|
||||
// portYIELD_FROM_ISR(xHigherPriorityTaskWoken | xHigherPriorityTaskWoken2);
|
||||
// }
|
||||
}
|
||||
|
||||
void SpiMaster::OnStartedEvent() {
|
||||
}
|
||||
|
||||
//void SpiMaster::PrepareTx(const volatile uint32_t bufferAddress, const volatile size_t size) {
|
||||
// spiBaseAddress->TXD.PTR = bufferAddress;
|
||||
// spiBaseAddress->TXD.MAXCNT = size;
|
||||
// spiBaseAddress->TXD.LIST = 0;
|
||||
// spiBaseAddress->RXD.PTR = 0;
|
||||
// spiBaseAddress->RXD.MAXCNT = 0;
|
||||
// spiBaseAddress->RXD.LIST = 0;
|
||||
// spiBaseAddress->EVENTS_END = 0;
|
||||
//}
|
||||
|
||||
//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;
|
||||
// spiBaseAddress->RXD.PTR = bufferAddress;
|
||||
// spiBaseAddress->RXD.MAXCNT = size;
|
||||
// spiBaseAddress->RXD.LIST = 0;
|
||||
// spiBaseAddress->EVENTS_END = 0;
|
||||
//}
|
||||
|
||||
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();
|
||||
//
|
||||
// this->pinCsn = pinCsn;
|
||||
//
|
||||
// if (size == 1) {
|
||||
// SetupWorkaroundForFtpan58(spiBaseAddress, 0, 0);
|
||||
// } else {
|
||||
// DisableWorkaroundForFtpan58(spiBaseAddress, 0, 0);
|
||||
// }
|
||||
//
|
||||
// nrf_gpio_pin_clear(this->pinCsn);
|
||||
//
|
||||
// currentBufferAddr = (uint32_t) data;
|
||||
// currentBufferSize = size;
|
||||
//
|
||||
// auto currentSize = std::min((size_t) 255, (size_t) currentBufferSize);
|
||||
// PrepareTx(currentBufferAddr, currentSize);
|
||||
// currentBufferSize -= currentSize;
|
||||
// currentBufferAddr += currentSize;
|
||||
// spiBaseAddress->TASKS_START = 1;
|
||||
//
|
||||
// if (size == 1) {
|
||||
// while (spiBaseAddress->EVENTS_END == 0)
|
||||
// ;
|
||||
// nrf_gpio_pin_set(this->pinCsn);
|
||||
// currentBufferAddr = 0;
|
||||
// xSemaphoreGive(mutex);
|
||||
// }
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
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;
|
||||
// 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)
|
||||
// ;
|
||||
//
|
||||
// PrepareRx((uint32_t) cmd, cmdSize, (uint32_t) data, dataSize);
|
||||
// spiBaseAddress->TASKS_START = 1;
|
||||
//
|
||||
// while (spiBaseAddress->EVENTS_END == 0)
|
||||
// ;
|
||||
// nrf_gpio_pin_set(this->pinCsn);
|
||||
//
|
||||
// xSemaphoreGive(mutex);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
void SpiMaster::Sleep() {
|
||||
// while (spiBaseAddress->ENABLE != 0) {
|
||||
// spiBaseAddress->ENABLE = (SPIM_ENABLE_ENABLE_Disabled << SPIM_ENABLE_ENABLE_Pos);
|
||||
// }
|
||||
// nrf_gpio_cfg_default(params.pinSCK);
|
||||
// nrf_gpio_cfg_default(params.pinMOSI);
|
||||
// nrf_gpio_cfg_default(params.pinMISO);
|
||||
|
||||
NRF_LOG_INFO("[SPIMASTER] sleep");
|
||||
}
|
||||
|
||||
void SpiMaster::Wakeup() {
|
||||
Init();
|
||||
NRF_LOG_INFO("[SPIMASTER] Wakeup");
|
||||
}
|
||||
|
||||
bool SpiMaster::WriteCmdAndBuffer(uint8_t pinCsn, const uint8_t* cmd, size_t cmdSize, const 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;
|
||||
}
|
||||
Reference in New Issue
Block a user