added prescaler for 16 bit pwm in LPC1347 target
Fork of mbed-dev by
Diff: targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/spi_api.c
- Revision:
- 144:ef7eb2e8f9f7
- Parent:
- 119:3921aeca8633
--- a/targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/spi_api.c Tue Aug 02 14:07:36 2016 +0000 +++ b/targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/spi_api.c Fri Sep 02 15:07:44 2016 +0100 @@ -1,577 +1,581 @@ -/* mbed Microcontroller Library - * Copyright (c) 2006-2013 ARM Limited - * - * Licensed under the Apache License, Version 2.0 (the "License"); - * you may not use this file except in compliance with the License. - * You may obtain a copy of the License at - * - * http://www.apache.org/licenses/LICENSE-2.0 - * - * Unless required by applicable law or agreed to in writing, software - * distributed under the License is distributed on an "AS IS" BASIS, - * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. - * See the License for the specific language governing permissions and - * limitations under the License. - */ -#include "mbed_assert.h" -#include <math.h> - -#include "spi_api.h" -#include "cmsis.h" -#include "pinmap.h" -#include "mbed_error.h" -#include "RZ_A1_Init.h" - -static const PinMap PinMap_SPI_SCLK[] = { - {P10_12, SPI_0, 4}, - {P4_4 , SPI_1, 2}, - {P11_12, SPI_1, 2}, - {P8_3 , SPI_2, 3}, - {P5_0 , SPI_3, 8}, - {NC , NC , 0} -}; - -static const PinMap PinMap_SPI_SSEL[] = { - {P10_13, SPI_0, 4}, - {P4_5 , SPI_1, 2}, - {P11_13, SPI_1, 2}, - {P8_4 , SPI_2, 3}, - {P5_1 , SPI_3, 8}, - {NC , NC , 0} -}; - -static const PinMap PinMap_SPI_MOSI[] = { - {P10_14, SPI_0, 4}, - {P4_6 , SPI_1, 2}, - {P11_14, SPI_1, 2}, - {P8_5 , SPI_2, 3}, - {P5_2 , SPI_3, 8}, - {NC , NC , 0} -}; - -static const PinMap PinMap_SPI_MISO[] = { - {P10_15, SPI_0, 4}, - {P4_7 , SPI_1, 2}, - {P11_15, SPI_1, 2}, - {P8_6 , SPI_2, 3}, - {P5_3 , SPI_3, 8}, - {NC , NC , 0} -}; - -static const struct st_rspi *RSPI[] = RSPI_ADDRESS_LIST; - -static inline void spi_disable(spi_t *obj); -static inline void spi_enable(spi_t *obj); -static inline int spi_readable(spi_t *obj); -static inline void spi_write(spi_t *obj, int value); -static inline int spi_read(spi_t *obj); - -void spi_init(spi_t *obj, PinName mosi, PinName miso, PinName sclk, PinName ssel) { - // determine the SPI to use - volatile uint8_t dummy; - uint32_t spi_mosi = pinmap_peripheral(mosi, PinMap_SPI_MOSI); - uint32_t spi_miso = pinmap_peripheral(miso, PinMap_SPI_MISO); - uint32_t spi_sclk = pinmap_peripheral(sclk, PinMap_SPI_SCLK); - uint32_t spi_ssel = pinmap_peripheral(ssel, PinMap_SPI_SSEL); - uint32_t spi_data = pinmap_merge(spi_mosi, spi_miso); - uint32_t spi_cntl = pinmap_merge(spi_sclk, spi_ssel); - uint32_t spi = pinmap_merge(spi_data, spi_cntl); - - MBED_ASSERT((int)spi != NC); - - obj->spi.spi = (struct st_rspi *)RSPI[spi]; - obj->spi.index = spi; - - // enable power and clocking - switch (spi) { - case SPI_0: CPGSTBCR10 &= ~(0x80); break; - case SPI_1: CPGSTBCR10 &= ~(0x40); break; - case SPI_2: CPGSTBCR10 &= ~(0x20); break; - case SPI_3: CPGSTBCR10 &= ~(0x10); break; - } - dummy = CPGSTBCR10; - - obj->spi.spi->SPCR = 0x00; // CTRL to 0 - obj->spi.spi->SPSCR = 0x00; // no sequential operation - obj->spi.spi->SSLP = 0x00; // SSL 'L' active - obj->spi.spi->SPDCR = 0x20; // byte access - obj->spi.spi->SPCKD = 0x00; // SSL -> enable CLK delay : 1RSPCK - obj->spi.spi->SSLND = 0x00; // CLK end -> SSL neg delay : 1RSPCK - obj->spi.spi->SPND = 0x00; // delay between CMD : 1RSPCK + 2P1CLK - obj->spi.spi->SPPCR = 0x20; // MOSI Idle fixed value equals 0 - obj->spi.spi->SPBFCR = 0xf0; // and set trigger count: read 1, write 1 - obj->spi.spi->SPBFCR = 0x30; // and reset buffer - - // pin out the spi pins - pinmap_pinout(mosi, PinMap_SPI_MOSI); - pinmap_pinout(miso, PinMap_SPI_MISO); - pinmap_pinout(sclk, PinMap_SPI_SCLK); - if ((int)ssel != NC) { - pinmap_pinout(ssel, PinMap_SPI_SSEL); - } -} - -void spi_free(spi_t *obj) {} - -void spi_format(spi_t *obj, int bits, int mode, int slave) { - int DSS; // DSS (data select size) - int polarity = (mode & 0x2) ? 1 : 0; - int phase = (mode & 0x1) ? 1 : 0; - uint16_t tmp = 0; - uint16_t mask = 0xf03; - uint16_t wk_spcmd0; - uint8_t splw; - - switch (mode) { - case 0: - case 1: - case 2: - case 3: - // Do Nothing - break; - default: - error("SPI format error"); - return; - } - - switch (bits) { - case 8: - DSS = 0x7; - splw = 0x20; - break; - case 16: - DSS = 0xf; - splw = 0x40; - break; - case 32: - DSS = 0x2; - splw = 0x60; - break; - default: - error("SPI module don't support other than 8/16/32bits"); - return; - } - tmp |= phase; - tmp |= (polarity << 1); - tmp |= (DSS << 8); - obj->spi.bits = bits; - - spi_disable(obj); - wk_spcmd0 = obj->spi.spi->SPCMD0; - wk_spcmd0 &= ~mask; - wk_spcmd0 |= (mask & tmp); - obj->spi.spi->SPCMD0 = wk_spcmd0; - obj->spi.spi->SPDCR = splw; - if (slave) { - obj->spi.spi->SPCR &=~(1 << 3); // MSTR to 0 - } else { - obj->spi.spi->SPCR |= (1 << 3); // MSTR to 1 - } - spi_enable(obj); -} - -void spi_frequency(spi_t *obj, int hz) { - uint32_t pclk_base; - uint32_t div; - uint32_t brdv = 0; - uint32_t hz_max; - uint32_t hz_min; - uint16_t mask = 0x000c; - uint16_t wk_spcmd0; - - /* set PCLK */ - if (RZ_A1_IsClockMode0() == false) { - pclk_base = CM1_RENESAS_RZ_A1_P1_CLK; - } else { - pclk_base = CM0_RENESAS_RZ_A1_P1_CLK; - } - - hz_min = pclk_base / 2 / 256 / 8; - hz_max = pclk_base / 2; - if ((hz < hz_min) || (hz > hz_max)) { - error("Couldn't setup requested SPI frequency"); - return; - } - - div = (pclk_base / hz / 2); - while (div > 256) { - div >>= 1; - brdv++; - } - div -= 1; - brdv = (brdv << 2); - - spi_disable(obj); - obj->spi.spi->SPBR = div; - wk_spcmd0 = obj->spi.spi->SPCMD0; - wk_spcmd0 &= ~mask; - wk_spcmd0 |= (mask & brdv); - obj->spi.spi->SPCMD0 = wk_spcmd0; - spi_enable(obj); -} - -static inline void spi_disable(spi_t *obj) { - obj->spi.spi->SPCR &= ~(1 << 6); // SPE to 0 -} - -static inline void spi_enable(spi_t *obj) { - obj->spi.spi->SPCR |= (1 << 6); // SPE to 1 -} - -static inline int spi_readable(spi_t *obj) { - return obj->spi.spi->SPSR & (1 << 7); // SPRF -} - -static inline int spi_tend(spi_t *obj) { - return obj->spi.spi->SPSR & (1 << 6); // TEND -} - -static inline void spi_write(spi_t *obj, int value) { - if (obj->spi.bits == 8) { - obj->spi.spi->SPDR.UINT8[0] = (uint8_t)value; - } else if (obj->spi.bits == 16) { - obj->spi.spi->SPDR.UINT16[0] = (uint16_t)value; - } else { - obj->spi.spi->SPDR.UINT32 = (uint32_t)value; - } -} - -static inline int spi_read(spi_t *obj) { - int read_data; - - if (obj->spi.bits == 8) { - read_data = obj->spi.spi->SPDR.UINT8[0]; - } else if (obj->spi.bits == 16) { - read_data = obj->spi.spi->SPDR.UINT16[0]; - } else { - read_data = obj->spi.spi->SPDR.UINT32; - } - - return read_data; -} - -int spi_master_write(spi_t *obj, int value) { - spi_write(obj, value); - while(!spi_tend(obj)); - return spi_read(obj); -} - -int spi_slave_receive(spi_t *obj) { - return (spi_readable(obj) && !spi_busy(obj)) ? (1) : (0); -} - -int spi_slave_read(spi_t *obj) { - return spi_read(obj); -} - -void spi_slave_write(spi_t *obj, int value) { - spi_write(obj, value); -} - -int spi_busy(spi_t *obj) { - return 0; -} - -#if DEVICE_SPI_ASYNCH - -#define IRQ_NUM 2 - -static void spi_irqs_set(spi_t *obj, uint32_t enable); -static void spi_async_write(spi_t *obj); -static void spi_async_read(spi_t *obj); - -static void spi0_rx_irq(void); -static void spi1_rx_irq(void); -static void spi2_rx_irq(void); -static void spi3_rx_irq(void); -static void spi4_rx_irq(void); -static void spi0_er_irq(void); -static void spi1_er_irq(void); -static void spi2_er_irq(void); -static void spi3_er_irq(void); -static void spi4_er_irq(void); - -static const IRQn_Type irq_set_tbl[RSPI_COUNT][IRQ_NUM] = { - {RSPISPRI0_IRQn, RSPISPEI0_IRQn}, - {RSPISPRI1_IRQn, RSPISPEI1_IRQn}, - {RSPISPRI2_IRQn, RSPISPEI2_IRQn}, - {RSPISPRI3_IRQn, RSPISPEI3_IRQn}, - {RSPISPRI4_IRQn, RSPISPEI4_IRQn} -}; - -static const IRQHandler hander_set_tbl[RSPI_COUNT][IRQ_NUM] = { - {spi0_rx_irq, spi0_er_irq}, - {spi1_rx_irq, spi1_er_irq}, - {spi2_rx_irq, spi2_er_irq}, - {spi3_rx_irq, spi3_er_irq}, - {spi4_rx_irq, spi4_er_irq} -}; - -struct spi_global_data_s { - spi_t *async_obj; - uint32_t async_callback, event, wanted_events; -}; - -static struct spi_global_data_s spi_data[RSPI_COUNT]; - -static void spi_rx_irq(IRQn_Type irq_num, uint32_t index) -{ - spi_t *obj = spi_data[index].async_obj; - if (obj->rx_buff.buffer && obj->rx_buff.pos < obj->rx_buff.length) { - spi_async_read(obj); - } else { - if (obj->rx_buff.buffer && obj->tx_buff.buffer && obj->tx_buff.pos < obj->tx_buff.length) { - spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; - if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { - spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; - } - spi_irqs_set(obj, 0); - spi_data[obj->spi.index].async_obj = NULL; - ((void (*)())spi_data[obj->spi.index].async_callback)(); - return; - } - spi_read(obj); - } - if (obj->tx_buff.buffer) { - if (obj->tx_buff.pos == obj->tx_buff.length) { - spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; - if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { - spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; - } - spi_irqs_set(obj, 0); - spi_data[obj->spi.index].async_obj = NULL; - ((void (*)())spi_data[obj->spi.index].async_callback)(); - } else { - spi_async_write(obj); - } - } else { - if (obj->rx_buff.pos == obj->rx_buff.length) { - spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; - if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { - spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; - } - spi_irqs_set(obj, 0); - spi_data[obj->spi.index].async_obj = NULL; - ((void (*)())spi_data[obj->spi.index].async_callback)(); - } else { - spi_async_write(obj); - } - } -} - -static void spi_err_irq(IRQn_Type irq_num, uint32_t index) -{ - spi_t *obj = spi_data[index].async_obj; - spi_abort_asynch(obj); - spi_data[index].event = SPI_EVENT_ERROR; - if (spi_data[index].wanted_events & SPI_EVENT_ERROR) { - ((void (*)())spi_data[index].async_callback)(); - } -} - -static void spi0_rx_irq(void) -{ - spi_rx_irq(RSPISPRI0_IRQn, 0); -} - -static void spi1_rx_irq(void) -{ - spi_rx_irq(RSPISPRI1_IRQn, 1); -} - -static void spi2_rx_irq(void) -{ - spi_rx_irq(RSPISPRI2_IRQn, 2); -} - -static void spi3_rx_irq(void) -{ - spi_rx_irq(RSPISPRI3_IRQn, 3); -} - -static void spi4_rx_irq(void) -{ - spi_rx_irq(RSPISPRI4_IRQn, 4); -} - -static void spi0_er_irq(void) -{ - spi_err_irq(RSPISPEI0_IRQn, 0); -} - -static void spi1_er_irq(void) -{ - spi_err_irq(RSPISPEI1_IRQn, 1); -} - -static void spi2_er_irq(void) -{ - spi_err_irq(RSPISPEI2_IRQn, 2); -} - -static void spi3_er_irq(void) -{ - spi_err_irq(RSPISPEI3_IRQn, 3); -} - -static void spi4_er_irq(void) -{ - spi_err_irq(RSPISPEI4_IRQn, 4); -} - -static void spi_irqs_set(spi_t *obj, uint32_t enable) -{ - int i; - const IRQn_Type *irqTable = irq_set_tbl[obj->spi.index]; - const IRQHandler *handlerTable = hander_set_tbl[obj->spi.index]; - for (i = 0; i < IRQ_NUM; ++i) { - if (enable) { - InterruptHandlerRegister(irqTable[i], handlerTable[i]); - GIC_SetPriority(irqTable[i], 5); - GIC_EnableIRQ(irqTable[i]); - } else { - GIC_DisableIRQ(irqTable[i]); - } - } - if (enable) { - obj->spi.spi->SPCR |= (1 << 4) | (1 << 7); - } else { - obj->spi.spi->SPCR &= ~((1 << 4) | (1 << 7)); - } -} - -static void spi_async_write(spi_t *obj) -{ - uint8_t **width8; - uint16_t **width16; - uint32_t **width32; - - if (obj->tx_buff.buffer) { - switch (obj->tx_buff.width) { - case 8: - width8 = (uint8_t **)&obj->tx_buff.buffer; - spi_write(obj, **width8); - ++*width8; - obj->tx_buff.pos += sizeof(uint8_t); - break; - - case 16: - width16 = (uint16_t **)&obj->tx_buff.buffer; - spi_write(obj, **width16); - ++*width16; - obj->tx_buff.pos += sizeof(uint16_t); - break; - - case 32: - width32 = (uint32_t **)&obj->tx_buff.buffer; - spi_write(obj, **width32); - ++*width32; - obj->tx_buff.pos += sizeof(uint32_t); - break; - - default: - MBED_ASSERT(0); - break; - } - } else { - spi_write(obj, SPI_FILL_WORD); - } -} - -static void spi_async_read(spi_t *obj) -{ - uint8_t **width8; - uint16_t **width16; - uint32_t **width32; - - switch (obj->rx_buff.width) { - case 8: - width8 = (uint8_t **)&obj->rx_buff.buffer; - **width8 = spi_read(obj); - ++*width8; - obj->rx_buff.pos += sizeof(uint8_t); - break; - - case 16: - width16 = (uint16_t **)&obj->rx_buff.buffer; - **width16 = spi_read(obj); - ++*width16; - obj->rx_buff.pos += sizeof(uint16_t); - break; - - case 32: - width32 = (uint32_t **)&obj->rx_buff.buffer; - **width32 = spi_read(obj); - ++*width32; - obj->rx_buff.pos += sizeof(uint32_t); - break; - - default: - MBED_ASSERT(0); - break; - } -} - -/****************************************************************************** - * ASYNCHRONOUS HAL - ******************************************************************************/ - -void spi_master_transfer(spi_t *obj, const void *tx, size_t tx_length, void *rx, size_t rx_length, uint8_t bit_width, uint32_t handler, uint32_t event, DMAUsage hint) -{ - int i; - MBED_ASSERT(obj); - MBED_ASSERT(tx || rx); - MBED_ASSERT(tx && ! rx ? tx_length : 1); - MBED_ASSERT(rx && ! tx ? rx_length : 1); - MBED_ASSERT(obj->spi.spi->SPCR & (1 << 3)); /* Slave mode */ - MBED_ASSERT(bit_width == 8 || bit_width == 16 || bit_width == 32); - - if (tx_length) { - obj->tx_buff.buffer = (void *)tx; - } else { - obj->tx_buff.buffer = NULL; - } - obj->tx_buff.length = tx_length * bit_width / 8; - obj->tx_buff.pos = 0; - obj->tx_buff.width = bit_width; - if (rx_length) { - obj->rx_buff.buffer = rx; - } else { - obj->rx_buff.buffer = NULL; - } - obj->rx_buff.length = rx_length * bit_width / 8; - obj->rx_buff.pos = 0; - obj->rx_buff.width = bit_width; - for (i = 0; i < obj->rx_buff.length; i++) { - ((uint8_t *)obj->rx_buff.buffer)[i] = SPI_FILL_WORD; - } - - spi_data[obj->spi.index].async_callback = handler; - spi_data[obj->spi.index].async_obj = obj; - spi_data[obj->spi.index].event = 0; - spi_data[obj->spi.index].wanted_events = event; - - spi_irqs_set(obj, 1); - - spi_async_write(obj); -} - -uint32_t spi_irq_handler_asynch(spi_t *obj) -{ - return spi_data[obj->spi.index].event; -} - -uint8_t spi_active(spi_t *obj) -{ - return spi_data[obj->spi.index].async_obj != NULL; -} - -void spi_abort_asynch(spi_t *obj) -{ - spi_disable(obj); - spi_irqs_set(obj, 0); - spi_data[obj->spi.index].async_obj = NULL; - spi_enable(obj); -} - -#endif +/* mbed Microcontroller Library + * Copyright (c) 2006-2013 ARM Limited + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ +#include "mbed_assert.h" +#include <math.h> + +#include "spi_api.h" +#include "cmsis.h" +#include "pinmap.h" +#include "mbed_error.h" +#include "RZ_A1_Init.h" + +static const PinMap PinMap_SPI_SCLK[] = { + {P10_12, SPI_0, 4}, + {P4_4 , SPI_1, 2}, + {P6_4 , SPI_1, 7}, + {P11_12, SPI_1, 2}, + {P8_3 , SPI_2, 3}, + {P5_0 , SPI_3, 8}, + {NC , NC , 0} +}; + +static const PinMap PinMap_SPI_SSEL[] = { + {P10_13, SPI_0, 4}, + {P4_5 , SPI_1, 2}, + {P6_5 , SPI_1, 7}, + {P11_13, SPI_1, 2}, + {P8_4 , SPI_2, 3}, + {P5_1 , SPI_3, 8}, + {NC , NC , 0} +}; + +static const PinMap PinMap_SPI_MOSI[] = { + {P10_14, SPI_0, 4}, + {P4_6 , SPI_1, 2}, + {P6_6 , SPI_1, 7}, + {P11_14, SPI_1, 2}, + {P8_5 , SPI_2, 3}, + {P5_2 , SPI_3, 8}, + {NC , NC , 0} +}; + +static const PinMap PinMap_SPI_MISO[] = { + {P10_15, SPI_0, 4}, + {P4_7 , SPI_1, 2}, + {P6_7 , SPI_1, 7}, + {P11_15, SPI_1, 2}, + {P8_6 , SPI_2, 3}, + {P5_3 , SPI_3, 8}, + {NC , NC , 0} +}; + +static const struct st_rspi *RSPI[] = RSPI_ADDRESS_LIST; + +static inline void spi_disable(spi_t *obj); +static inline void spi_enable(spi_t *obj); +static inline int spi_readable(spi_t *obj); +static inline void spi_write(spi_t *obj, int value); +static inline int spi_read(spi_t *obj); + +void spi_init(spi_t *obj, PinName mosi, PinName miso, PinName sclk, PinName ssel) { + // determine the SPI to use + volatile uint8_t dummy; + uint32_t spi_mosi = pinmap_peripheral(mosi, PinMap_SPI_MOSI); + uint32_t spi_miso = pinmap_peripheral(miso, PinMap_SPI_MISO); + uint32_t spi_sclk = pinmap_peripheral(sclk, PinMap_SPI_SCLK); + uint32_t spi_ssel = pinmap_peripheral(ssel, PinMap_SPI_SSEL); + uint32_t spi_data = pinmap_merge(spi_mosi, spi_miso); + uint32_t spi_cntl = pinmap_merge(spi_sclk, spi_ssel); + uint32_t spi = pinmap_merge(spi_data, spi_cntl); + + MBED_ASSERT((int)spi != NC); + + obj->spi.spi = (struct st_rspi *)RSPI[spi]; + obj->spi.index = spi; + + // enable power and clocking + switch (spi) { + case SPI_0: CPGSTBCR10 &= ~(0x80); break; + case SPI_1: CPGSTBCR10 &= ~(0x40); break; + case SPI_2: CPGSTBCR10 &= ~(0x20); break; + case SPI_3: CPGSTBCR10 &= ~(0x10); break; + } + dummy = CPGSTBCR10; + + obj->spi.spi->SPCR = 0x00; // CTRL to 0 + obj->spi.spi->SPSCR = 0x00; // no sequential operation + obj->spi.spi->SSLP = 0x00; // SSL 'L' active + obj->spi.spi->SPDCR = 0x20; // byte access + obj->spi.spi->SPCKD = 0x00; // SSL -> enable CLK delay : 1RSPCK + obj->spi.spi->SSLND = 0x00; // CLK end -> SSL neg delay : 1RSPCK + obj->spi.spi->SPND = 0x00; // delay between CMD : 1RSPCK + 2P1CLK + obj->spi.spi->SPPCR = 0x20; // MOSI Idle fixed value equals 0 + obj->spi.spi->SPBFCR = 0xf0; // and set trigger count: read 1, write 1 + obj->spi.spi->SPBFCR = 0x30; // and reset buffer + + // pin out the spi pins + pinmap_pinout(mosi, PinMap_SPI_MOSI); + pinmap_pinout(miso, PinMap_SPI_MISO); + pinmap_pinout(sclk, PinMap_SPI_SCLK); + if ((int)ssel != NC) { + pinmap_pinout(ssel, PinMap_SPI_SSEL); + } +} + +void spi_free(spi_t *obj) {} + +void spi_format(spi_t *obj, int bits, int mode, int slave) { + int DSS; // DSS (data select size) + int polarity = (mode & 0x2) ? 1 : 0; + int phase = (mode & 0x1) ? 1 : 0; + uint16_t tmp = 0; + uint16_t mask = 0xf03; + uint16_t wk_spcmd0; + uint8_t splw; + + switch (mode) { + case 0: + case 1: + case 2: + case 3: + // Do Nothing + break; + default: + error("SPI format error"); + return; + } + + switch (bits) { + case 8: + DSS = 0x7; + splw = 0x20; + break; + case 16: + DSS = 0xf; + splw = 0x40; + break; + case 32: + DSS = 0x2; + splw = 0x60; + break; + default: + error("SPI module don't support other than 8/16/32bits"); + return; + } + tmp |= phase; + tmp |= (polarity << 1); + tmp |= (DSS << 8); + obj->spi.bits = bits; + + spi_disable(obj); + wk_spcmd0 = obj->spi.spi->SPCMD0; + wk_spcmd0 &= ~mask; + wk_spcmd0 |= (mask & tmp); + obj->spi.spi->SPCMD0 = wk_spcmd0; + obj->spi.spi->SPDCR = splw; + if (slave) { + obj->spi.spi->SPCR &=~(1 << 3); // MSTR to 0 + } else { + obj->spi.spi->SPCR |= (1 << 3); // MSTR to 1 + } + spi_enable(obj); +} + +void spi_frequency(spi_t *obj, int hz) { + uint32_t pclk_base; + uint32_t div; + uint32_t brdv = 0; + uint32_t hz_max; + uint32_t hz_min; + uint16_t mask = 0x000c; + uint16_t wk_spcmd0; + + /* set PCLK */ + if (RZ_A1_IsClockMode0() == false) { + pclk_base = CM1_RENESAS_RZ_A1_P1_CLK; + } else { + pclk_base = CM0_RENESAS_RZ_A1_P1_CLK; + } + + hz_min = pclk_base / 2 / 256 / 8; + hz_max = pclk_base / 2; + if ((hz < hz_min) || (hz > hz_max)) { + error("Couldn't setup requested SPI frequency"); + return; + } + + div = (pclk_base / hz / 2); + while (div > 256) { + div >>= 1; + brdv++; + } + div -= 1; + brdv = (brdv << 2); + + spi_disable(obj); + obj->spi.spi->SPBR = div; + wk_spcmd0 = obj->spi.spi->SPCMD0; + wk_spcmd0 &= ~mask; + wk_spcmd0 |= (mask & brdv); + obj->spi.spi->SPCMD0 = wk_spcmd0; + spi_enable(obj); +} + +static inline void spi_disable(spi_t *obj) { + obj->spi.spi->SPCR &= ~(1 << 6); // SPE to 0 +} + +static inline void spi_enable(spi_t *obj) { + obj->spi.spi->SPCR |= (1 << 6); // SPE to 1 +} + +static inline int spi_readable(spi_t *obj) { + return obj->spi.spi->SPSR & (1 << 7); // SPRF +} + +static inline int spi_tend(spi_t *obj) { + return obj->spi.spi->SPSR & (1 << 6); // TEND +} + +static inline void spi_write(spi_t *obj, int value) { + if (obj->spi.bits == 8) { + obj->spi.spi->SPDR.UINT8[0] = (uint8_t)value; + } else if (obj->spi.bits == 16) { + obj->spi.spi->SPDR.UINT16[0] = (uint16_t)value; + } else { + obj->spi.spi->SPDR.UINT32 = (uint32_t)value; + } +} + +static inline int spi_read(spi_t *obj) { + int read_data; + + if (obj->spi.bits == 8) { + read_data = obj->spi.spi->SPDR.UINT8[0]; + } else if (obj->spi.bits == 16) { + read_data = obj->spi.spi->SPDR.UINT16[0]; + } else { + read_data = obj->spi.spi->SPDR.UINT32; + } + + return read_data; +} + +int spi_master_write(spi_t *obj, int value) { + spi_write(obj, value); + while(!spi_tend(obj)); + return spi_read(obj); +} + +int spi_slave_receive(spi_t *obj) { + return (spi_readable(obj) && !spi_busy(obj)) ? (1) : (0); +} + +int spi_slave_read(spi_t *obj) { + return spi_read(obj); +} + +void spi_slave_write(spi_t *obj, int value) { + spi_write(obj, value); +} + +int spi_busy(spi_t *obj) { + return 0; +} + +#if DEVICE_SPI_ASYNCH + +#define IRQ_NUM 2 + +static void spi_irqs_set(spi_t *obj, uint32_t enable); +static void spi_async_write(spi_t *obj); +static void spi_async_read(spi_t *obj); + +static void spi0_rx_irq(void); +static void spi1_rx_irq(void); +static void spi2_rx_irq(void); +static void spi3_rx_irq(void); +static void spi4_rx_irq(void); +static void spi0_er_irq(void); +static void spi1_er_irq(void); +static void spi2_er_irq(void); +static void spi3_er_irq(void); +static void spi4_er_irq(void); + +static const IRQn_Type irq_set_tbl[RSPI_COUNT][IRQ_NUM] = { + {RSPISPRI0_IRQn, RSPISPEI0_IRQn}, + {RSPISPRI1_IRQn, RSPISPEI1_IRQn}, + {RSPISPRI2_IRQn, RSPISPEI2_IRQn}, + {RSPISPRI3_IRQn, RSPISPEI3_IRQn}, + {RSPISPRI4_IRQn, RSPISPEI4_IRQn} +}; + +static const IRQHandler hander_set_tbl[RSPI_COUNT][IRQ_NUM] = { + {spi0_rx_irq, spi0_er_irq}, + {spi1_rx_irq, spi1_er_irq}, + {spi2_rx_irq, spi2_er_irq}, + {spi3_rx_irq, spi3_er_irq}, + {spi4_rx_irq, spi4_er_irq} +}; + +struct spi_global_data_s { + spi_t *async_obj; + uint32_t async_callback, event, wanted_events; +}; + +static struct spi_global_data_s spi_data[RSPI_COUNT]; + +static void spi_rx_irq(IRQn_Type irq_num, uint32_t index) +{ + spi_t *obj = spi_data[index].async_obj; + if (obj->rx_buff.buffer && obj->rx_buff.pos < obj->rx_buff.length) { + spi_async_read(obj); + } else { + if (obj->rx_buff.buffer && obj->tx_buff.buffer && obj->tx_buff.pos < obj->tx_buff.length) { + spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; + if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { + spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; + } + spi_irqs_set(obj, 0); + spi_data[obj->spi.index].async_obj = NULL; + ((void (*)())spi_data[obj->spi.index].async_callback)(); + return; + } + spi_read(obj); + } + if (obj->tx_buff.buffer) { + if (obj->tx_buff.pos == obj->tx_buff.length) { + spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; + if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { + spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; + } + spi_irqs_set(obj, 0); + spi_data[obj->spi.index].async_obj = NULL; + ((void (*)())spi_data[obj->spi.index].async_callback)(); + } else { + spi_async_write(obj); + } + } else { + if (obj->rx_buff.pos == obj->rx_buff.length) { + spi_data[obj->spi.index].event = SPI_EVENT_INTERNAL_TRANSFER_COMPLETE; + if (spi_data[obj->spi.index].wanted_events & SPI_EVENT_COMPLETE) { + spi_data[obj->spi.index].event |= SPI_EVENT_COMPLETE; + } + spi_irqs_set(obj, 0); + spi_data[obj->spi.index].async_obj = NULL; + ((void (*)())spi_data[obj->spi.index].async_callback)(); + } else { + spi_async_write(obj); + } + } +} + +static void spi_err_irq(IRQn_Type irq_num, uint32_t index) +{ + spi_t *obj = spi_data[index].async_obj; + spi_abort_asynch(obj); + spi_data[index].event = SPI_EVENT_ERROR; + if (spi_data[index].wanted_events & SPI_EVENT_ERROR) { + ((void (*)())spi_data[index].async_callback)(); + } +} + +static void spi0_rx_irq(void) +{ + spi_rx_irq(RSPISPRI0_IRQn, 0); +} + +static void spi1_rx_irq(void) +{ + spi_rx_irq(RSPISPRI1_IRQn, 1); +} + +static void spi2_rx_irq(void) +{ + spi_rx_irq(RSPISPRI2_IRQn, 2); +} + +static void spi3_rx_irq(void) +{ + spi_rx_irq(RSPISPRI3_IRQn, 3); +} + +static void spi4_rx_irq(void) +{ + spi_rx_irq(RSPISPRI4_IRQn, 4); +} + +static void spi0_er_irq(void) +{ + spi_err_irq(RSPISPEI0_IRQn, 0); +} + +static void spi1_er_irq(void) +{ + spi_err_irq(RSPISPEI1_IRQn, 1); +} + +static void spi2_er_irq(void) +{ + spi_err_irq(RSPISPEI2_IRQn, 2); +} + +static void spi3_er_irq(void) +{ + spi_err_irq(RSPISPEI3_IRQn, 3); +} + +static void spi4_er_irq(void) +{ + spi_err_irq(RSPISPEI4_IRQn, 4); +} + +static void spi_irqs_set(spi_t *obj, uint32_t enable) +{ + int i; + const IRQn_Type *irqTable = irq_set_tbl[obj->spi.index]; + const IRQHandler *handlerTable = hander_set_tbl[obj->spi.index]; + for (i = 0; i < IRQ_NUM; ++i) { + if (enable) { + InterruptHandlerRegister(irqTable[i], handlerTable[i]); + GIC_SetPriority(irqTable[i], 5); + GIC_EnableIRQ(irqTable[i]); + } else { + GIC_DisableIRQ(irqTable[i]); + } + } + if (enable) { + obj->spi.spi->SPCR |= (1 << 4) | (1 << 7); + } else { + obj->spi.spi->SPCR &= ~((1 << 4) | (1 << 7)); + } +} + +static void spi_async_write(spi_t *obj) +{ + uint8_t **width8; + uint16_t **width16; + uint32_t **width32; + + if (obj->tx_buff.buffer) { + switch (obj->tx_buff.width) { + case 8: + width8 = (uint8_t **)&obj->tx_buff.buffer; + spi_write(obj, **width8); + ++*width8; + obj->tx_buff.pos += sizeof(uint8_t); + break; + + case 16: + width16 = (uint16_t **)&obj->tx_buff.buffer; + spi_write(obj, **width16); + ++*width16; + obj->tx_buff.pos += sizeof(uint16_t); + break; + + case 32: + width32 = (uint32_t **)&obj->tx_buff.buffer; + spi_write(obj, **width32); + ++*width32; + obj->tx_buff.pos += sizeof(uint32_t); + break; + + default: + MBED_ASSERT(0); + break; + } + } else { + spi_write(obj, SPI_FILL_WORD); + } +} + +static void spi_async_read(spi_t *obj) +{ + uint8_t **width8; + uint16_t **width16; + uint32_t **width32; + + switch (obj->rx_buff.width) { + case 8: + width8 = (uint8_t **)&obj->rx_buff.buffer; + **width8 = spi_read(obj); + ++*width8; + obj->rx_buff.pos += sizeof(uint8_t); + break; + + case 16: + width16 = (uint16_t **)&obj->rx_buff.buffer; + **width16 = spi_read(obj); + ++*width16; + obj->rx_buff.pos += sizeof(uint16_t); + break; + + case 32: + width32 = (uint32_t **)&obj->rx_buff.buffer; + **width32 = spi_read(obj); + ++*width32; + obj->rx_buff.pos += sizeof(uint32_t); + break; + + default: + MBED_ASSERT(0); + break; + } +} + +/****************************************************************************** + * ASYNCHRONOUS HAL + ******************************************************************************/ + +void spi_master_transfer(spi_t *obj, const void *tx, size_t tx_length, void *rx, size_t rx_length, uint8_t bit_width, uint32_t handler, uint32_t event, DMAUsage hint) +{ + int i; + MBED_ASSERT(obj); + MBED_ASSERT(tx || rx); + MBED_ASSERT(tx && ! rx ? tx_length : 1); + MBED_ASSERT(rx && ! tx ? rx_length : 1); + MBED_ASSERT(obj->spi.spi->SPCR & (1 << 3)); /* Slave mode */ + MBED_ASSERT(bit_width == 8 || bit_width == 16 || bit_width == 32); + + if (tx_length) { + obj->tx_buff.buffer = (void *)tx; + } else { + obj->tx_buff.buffer = NULL; + } + obj->tx_buff.length = tx_length * bit_width / 8; + obj->tx_buff.pos = 0; + obj->tx_buff.width = bit_width; + if (rx_length) { + obj->rx_buff.buffer = rx; + } else { + obj->rx_buff.buffer = NULL; + } + obj->rx_buff.length = rx_length * bit_width / 8; + obj->rx_buff.pos = 0; + obj->rx_buff.width = bit_width; + for (i = 0; i < obj->rx_buff.length; i++) { + ((uint8_t *)obj->rx_buff.buffer)[i] = SPI_FILL_WORD; + } + + spi_data[obj->spi.index].async_callback = handler; + spi_data[obj->spi.index].async_obj = obj; + spi_data[obj->spi.index].event = 0; + spi_data[obj->spi.index].wanted_events = event; + + spi_irqs_set(obj, 1); + + spi_async_write(obj); +} + +uint32_t spi_irq_handler_asynch(spi_t *obj) +{ + return spi_data[obj->spi.index].event; +} + +uint8_t spi_active(spi_t *obj) +{ + return spi_data[obj->spi.index].async_obj != NULL; +} + +void spi_abort_asynch(spi_t *obj) +{ + spi_disable(obj); + spi_irqs_set(obj, 0); + spi_data[obj->spi.index].async_obj = NULL; + spi_enable(obj); +} + +#endif