diff --git a/os/ex/ST/lis3dsh.c b/os/ex/ST/lis3dsh.c new file mode 100644 index 000000000..880cf391e --- /dev/null +++ b/os/ex/ST/lis3dsh.c @@ -0,0 +1,596 @@ +/* + ChibiOS - Copyright (C) 2016 Rocco Marco Guglielmi + + This file is part of ChibiOS. + + ChibiOS is free software; you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation; either version 3 of the License, or + (at your option) any later version. + + ChibiOS is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program. If not, see . + +*/ + +/** + * @file lis3dsh.c + * @brief LIS3DSH MEMS interface module code. + * + * @addtogroup lis3dsh + * @{ + */ + +#include "hal.h" + +#include "lis3dsh.h" + +/*===========================================================================*/ +/* Driver local definitions. */ +/*===========================================================================*/ + +#define LIS3DSH_SENS_2G ((float)0.06f) +#define LIS3DSH_SENS_4G ((float)0.12f) +#define LIS3DSH_SENS_6G ((float)0.18f) +#define LIS3DSH_SENS_8G ((float)0.24f) +#define LIS3DSH_SENS_16G ((float)0.73f) + +#define LIS3DSH_DI ((uint8_t)0xFF) +#define LIS3DSH_DI_0 ((uint8_t)0x01) +#define LIS3DSH_DI_1 ((uint8_t)0x02) +#define LIS3DSH_DI_2 ((uint8_t)0x04) +#define LIS3DSH_DI_3 ((uint8_t)0x08) +#define LIS3DSH_DI_4 ((uint8_t)0x10) +#define LIS3DSH_DI_5 ((uint8_t)0x20) +#define LIS3DSH_DI_6 ((uint8_t)0x40) +#define LIS3DSH_DI_7 ((uint8_t)0x80) + +#define LIS3DSH_AD ((uint8_t)0x3F) +#define LIS3DSH_AD_0 ((uint8_t)0x01) +#define LIS3DSH_AD_1 ((uint8_t)0x02) +#define LIS3DSH_AD_2 ((uint8_t)0x04) +#define LIS3DSH_AD_3 ((uint8_t)0x08) +#define LIS3DSH_AD_4 ((uint8_t)0x10) +#define LIS3DSH_AD_5 ((uint8_t)0x20) + +#define LIS3DSH_MS ((uint8_t)0x40) +#define LIS3DSH_RW ((uint8_t)0x80) + +#define LIS3DSH_AD_INFO1 ((uint8_t)0x0D) +#define LIS3DSH_AD_INFO2 ((uint8_t)0x0E) +#define LIS3DSH_AD_WHO_AM_I ((uint8_t)0x0F) +#define LIS3DSH_AD_CTRL_REG3 ((uint8_t)0x23) +#define LIS3DSH_AD_CTRL_REG4 ((uint8_t)0x20) +#define LIS3DSH_AD_CTRL_REG5 ((uint8_t)0x24) +#define LIS3DSH_AD_CTRL_REG6 ((uint8_t)0x25) +#define LIS3DSH_AD_STATUS ((uint8_t)0x27) +#define LIS3DSH_AD_OUT_T ((uint8_t)0x0C) +#define LIS3DSH_AD_OFF_X ((uint8_t)0x10) +#define LIS3DSH_AD_OFF_Y ((uint8_t)0x11) +#define LIS3DSH_AD_OFF_Z ((uint8_t)0x12) +#define LIS3DSH_AD_CS_X ((uint8_t)0x13) +#define LIS3DSH_AD_CS_Y ((uint8_t)0x14) +#define LIS3DSH_AD_CS_Z ((uint8_t)0x15) +#define LIS3DSH_AD_LC_L ((uint8_t)0x16) +#define LIS3DSH_AD_LC_H ((uint8_t)0x17) +#define LIS3DSH_AD_STAT ((uint8_t)0x18) +#define LIS3DSH_AD_VFC_1 ((uint8_t)0x1B) +#define LIS3DSH_AD_VFC_2 ((uint8_t)0x1C) +#define LIS3DSH_AD_VFC_3 ((uint8_t)0x1D) +#define LIS3DSH_AD_VFC_4 ((uint8_t)0x1E) +#define LIS3DSH_AD_THRS3 ((uint8_t)0x1F) +#define LIS3DSH_AD_OUT_X_L ((uint8_t)0x28) +#define LIS3DSH_AD_OUT_X_H ((uint8_t)0x29) +#define LIS3DSH_AD_OUT_Y_L ((uint8_t)0x2A) +#define LIS3DSH_AD_OUT_Y_H ((uint8_t)0x2B) +#define LIS3DSH_AD_OUT_Z_L ((uint8_t)0x2C) +#define LIS3DSH_AD_OUT_Z_H ((uint8_t)0x2D) +#define LIS3DSH_AD_FIFO_CTRL ((uint8_t)0x2E) +#define LIS3DSH_AD_FIFO_SRC ((uint8_t)0x2F) +#define LIS3DSH_AD_CTRL_REG1 ((uint8_t)0x21) +#define LIS3DSH_AD_ST1_0 ((uint8_t)0x40) +#define LIS3DSH_AD_ST1_1 ((uint8_t)0x41) +#define LIS3DSH_AD_ST1_2 ((uint8_t)0x42) +#define LIS3DSH_AD_ST1_3 ((uint8_t)0x43) +#define LIS3DSH_AD_ST1_4 ((uint8_t)0x44) +#define LIS3DSH_AD_ST1_5 ((uint8_t)0x45) +#define LIS3DSH_AD_ST1_6 ((uint8_t)0x46) +#define LIS3DSH_AD_ST1_7 ((uint8_t)0x47) +#define LIS3DSH_AD_ST1_8 ((uint8_t)0x48) +#define LIS3DSH_AD_ST1_9 ((uint8_t)0x49) +#define LIS3DSH_AD_ST1_A ((uint8_t)0x4A) +#define LIS3DSH_AD_ST1_B ((uint8_t)0x4B) +#define LIS3DSH_AD_ST1_C ((uint8_t)0x4C) +#define LIS3DSH_AD_ST1_D ((uint8_t)0x4D) +#define LIS3DSH_AD_ST1_E ((uint8_t)0x4E) +#define LIS3DSH_AD_ST1_F ((uint8_t)0x4F) +#define LIS3DSH_AD_TIM4_1 ((uint8_t)0x50) +#define LIS3DSH_AD_TIM3_1 ((uint8_t)0x51) +#define LIS3DSH_AD_TIM2_1_L ((uint8_t)0x52) +#define LIS3DSH_AD_TIM2_1_H ((uint8_t)0x53) +#define LIS3DSH_AD_TIM1_1_L ((uint8_t)0x54) +#define LIS3DSH_AD_TIM1_1_H ((uint8_t)0x55) +#define LIS3DSH_AD_THRS2_1 ((uint8_t)0x56) +#define LIS3DSH_AD_THRS1_1 ((uint8_t)0x57) +#define LIS3DSH_AD_MASK1_B ((uint8_t)0x59) +#define LIS3DSH_AD_MASK1_A ((uint8_t)0x5A) +#define LIS3DSH_AD_SETT1 ((uint8_t)0x5B) +#define LIS3DSH_AD_PR1 ((uint8_t)0x5C) +#define LIS3DSH_AD_TC1_L ((uint8_t)0x5D) +#define LIS3DSH_AD_TC1_H ((uint8_t)0x5E) +#define LIS3DSH_AD_OUTS1 ((uint8_t)0x5F) +#define LIS3DSH_AD_PEAK1 ((uint8_t)0x19) +#define LIS3DSH_AD_CTRL_REG2 ((uint8_t)0x22) +#define LIS3DSH_AD_ST2_0 ((uint8_t)0x60) +#define LIS3DSH_AD_ST2_1 ((uint8_t)0x61) +#define LIS3DSH_AD_ST2_2 ((uint8_t)0x62) +#define LIS3DSH_AD_ST2_3 ((uint8_t)0x63) +#define LIS3DSH_AD_ST2_4 ((uint8_t)0x64) +#define LIS3DSH_AD_ST2_5 ((uint8_t)0x65) +#define LIS3DSH_AD_ST2_6 ((uint8_t)0x66) +#define LIS3DSH_AD_ST2_7 ((uint8_t)0x67) +#define LIS3DSH_AD_ST2_8 ((uint8_t)0x68) +#define LIS3DSH_AD_ST2_9 ((uint8_t)0x69) +#define LIS3DSH_AD_ST2_A ((uint8_t)0x6A) +#define LIS3DSH_AD_ST2_B ((uint8_t)0x6B) +#define LIS3DSH_AD_ST2_C ((uint8_t)0x6C) +#define LIS3DSH_AD_ST2_D ((uint8_t)0x6D) +#define LIS3DSH_AD_ST2_E ((uint8_t)0x6E) +#define LIS3DSH_AD_ST2_F ((uint8_t)0x6F) +#define LIS3DSH_AD_TIM4_2 ((uint8_t)0x70) +#define LIS3DSH_AD_TIM3_2 ((uint8_t)0x71) +#define LIS3DSH_AD_TIM2_2_L ((uint8_t)0x72) +#define LIS3DSH_AD_TIM2_2_H ((uint8_t)0x73) +#define LIS3DSH_AD_TIM1_2_L ((uint8_t)0x74) +#define LIS3DSH_AD_TIM1_2_H ((uint8_t)0x75) +#define LIS3DSH_AD_THRS2_2 ((uint8_t)0x76) +#define LIS3DSH_AD_THRS1_2 ((uint8_t)0x77) +#define LIS3DSH_AD_MASK2_B ((uint8_t)0x79) +#define LIS3DSH_AD_MASK2_A ((uint8_t)0x7A) +#define LIS3DSH_AD_SETT2 ((uint8_t)0x7B) +#define LIS3DSH_AD_PR2 ((uint8_t)0x7C) +#define LIS3DSH_AD_TC2_L ((uint8_t)0x7D) +#define LIS3DSH_AD_TC2_H ((uint8_t)0x7E) +#define LIS3DSH_AD_OUTS2 ((uint8_t)0x7F) +#define LIS3DSH_AD_PEAK2 ((uint8_t)0x1A) +#define LIS3DSH_AD_DES2 ((uint8_t)0x78) + +#define LIS3DSH_CTRL_REG5_FS_MASK ((uint8_t)0x38) +#define TO_G ((float)0.001f) +#define TO_SI ((float)0.00981f) +/*===========================================================================*/ +/* Driver exported variables. */ +/*===========================================================================*/ + +/*===========================================================================*/ +/* Driver local variables and types. */ +/*===========================================================================*/ + +/*===========================================================================*/ +/* Driver local functions. */ +/*===========================================================================*/ + +#if (LIS3DSH_USE_SPI) || defined(__DOXYGEN__) +/** + * @brief Reads a generic register value using SPI. + * @pre The SPI interface must be initialized and the driver started. + * + * @param[in] spip pointer to the SPI interface + * @param[in] reg register number + * @return register value. + */ +static uint8_t lis3dshSPIReadRegister(SPIDriver *spip, uint8_t reg) { + uint8_t txbuf[2] = {LIS3DSH_RW | reg, 0xFF}; + uint8_t rxbuf[2] = {0x00, 0x00}; + spiSelect(spip); + spiExchange(spip, 2, txbuf, rxbuf); + spiUnselect(spip); + return rxbuf[1]; +} + +/** + * @brief Writes a value into a generic register using SPI. + * @pre The SPI interface must be initialized and the driver started. + * + * @param[in] spip pointer to the SPI interface + * @param[in] reg register number + * @param[in] value register value. + */ +static void lis3dshSPIWriteRegister(SPIDriver *spip, uint8_t reg, + uint8_t value) { + + switch (reg) { + default: + /* Reserved register must not be written, according to the datasheet + * this could permanently damage the device. + */ + osalDbgAssert(FALSE, "lis3dshSPIWriteRegister(), reserved register"); + case LIS3DSH_AD_INFO1: + case LIS3DSH_AD_INFO2: + case LIS3DSH_AD_WHO_AM_I: + case LIS3DSH_AD_STATUS: + case LIS3DSH_AD_OUT_T: + case LIS3DSH_AD_STAT: + case LIS3DSH_AD_OUT_X_L: + case LIS3DSH_AD_OUT_X_H: + case LIS3DSH_AD_OUT_Y_L: + case LIS3DSH_AD_OUT_Y_H: + case LIS3DSH_AD_OUT_Z_L: + case LIS3DSH_AD_OUT_Z_H: + case LIS3DSH_AD_FIFO_SRC: + case LIS3DSH_AD_FIFO_CTRL: + case LIS3DSH_AD_PR1: + case LIS3DSH_AD_TC1_L: + case LIS3DSH_AD_TC1_H: + case LIS3DSH_AD_OUTS1: + case LIS3DSH_AD_PEAK1: + case LIS3DSH_AD_PR2: + case LIS3DSH_AD_TC2_L: + case LIS3DSH_AD_TC2_H: + case LIS3DSH_AD_OUTS2: + case LIS3DSH_AD_PEAK2: + /* Read only registers cannot be written, the command is ignored.*/ + return; + case LIS3DSH_AD_CTRL_REG3: + case LIS3DSH_AD_CTRL_REG4: + case LIS3DSH_AD_CTRL_REG5: + case LIS3DSH_AD_CTRL_REG6: + case LIS3DSH_AD_OFF_X: + case LIS3DSH_AD_OFF_Y: + case LIS3DSH_AD_OFF_Z: + case LIS3DSH_AD_CS_X: + case LIS3DSH_AD_CS_Y: + case LIS3DSH_AD_CS_Z: + case LIS3DSH_AD_LC_L: + case LIS3DSH_AD_LC_H: + case LIS3DSH_AD_VFC_1: + case LIS3DSH_AD_VFC_2: + case LIS3DSH_AD_VFC_3: + case LIS3DSH_AD_VFC_4: + case LIS3DSH_AD_THRS3: + case LIS3DSH_AD_CTRL_REG1: + case LIS3DSH_AD_ST1_0: + case LIS3DSH_AD_ST1_1: + case LIS3DSH_AD_ST1_2: + case LIS3DSH_AD_ST1_3: + case LIS3DSH_AD_ST1_4: + case LIS3DSH_AD_ST1_5: + case LIS3DSH_AD_ST1_6: + case LIS3DSH_AD_ST1_7: + case LIS3DSH_AD_ST1_8: + case LIS3DSH_AD_ST1_9: + case LIS3DSH_AD_ST1_A: + case LIS3DSH_AD_ST1_B: + case LIS3DSH_AD_ST1_C: + case LIS3DSH_AD_ST1_D: + case LIS3DSH_AD_ST1_E: + case LIS3DSH_AD_ST1_F: + case LIS3DSH_AD_TIM4_1: + case LIS3DSH_AD_TIM3_1: + case LIS3DSH_AD_TIM2_1_L: + case LIS3DSH_AD_TIM2_1_H: + case LIS3DSH_AD_TIM1_1_L: + case LIS3DSH_AD_TIM1_1_H: + case LIS3DSH_AD_THRS2_1: + case LIS3DSH_AD_THRS1_1: + case LIS3DSH_AD_MASK1_B: + case LIS3DSH_AD_MASK1_A: + case LIS3DSH_AD_SETT1: + case LIS3DSH_AD_CTRL_REG2: + case LIS3DSH_AD_ST2_0: + case LIS3DSH_AD_ST2_1: + case LIS3DSH_AD_ST2_2: + case LIS3DSH_AD_ST2_3: + case LIS3DSH_AD_ST2_4: + case LIS3DSH_AD_ST2_5: + case LIS3DSH_AD_ST2_6: + case LIS3DSH_AD_ST2_7: + case LIS3DSH_AD_ST2_8: + case LIS3DSH_AD_ST2_9: + case LIS3DSH_AD_ST2_A: + case LIS3DSH_AD_ST2_B: + case LIS3DSH_AD_ST2_C: + case LIS3DSH_AD_ST2_D: + case LIS3DSH_AD_ST2_E: + case LIS3DSH_AD_ST2_F: + case LIS3DSH_AD_TIM4_2: + case LIS3DSH_AD_TIM3_2: + case LIS3DSH_AD_TIM2_2_L: + case LIS3DSH_AD_TIM2_2_H: + case LIS3DSH_AD_TIM1_2_L: + case LIS3DSH_AD_TIM1_2_H: + case LIS3DSH_AD_THRS2_2: + case LIS3DSH_AD_THRS1_2: + case LIS3DSH_AD_MASK2_B: + case LIS3DSH_AD_MASK2_A: + case LIS3DSH_AD_SETT2: + case LIS3DSH_AD_DES2: + spiSelect(spip); + uint8_t txbuf[2] = {reg, value}; + spiSend(spip, 2, txbuf); + spiUnselect(spip); + } +} +#endif /* LIS3DSH_USE_SPI */ + +/* + * Interface implementation. + */ +static size_t get_axes_number(void *ip) { + + osalDbgCheck(ip != NULL); + return LIS3DSH_NUMBER_OF_AXES; +} + +static msg_t read_raw(void *ip, int32_t axes[LIS3DSH_NUMBER_OF_AXES]) { + int16_t tmp; + osalDbgCheck((ip != NULL) && (axes != NULL)); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY), + "read_raw(), invalid state"); + +#if LIS3DSH_USE_SPI + osalDbgAssert((((LIS3DSHDriver *)ip)->config->spip->state == SPI_READY), + "read_raw(), channel not ready"); +#if LIS3DSH_SHARED_SPI + spiAcquireBus(((LIS3DSHDriver *)ip)->config->spip); + spiStart(((LIS3DSHDriver *)ip)->config->spip, + ((LIS3DSHDriver *)ip)->config->spicfg); +#endif /* LIS3DSH_SHARED_SPI */ + if(((LIS3DSHDriver *)ip)->config->axesenabling & LIS3DSH_AE_X){ + tmp = lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_X_L); + tmp += lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_X_H) << 8; + axes[0] = (int32_t)tmp + ((LIS3DSHDriver *)ip)->bias[0]; + } + if(((LIS3DSHDriver *)ip)->config->axesenabling & LIS3DSH_AE_Y){ + tmp = lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_Y_L); + tmp += lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_Y_H) << 8; + axes[1] = (int32_t)tmp + ((LIS3DSHDriver *)ip)->bias[1]; + } + if(((LIS3DSHDriver *)ip)->config->axesenabling & LIS3DSH_AE_Z){ + tmp = lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_Z_L); + tmp += lis3dshSPIReadRegister(((LIS3DSHDriver *)ip)->config->spip, + LIS3DSH_AD_OUT_Z_H) << 8; + axes[2] = (int32_t)tmp + ((LIS3DSHDriver *)ip)->bias[2]; + } +#if LIS3DSH_SHARED_SPI + spiReleaseBus(((LIS3DSHDriver *)ip)->config->spip); +#endif /* LIS3DSH_SHARED_SPI */ +#endif /* LIS3DSH_USE_SPI */ + return MSG_OK; +} + +static msg_t read_cooked(void *ip, float axes[]) { + uint32_t i; + int32_t raw[LIS3DSH_NUMBER_OF_AXES]; + msg_t msg; + + osalDbgCheck((ip != NULL) && (axes != NULL)); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY), + "read_cooked(), invalid state"); + + msg = read_raw(ip, raw); + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES ; i++){ + axes[i] = raw[i] * ((LIS3DSHDriver *)ip)->sensitivity[i]; + if(((LIS3DSHDriver *)ip)->config->unit == LIS3DSH_ACC_UNIT_G){ + axes[i] *= TO_G; + } + else if(((LIS3DSHDriver *)ip)->config->unit == LIS3DSH_ACC_UNIT_SI){ + axes[i] *= TO_SI; + } + } + return msg; +} + +static msg_t set_bias(void *ip, int32_t *bp) { + uint32_t i; + + osalDbgCheck((ip != NULL) && (bp !=NULL)); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY) || + (((LIS3DSHDriver *)ip)->state == LIS3DSH_STOP), + "set_bias(), invalid state"); + + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) { + ((LIS3DSHDriver *)ip)->bias[i] = bp[i]; + } + return MSG_OK; +} + +static msg_t reset_bias(void *ip) { + uint32_t i; + + osalDbgCheck(ip != NULL); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY) || + (((LIS3DSHDriver *)ip)->state == LIS3DSH_STOP), + "reset_bias(), invalid state"); + + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->bias[i] = 0; + return MSG_OK; +} + +static msg_t set_sensivity(void *ip, float *sp) { + uint32_t i; + + osalDbgCheck((ip != NULL) && (sp !=NULL)); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY), + "set_sensivity(), invalid state"); + + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) { + ((LIS3DSHDriver *)ip)->sensitivity[i] = sp[i]; + } + return MSG_OK; +} + +static msg_t reset_sensivity(void *ip) { + uint32_t i; + + osalDbgCheck(ip != NULL); + + osalDbgAssert((((LIS3DSHDriver *)ip)->state == LIS3DSH_READY), + "reset_sensivity(), invalid state"); + + if(((LIS3DSHDriver *)ip)->config->fullscale == LIS3DSH_FS_2G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->sensitivity[i] = LIS3DSH_SENS_2G; + else if(((LIS3DSHDriver *)ip)->config->fullscale == LIS3DSH_FS_4G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->sensitivity[i] = LIS3DSH_SENS_4G; + else if(((LIS3DSHDriver *)ip)->config->fullscale == LIS3DSH_FS_6G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->sensitivity[i] = LIS3DSH_SENS_6G; + else if(((LIS3DSHDriver *)ip)->config->fullscale == LIS3DSH_FS_8G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->sensitivity[i] = LIS3DSH_SENS_8G; + else if(((LIS3DSHDriver *)ip)->config->fullscale == LIS3DSH_FS_16G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + ((LIS3DSHDriver *)ip)->sensitivity[i] = LIS3DSH_SENS_16G; + else { + osalDbgAssert(FALSE, "reset_sensivity(), accelerometer full scale issue"); + return MSG_RESET; + } + return MSG_OK; +} + +static const struct BaseSensorVMT vmt_basesensor = { + get_axes_number, read_raw, read_cooked +}; + +static const struct BaseAccelerometerVMT vmt_baseaccelerometer = { + get_axes_number, read_raw, read_cooked, + set_bias, reset_bias, set_sensivity, reset_sensivity +}; + +static const struct LIS3DSHVMT vmt_lis3dsh = { + get_axes_number, read_raw, read_cooked, + set_bias, reset_bias, set_sensivity, reset_sensivity +}; + +/*===========================================================================*/ +/* Driver exported functions. */ +/*===========================================================================*/ + +/** + * @brief Initializes an instance. + * + * @param[out] devp pointer to the @p LIS3DSHDriver object + * + * @init + */ +void lis3dshObjectInit(LIS3DSHDriver *devp) { + uint32_t i; + devp->vmt_basesensor = &vmt_basesensor; + devp->vmt_baseaccelerometer = &vmt_baseaccelerometer; + devp->vmt_lis3dsh = &vmt_lis3dsh; + devp->config = NULL; + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->bias[i] = 0; + devp->state = LIS3DSH_STOP; +} + +/** + * @brief Configures and activates LIS3DSH Complex Driver peripheral. + * + * @param[in] devp pointer to the @p LIS3DSHDriver object + * @param[in] config pointer to the @p LIS3DSHConfig object + * + * @api + */ +void lis3dshStart(LIS3DSHDriver *devp, const LIS3DSHConfig *config) { + uint32_t i; + osalDbgCheck((devp != NULL) && (config != NULL)); + + osalDbgAssert((devp->state == LIS3DSH_STOP) || (devp->state == LIS3DSH_READY), + "lis3dshStart(), invalid state"); + + devp->config = config; + +#if LIS3DSH_USE_SPI +#if LIS3DSH_SHARED_SPI + spiAcquireBus((devp)->config->spip); +#endif /* LIS3DSH_SHARED_SPI */ + spiStart((devp)->config->spip, + (devp)->config->spicfg); + lis3dshSPIWriteRegister(devp->config->spip, LIS3DSH_AD_CTRL_REG4, + devp->config->axesenabling | + devp->config->blockdataupdate | + devp->config->outputdatarate); + lis3dshSPIWriteRegister(devp->config->spip, LIS3DSH_AD_CTRL_REG5, + devp->config->fullscale | + devp->config->antialiasing ); +#if LIS3DSH_SHARED_SPI + spiReleaseBus((devp)->config->spip); +#endif /* LIS3DSH_SHARED_SPI */ +#endif /* LIS3DSH_USE_SPI */ + + /* Storing sensitivity information according to full scale value */ + if(devp->config->fullscale == LIS3DSH_FS_2G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->sensitivity[i] = LIS3DSH_SENS_2G; + else if(devp->config->fullscale == LIS3DSH_FS_4G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->sensitivity[i] = LIS3DSH_SENS_4G; + else if(devp->config->fullscale == LIS3DSH_FS_6G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->sensitivity[i] = LIS3DSH_SENS_6G; + else if(devp->config->fullscale == LIS3DSH_FS_8G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->sensitivity[i] = LIS3DSH_SENS_8G; + else if(devp->config->fullscale == LIS3DSH_FS_16G) + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + devp->sensitivity[i] = LIS3DSH_SENS_16G; + else { + osalDbgAssert(FALSE, "lis3dshStart(), accelerometer full scale issue"); + } + /* This is the Accelerometer transient recovery time */ + osalThreadSleepMilliseconds(10); + + devp->state = LIS3DSH_READY; +} + +/** + * @brief Deactivates the LIS3DSH Complex Driver peripheral. + * + * @param[in] devp pointer to the @p LIS3DSHDriver object + * + * @api + */ +void lis3dshStop(LIS3DSHDriver *devp) { + + osalDbgCheck(devp != NULL); + + osalDbgAssert((devp->state == LIS3DSH_STOP) || (devp->state == LIS3DSH_READY), + "lis3dshStop(), invalid state"); + +#if (LIS3DSH_USE_SPI) + if (devp->state == LIS3DSH_STOP) { +#if LIS3DSH_SHARED_SPI + spiAcquireBus((devp)->config->spip); + spiStart((devp)->config->spip, + (devp)->config->spicfg); +#endif /* LIS3DSH_SHARED_SPI */ + lis3dshSPIWriteRegister(devp->config->spip, LIS3DSH_AD_CTRL_REG4, + LIS3DSH_ODR_PD | LIS3DSH_AE_DISABLED); + spiStop((devp)->config->spip); +#if LIS3DSH_SHARED_SPI + spiReleaseBus((devp)->config->spip); +#endif /* LIS3DSH_SHARED_SPI */ + } +#endif /* LIS3DSH_USE_SPI */ + devp->state = LIS3DSH_STOP; +} +/** @} */ diff --git a/os/ex/ST/lis3dsh.h b/os/ex/ST/lis3dsh.h new file mode 100644 index 000000000..7d1002f87 --- /dev/null +++ b/os/ex/ST/lis3dsh.h @@ -0,0 +1,323 @@ +/* + ChibiOS - Copyright (C) 2016 Rocco Marco Guglielmi + + This file is part of ChibiOS. + + ChibiOS is free software; you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation; either version 3 of the License, or + (at your option) any later version. + + ChibiOS is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program. If not, see . + +*/ + +/** + * @file lis3dsh.h + * @brief LIS3DSH MEMS interface module header. + * + * @{ + */ + +#ifndef _LIS3DSH_H_ +#define _LIS3DSH_H_ + +#include "hal_accelerometer.h" + +/*===========================================================================*/ +/* Driver constants. */ +/*===========================================================================*/ + +/** + * @brief LIS3DSH number of axes. + */ +#define LIS3DSH_NUMBER_OF_AXES ((size_t) 3U) + +/*===========================================================================*/ +/* Driver pre-compile time settings. */ +/*===========================================================================*/ + +/** + * @name Configuration options. + * @{ + */ +/** + * @brief LIS3DSH SPI interface switch. + * @details If set to @p TRUE the support for SPI is included. + * @note The default is @p TRUE. + */ +#if !defined(LIS3DSH_USE_SPI) || defined(__DOXYGEN__) +#define LIS3DSH_USE_SPI TRUE +#endif + +/** + * @brief LIS3DSH I2C interface switch. + * @details If set to @p TRUE the support for I2C is included. + * @note The default is @p FALSE. + */ +#if !defined(LIS3DSH_USE_I2C) || defined(__DOXYGEN__) +#define LIS3DSH_USE_I2C FALSE +#endif + +/** + * @brief LIS3DSH shared SPI switch. + * @details If set to @p TRUE the device acquires SPI bus ownership + * on each transaction. + * @note The default is @p FALSE. Requires SPI_USE_MUTUAL_EXCLUSION. + */ +#if !defined(LIS3DSH_SHARED_SPI) || defined(__DOXYGEN__) +#define LIS3DSH_SHARED_SPI FALSE +#endif +/** @} */ + +/*===========================================================================*/ +/* Derived constants and error checks. */ +/*===========================================================================*/ + +#if !(LIS3DSH_USE_SPI ^ LIS3DSH_USE_I2C) +#error "LIS3DSH_USE_SPI and LIS3DSH_USE_I2C cannot be both true or both false" +#endif + +#if LIS3DSH_USE_SPI && !HAL_USE_SPI +#error "LIS3DSH_USE_SPI requires HAL_USE_SPI" +#endif + +#if LIS3DSH_USE_I2C && !HAL_USE_I2C +#error "LIS3DSH_USE_I2C requires HAL_USE_I2C" +#endif + +#if LIS3DSH_SHARED_SPI && !SPI_USE_MUTUAL_EXCLUSION +#error "LIS3DSH_SHARED_SPI requires SPI_USE_MUTUAL_EXCLUSION" +#endif + +/*===========================================================================*/ +/* Driver data structures and types. */ +/*===========================================================================*/ + +/** + * @name LIS3DSH data structures and types + * @{ + */ +/** + * @brief LIS3DSH full scale. + */ +typedef enum { + LIS3DSH_FS_2G = 0x00, /**< Full scale ±2g. */ + LIS3DSH_FS_4G = 0x08, /**< Full scale ±4g. */ + LIS3DSH_FS_6G = 0x10, /**< Full scale ±6g. */ + LIS3DSH_FS_8G = 0x18, /**< Full scale ±8g. */ + LIS3DSH_FS_16G = 0x20 /**< Full scale ±16g. */ +}lis3dsh_fs_t; + +/** + * @brief LIS3DSH output data rate. + */ +typedef enum { + LIS3DSH_ODR_PD = 0x00, /**< ODR 100 Hz. */ + LIS3DSH_ODR_3_125HZ = 0x10, /**< ODR 3.125 Hz. */ + LIS3DSH_ODR_6_25HZ = 0x20, /**< ODR 6.25 Hz. */ + LIS3DSH_ODR_12_5HZ = 0x30, /**< ODR 12.5 Hz. */ + LIS3DSH_ODR_25HZ = 0x40, /**< ODR 25 Hz. */ + LIS3DSH_ODR_50HZ = 0x50, /**< ODR 50 Hz. */ + LIS3DSH_ODR_100HZ = 0x60, /**< ODR 100 Hz. */ + LIS3DSH_ODR_400HZ = 0x70, /**< ODR 400 Hz. */ + LIS3DSH_ODR_800HZ = 0x80, /**< ODR 800 Hz. */ + LIS3DSH_ODR_1600HZ = 0x90 /**< ODR 1600 Hz. */ +}lis3dsh_odr_t; + +/** + * @brief LIS3DSH anti-aliasing bandwidth. + */ +typedef enum { + LIS3DSH_BW_800HZ = 0x00, /**< AA filter BW 800Hz. */ + LIS3DSH_BW_200HZ = 0x40, /**< AA filter BW 200Hz. */ + LIS3DSH_BW_400HZ = 0x80, /**< AA filter BW 400Hz. */ + LIS3DSH_BW_50HZ = 0xC0 /**< AA filter BW 50Hz. */ +}lis3dsh_bw_t; + +/** + * @brief LIS3DSH axes enabling. + */ +typedef enum { + LIS3DSH_AE_DISABLED = 0x00, /**< All axes disabled. */ + LIS3DSH_AE_X = 0x01, /**< Only X-axis enabled. */ + LIS3DSH_AE_Y = 0x02, /**< Only Y-axis enabled. */ + LIS3DSH_AE_XY = 0x03, /**< X and Y axes enabled. */ + LIS3DSH_AE_Z = 0x04, /**< Only Z-axis enabled. */ + LIS3DSH_AE_XZ = 0x05, /**< X and Z axes enabled. */ + LIS3DSH_AE_YZ = 0x06, /**< Y and Z axes enabled. */ + LIS3DSH_AE_XYZ = 0x07 /**< All axes enabled. */ +}lis3dsh_ae_t; + +/** + * @brief LIS3DSH block data update. + */ +typedef enum { + LIS3DSH_BDU_CONTINUOUS = 0x00, /**< Block data continuously updated. */ + LIS3DSH_BDU_BLOCKED = 0x80 /**< Block data updated after reading. */ +} lis3dsh_bdu_t; + +/** + * @brief LIS3DSH accelerometer subsystem unit. + */ +typedef enum { + LIS3DSH_ACC_UNIT_G = 0x00, /**< Cooked data in g. */ + LIS3DSH_ACC_UNIT_MG = 0x01, /**< Cooked data in mg. */ + LIS3DSH_ACC_UNIT_SI = 0x02, /**< Cooked data in m/s^2. */ +} lis3dsh_acc_unit_t; + +/** + * @brief Driver state machine possible states. + */ +typedef enum { + LIS3DSH_UNINIT = 0, /**< Not initialized. */ + LIS3DSH_STOP = 1, /**< Stopped. */ + LIS3DSH_READY = 2, /**< Ready. */ +} lis3dsh_state_t; + +/** + * @brief LIS3DSH configuration structure. + */ +typedef struct { + +#if (LIS3DSH_USE_SPI) || defined(__DOXYGEN__) + /** + * @brief SPI driver associated to this LIS3DSH. + */ + SPIDriver *spip; + /** + * @brief SPI configuration associated to this LIS3DSH. + */ + const SPIConfig *spicfg; +#endif /* LIS3DSH_USE_SPI */ +#if (LIS3DSH_USE_I2C) || defined(__DOXYGEN__) + /** + * @brief I2C driver associated to this LIS3DSH. + */ + I2CDriver *i2cp; + /** + * @brief I2C configuration associated to this LIS3DSH. + */ + const I2CConfig *i2ccfg; +#endif /* LIS3DSH_USE_I2C */ + /** + * @brief LIS3DSH full scale value. + */ + lis3dsh_fs_t fullscale; + /** + * @brief LIS3DSH output data rate selection. + */ + lis3dsh_odr_t outputdatarate; + /** + * @brief LIS3DSH anti-aliasing bandwidth. + */ + lis3dsh_bw_t antialiasing; + /** + * @brief LIS3DSH axes enabling. + */ + lis3dsh_ae_t axesenabling; + /** + * @brief LIS3DSH block data update. + */ + lis3dsh_bdu_t blockdataupdate; + /** + * @brief LIS3DSH unit for cooked data. + */ + lis3dsh_acc_unit_t unit; +} LIS3DSHConfig; + +/** + * @brief Structure representing a LIS3DSH driver. + */ +typedef struct LIS3DSHDriver LIS3DSHDriver; + +/** + * @brief @p LIS3DSH specific methods. + */ +#define _lis3dsh_methods \ + _base_accelerometer_methods + +/** + * @extends BaseAccelerometerVMT + * + * @brief @p LIS3DSH virtual methods table. + */ +struct LIS3DSHVMT { + _lis3dsh_methods +}; + +/** + * @brief @p LIS3DSHDriver specific data. + */ +#define _lis3dsh_data \ + _base_accelerometer_data \ + /* Driver state.*/ \ + lis3dsh_state_t state; \ + /* Current configuration data.*/ \ + const LIS3DSHConfig *config; \ + /* Current sensitivity.*/ \ + float sensitivity[LIS3DSH_NUMBER_OF_AXES]; \ + /* Bias data.*/ \ + int32_t bias[LIS3DSH_NUMBER_OF_AXES]; + +/** + * @extends BaseAccelerometer + * + * @brief LIS3DSH 3-axis accelerometer class. + * @details This class extends @p BaseAccelerometer by adding physical + * driver implementation. + */ +struct LIS3DSHDriver { + /** @brief BaseSensor Virtual Methods Table. */ + const struct BaseSensorVMT *vmt_basesensor; + /** @brief BaseAccelerometer Virtual Methods Table. */ + const struct BaseAccelerometerVMT *vmt_baseaccelerometer; + /** @brief LIS3DSH Virtual Methods Table. */ + const struct LIS3DSHVMT *vmt_lis3dsh; + _lis3dsh_data +}; +/** @} */ + +/*===========================================================================*/ +/* Driver macros. */ +/*===========================================================================*/ + +/** + * @brief Get current MEMS temperature. + * @detail This information is very useful especially for high accuracy IMU + * + * @param[in] ip pointer to a @p BaseAccelerometer class. + * @param[out] temp the MEMS temperature as single precision floating. + * + * @return The operation status. + * @retval MSG_OK if the function succeeded. + * @retval MSG_RESET if one or more errors occurred. + * @api + */ +#define accelerometerGetTemp(ip, tpp) \ + (ip)->vmt_lis3dsh->get_temperature(ip, tpp) + +/*===========================================================================*/ +/* External declarations. */ +/*===========================================================================*/ + +#ifdef __cplusplus +extern "C" { +#endif + void lis3dshObjectInit(LIS3DSHDriver *devp); + void lis3dshStart(LIS3DSHDriver *devp, const LIS3DSHConfig *config); + void lis3dshStop(LIS3DSHDriver *devp); +#ifdef __cplusplus +} +#endif + +#endif /* _LIS3DSH_H_ */ + +/** @} */ + diff --git a/os/ex/ST/lis3dsh.mk b/os/ex/ST/lis3dsh.mk new file mode 100644 index 000000000..76448d397 --- /dev/null +++ b/os/ex/ST/lis3dsh.mk @@ -0,0 +1,6 @@ +# List of all the LIS3DSH device files. +LIS3DSHSRC := $(CHIBIOS)/os/ex/ST/lis3dsh.c + +# Required include directories +LIS3DSHINC := $(CHIBIOS)/os/hal/lib/peripherals/sensors \ + $(CHIBIOS)/os/ex/ST \ No newline at end of file diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.cproject b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.cproject new file mode 100644 index 000000000..4d2044e0c --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.cproject @@ -0,0 +1,50 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.project b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.project new file mode 100644 index 000000000..5498aa598 --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/.project @@ -0,0 +1,38 @@ + + + STM32F4xx-SPI-LIS3DSH + + + + + + org.eclipse.cdt.managedbuilder.core.genmakebuilder + clean,full,incremental, + + + + + org.eclipse.cdt.managedbuilder.core.ScannerConfigBuilder + full,incremental, + + + + + + org.eclipse.cdt.core.cnature + org.eclipse.cdt.managedbuilder.core.managedBuildNature + org.eclipse.cdt.managedbuilder.core.ScannerConfigNature + + + + board + 2 + CHIBIOS/os/hal/boards/ST_STM32F4_DISCOVERY + + + os + 2 + CHIBIOS/os + + + diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/Makefile b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/Makefile new file mode 100644 index 000000000..80bc7ec50 --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/Makefile @@ -0,0 +1,220 @@ +############################################################################## +# Build global options +# NOTE: Can be overridden externally. +# + +# Compiler options here. +ifeq ($(USE_OPT),) + USE_OPT = -O0 -ggdb -fomit-frame-pointer -falign-functions=16 +endif + +# C specific options here (added to USE_OPT). +ifeq ($(USE_COPT),) + USE_COPT = +endif + +# C++ specific options here (added to USE_OPT). +ifeq ($(USE_CPPOPT),) + USE_CPPOPT = -fno-rtti +endif + +# Enable this if you want the linker to remove unused code and data +ifeq ($(USE_LINK_GC),) + USE_LINK_GC = yes +endif + +# Linker extra options here. +ifeq ($(USE_LDOPT),) + USE_LDOPT = +endif + +# Enable this if you want link time optimizations (LTO) +ifeq ($(USE_LTO),) + USE_LTO = yes +endif + +# If enabled, this option allows to compile the application in THUMB mode. +ifeq ($(USE_THUMB),) + USE_THUMB = yes +endif + +# Enable this if you want to see the full log while compiling. +ifeq ($(USE_VERBOSE_COMPILE),) + USE_VERBOSE_COMPILE = no +endif + +# If enabled, this option makes the build process faster by not compiling +# modules not used in the current configuration. +ifeq ($(USE_SMART_BUILD),) + USE_SMART_BUILD = yes +endif + +# +# Build global options +############################################################################## + +############################################################################## +# Architecture or project specific options +# + +# Stack size to be allocated to the Cortex-M process stack. This stack is +# the stack used by the main() thread. +ifeq ($(USE_PROCESS_STACKSIZE),) + USE_PROCESS_STACKSIZE = 0x400 +endif + +# Stack size to the allocated to the Cortex-M main/exceptions stack. This +# stack is used for processing interrupts and exceptions. +ifeq ($(USE_EXCEPTIONS_STACKSIZE),) + USE_EXCEPTIONS_STACKSIZE = 0x400 +endif + +# Enables the use of FPU (no, softfp, hard). +ifeq ($(USE_FPU),) + USE_FPU = no +endif + +# +# Architecture or project specific options +############################################################################## + +############################################################################## +# Project, sources and paths +# + +# Define project name here +PROJECT = ch + +# Imported source files and paths +CHIBIOS = ../../../.. +# Startup files. +include $(CHIBIOS)/os/common/startup/ARMCMx/compilers/GCC/mk/startup_stm32f4xx.mk +# HAL-OSAL files (optional). +include $(CHIBIOS)/os/hal/hal.mk +include $(CHIBIOS)/os/hal/ports/STM32/STM32F4xx/platform.mk +include $(CHIBIOS)/os/hal/boards/ST_STM32F4_DISCOVERY/board.mk +include $(CHIBIOS)/os/hal/osal/rt/osal.mk +# RTOS files (optional). +include $(CHIBIOS)/os/rt/rt.mk +include $(CHIBIOS)/os/common/ports/ARMCMx/compilers/GCC/mk/port_v7m.mk +# Other files (optional). +include $(CHIBIOS)/os/ex/ST/lis3dsh.mk +include $(CHIBIOS)/os/hal/lib/streams/streams.mk + +# Define linker script file here +LDSCRIPT= $(STARTUPLD)/STM32F407xG.ld + +# C sources that can be compiled in ARM or THUMB mode depending on the global +# setting. +CSRC = $(STARTUPSRC) \ + $(KERNSRC) \ + $(PORTSRC) \ + $(OSALSRC) \ + $(HALSRC) \ + $(PLATFORMSRC) \ + $(BOARDSRC) \ + $(LIS3DSHSRC) \ + $(STREAMSSRC) \ + usbcfg.c main.c + +# C++ sources that can be compiled in ARM or THUMB mode depending on the global +# setting. +CPPSRC = + +# C sources to be compiled in ARM mode regardless of the global setting. +# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler +# option that results in lower performance and larger code size. +ACSRC = + +# C++ sources to be compiled in ARM mode regardless of the global setting. +# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler +# option that results in lower performance and larger code size. +ACPPSRC = + +# C sources to be compiled in THUMB mode regardless of the global setting. +# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler +# option that results in lower performance and larger code size. +TCSRC = + +# C sources to be compiled in THUMB mode regardless of the global setting. +# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler +# option that results in lower performance and larger code size. +TCPPSRC = + +# List ASM source files here +ASMSRC = +ASMXSRC = $(STARTUPASM) $(PORTASM) $(OSALASM) + +INCDIR = $(CHIBIOS)/os/license \ + $(STARTUPINC) $(KERNINC) $(PORTINC) $(OSALINC) \ + $(HALINC) $(PLATFORMINC) $(BOARDINC) $(LIS3DSHINC) \ + $(STREAMSINC) $(CHIBIOS)/os/various + +# +# Project, sources and paths +############################################################################## + +############################################################################## +# Compiler settings +# + +MCU = cortex-m4 + +#TRGT = arm-elf- +TRGT = arm-none-eabi- +CC = $(TRGT)gcc +CPPC = $(TRGT)g++ +# Enable loading with g++ only if you need C++ runtime support. +# NOTE: You can use C++ even without C++ support if you are careful. C++ +# runtime support makes code size explode. +LD = $(TRGT)gcc +#LD = $(TRGT)g++ +CP = $(TRGT)objcopy +AS = $(TRGT)gcc -x assembler-with-cpp +AR = $(TRGT)ar +OD = $(TRGT)objdump +SZ = $(TRGT)size +HEX = $(CP) -O ihex +BIN = $(CP) -O binary + +# ARM-specific options here +AOPT = + +# THUMB-specific options here +TOPT = -mthumb -DTHUMB + +# Define C warning options here +CWARN = -Wall -Wextra -Wundef -Wstrict-prototypes + +# Define C++ warning options here +CPPWARN = -Wall -Wextra -Wundef + +# +# Compiler settings +############################################################################## + +############################################################################## +# Start of user section +# + +# List all user C define here, like -D_DEBUG=1 +UDEFS = -DCHPRINTF_USE_FLOAT=1 + +# Define ASM defines here +UADEFS = + +# List all user directories here +UINCDIR = + +# List the user directory to look for the libraries here +ULIBDIR = + +# List all user libraries here +ULIBS = + +# +# End of user defines +############################################################################## + +RULESPATH = $(CHIBIOS)/os/common/startup/ARMCMx/compilers/GCC +include $(RULESPATH)/rules.mk diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/chconf.h b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/chconf.h new file mode 100644 index 000000000..00eb395ec --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/chconf.h @@ -0,0 +1,520 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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. +*/ + +/** + * @file templates/chconf.h + * @brief Configuration file template. + * @details A copy of this file must be placed in each project directory, it + * contains the application specific kernel settings. + * + * @addtogroup config + * @details Kernel related settings and hooks. + * @{ + */ + +#ifndef CHCONF_H +#define CHCONF_H + +#define _CHIBIOS_RT_CONF_ + +/*===========================================================================*/ +/** + * @name System timers settings + * @{ + */ +/*===========================================================================*/ + +/** + * @brief System time counter resolution. + * @note Allowed values are 16 or 32 bits. + */ +#define CH_CFG_ST_RESOLUTION 32 + +/** + * @brief System tick frequency. + * @details Frequency of the system timer that drives the system ticks. This + * setting also defines the system tick time unit. + */ +#define CH_CFG_ST_FREQUENCY 10000 + +/** + * @brief Time delta constant for the tick-less mode. + * @note If this value is zero then the system uses the classic + * periodic tick. This value represents the minimum number + * of ticks that is safe to specify in a timeout directive. + * The value one is not valid, timeouts are rounded up to + * this value. + */ +#define CH_CFG_ST_TIMEDELTA 2 + +/** @} */ + +/*===========================================================================*/ +/** + * @name Kernel parameters and options + * @{ + */ +/*===========================================================================*/ + +/** + * @brief Round robin interval. + * @details This constant is the number of system ticks allowed for the + * threads before preemption occurs. Setting this value to zero + * disables the preemption for threads with equal priority and the + * round robin becomes cooperative. Note that higher priority + * threads can still preempt, the kernel is always preemptive. + * @note Disabling the round robin preemption makes the kernel more compact + * and generally faster. + * @note The round robin preemption is not supported in tickless mode and + * must be set to zero in that case. + */ +#define CH_CFG_TIME_QUANTUM 0 + +/** + * @brief Managed RAM size. + * @details Size of the RAM area to be managed by the OS. If set to zero + * then the whole available RAM is used. The core memory is made + * available to the heap allocator and/or can be used directly through + * the simplified core memory allocator. + * + * @note In order to let the OS manage the whole RAM the linker script must + * provide the @p __heap_base__ and @p __heap_end__ symbols. + * @note Requires @p CH_CFG_USE_MEMCORE. + */ +#define CH_CFG_MEMCORE_SIZE 0 + +/** + * @brief Idle thread automatic spawn suppression. + * @details When this option is activated the function @p chSysInit() + * does not spawn the idle thread. The application @p main() + * function becomes the idle thread and must implement an + * infinite loop. + */ +#define CH_CFG_NO_IDLE_THREAD FALSE + +/** @} */ + +/*===========================================================================*/ +/** + * @name Performance options + * @{ + */ +/*===========================================================================*/ + +/** + * @brief OS optimization. + * @details If enabled then time efficient rather than space efficient code + * is used when two possible implementations exist. + * + * @note This is not related to the compiler optimization options. + * @note The default is @p TRUE. + */ +#define CH_CFG_OPTIMIZE_SPEED TRUE + +/** @} */ + +/*===========================================================================*/ +/** + * @name Subsystem options + * @{ + */ +/*===========================================================================*/ + +/** + * @brief Time Measurement APIs. + * @details If enabled then the time measurement APIs are included in + * the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_TM TRUE + +/** + * @brief Threads registry APIs. + * @details If enabled then the registry APIs are included in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_REGISTRY TRUE + +/** + * @brief Threads synchronization APIs. + * @details If enabled then the @p chThdWait() function is included in + * the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_WAITEXIT TRUE + +/** + * @brief Semaphores APIs. + * @details If enabled then the Semaphores APIs are included in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_SEMAPHORES TRUE + +/** + * @brief Semaphores queuing mode. + * @details If enabled then the threads are enqueued on semaphores by + * priority rather than in FIFO order. + * + * @note The default is @p FALSE. Enable this if you have special + * requirements. + * @note Requires @p CH_CFG_USE_SEMAPHORES. + */ +#define CH_CFG_USE_SEMAPHORES_PRIORITY FALSE + +/** + * @brief Mutexes APIs. + * @details If enabled then the mutexes APIs are included in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_MUTEXES TRUE + +/** + * @brief Enables recursive behavior on mutexes. + * @note Recursive mutexes are heavier and have an increased + * memory footprint. + * + * @note The default is @p FALSE. + * @note Requires @p CH_CFG_USE_MUTEXES. + */ +#define CH_CFG_USE_MUTEXES_RECURSIVE FALSE + +/** + * @brief Conditional Variables APIs. + * @details If enabled then the conditional variables APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_MUTEXES. + */ +#define CH_CFG_USE_CONDVARS TRUE + +/** + * @brief Conditional Variables APIs with timeout. + * @details If enabled then the conditional variables APIs with timeout + * specification are included in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_CONDVARS. + */ +#define CH_CFG_USE_CONDVARS_TIMEOUT TRUE + +/** + * @brief Events Flags APIs. + * @details If enabled then the event flags APIs are included in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_EVENTS TRUE + +/** + * @brief Events Flags APIs with timeout. + * @details If enabled then the events APIs with timeout specification + * are included in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_EVENTS. + */ +#define CH_CFG_USE_EVENTS_TIMEOUT TRUE + +/** + * @brief Synchronous Messages APIs. + * @details If enabled then the synchronous messages APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_MESSAGES TRUE + +/** + * @brief Synchronous Messages queuing mode. + * @details If enabled then messages are served by priority rather than in + * FIFO order. + * + * @note The default is @p FALSE. Enable this if you have special + * requirements. + * @note Requires @p CH_CFG_USE_MESSAGES. + */ +#define CH_CFG_USE_MESSAGES_PRIORITY FALSE + +/** + * @brief Mailboxes APIs. + * @details If enabled then the asynchronous messages (mailboxes) APIs are + * included in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_SEMAPHORES. + */ +#define CH_CFG_USE_MAILBOXES TRUE + +/** + * @brief Core Memory Manager APIs. + * @details If enabled then the core memory manager APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_MEMCORE TRUE + +/** + * @brief Heap Allocator APIs. + * @details If enabled then the memory heap allocator APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_MEMCORE and either @p CH_CFG_USE_MUTEXES or + * @p CH_CFG_USE_SEMAPHORES. + * @note Mutexes are recommended. + */ +#define CH_CFG_USE_HEAP TRUE + +/** + * @brief Memory Pools Allocator APIs. + * @details If enabled then the memory pools allocator APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + */ +#define CH_CFG_USE_MEMPOOLS TRUE + +/** + * @brief Dynamic Threads APIs. + * @details If enabled then the dynamic threads creation APIs are included + * in the kernel. + * + * @note The default is @p TRUE. + * @note Requires @p CH_CFG_USE_WAITEXIT. + * @note Requires @p CH_CFG_USE_HEAP and/or @p CH_CFG_USE_MEMPOOLS. + */ +#define CH_CFG_USE_DYNAMIC TRUE + +/** @} */ + +/*===========================================================================*/ +/** + * @name Debug options + * @{ + */ +/*===========================================================================*/ + +/** + * @brief Debug option, kernel statistics. + * + * @note The default is @p FALSE. + */ +#define CH_DBG_STATISTICS FALSE + +/** + * @brief Debug option, system state check. + * @details If enabled the correct call protocol for system APIs is checked + * at runtime. + * + * @note The default is @p FALSE. + */ +#define CH_DBG_SYSTEM_STATE_CHECK TRUE + +/** + * @brief Debug option, parameters checks. + * @details If enabled then the checks on the API functions input + * parameters are activated. + * + * @note The default is @p FALSE. + */ +#define CH_DBG_ENABLE_CHECKS TRUE + +/** + * @brief Debug option, consistency checks. + * @details If enabled then all the assertions in the kernel code are + * activated. This includes consistency checks inside the kernel, + * runtime anomalies and port-defined checks. + * + * @note The default is @p FALSE. + */ +#define CH_DBG_ENABLE_ASSERTS TRUE + +/** + * @brief Debug option, trace buffer. + * @details If enabled then the trace buffer is activated. + * + * @note The default is @p CH_DBG_TRACE_MASK_DISABLED. + */ +#define CH_DBG_TRACE_MASK CH_DBG_TRACE_MASK_ALL + +/** + * @brief Trace buffer entries. + * @note The trace buffer is only allocated if @p CH_DBG_TRACE_MASK is + * different from @p CH_DBG_TRACE_MASK_DISABLED. + */ +#define CH_DBG_TRACE_BUFFER_SIZE 128 + +/** + * @brief Debug option, stack checks. + * @details If enabled then a runtime stack check is performed. + * + * @note The default is @p FALSE. + * @note The stack check is performed in a architecture/port dependent way. + * It may not be implemented or some ports. + * @note The default failure mode is to halt the system with the global + * @p panic_msg variable set to @p NULL. + */ +#define CH_DBG_ENABLE_STACK_CHECK TRUE + +/** + * @brief Debug option, stacks initialization. + * @details If enabled then the threads working area is filled with a byte + * value when a thread is created. This can be useful for the + * runtime measurement of the used stack. + * + * @note The default is @p FALSE. + */ +#define CH_DBG_FILL_THREADS TRUE + +/** + * @brief Debug option, threads profiling. + * @details If enabled then a field is added to the @p thread_t structure that + * counts the system ticks occurred while executing the thread. + * + * @note The default is @p FALSE. + * @note This debug option is not currently compatible with the + * tickless mode. + */ +#define CH_DBG_THREADS_PROFILING FALSE + +/** @} */ + +/*===========================================================================*/ +/** + * @name Kernel hooks + * @{ + */ +/*===========================================================================*/ + +/** + * @brief Threads descriptor structure extension. + * @details User fields added to the end of the @p thread_t structure. + */ +#define CH_CFG_THREAD_EXTRA_FIELDS \ + /* Add threads custom fields here.*/ + +/** + * @brief Threads initialization hook. + * @details User initialization code added to the @p chThdInit() API. + * + * @note It is invoked from within @p chThdInit() and implicitly from all + * the threads creation APIs. + */ +#define CH_CFG_THREAD_INIT_HOOK(tp) { \ + /* Add threads initialization code here.*/ \ +} + +/** + * @brief Threads finalization hook. + * @details User finalization code added to the @p chThdExit() API. + */ +#define CH_CFG_THREAD_EXIT_HOOK(tp) { \ + /* Add threads finalization code here.*/ \ +} + +/** + * @brief Context switch hook. + * @details This hook is invoked just before switching between threads. + */ +#define CH_CFG_CONTEXT_SWITCH_HOOK(ntp, otp) { \ + /* Context switch code here.*/ \ +} + +/** + * @brief ISR enter hook. + */ +#define CH_CFG_IRQ_PROLOGUE_HOOK() { \ + /* IRQ prologue code here.*/ \ +} + +/** + * @brief ISR exit hook. + */ +#define CH_CFG_IRQ_EPILOGUE_HOOK() { \ + /* IRQ epilogue code here.*/ \ +} + +/** + * @brief Idle thread enter hook. + * @note This hook is invoked within a critical zone, no OS functions + * should be invoked from here. + * @note This macro can be used to activate a power saving mode. + */ +#define CH_CFG_IDLE_ENTER_HOOK() { \ + /* Idle-enter code here.*/ \ +} + +/** + * @brief Idle thread leave hook. + * @note This hook is invoked within a critical zone, no OS functions + * should be invoked from here. + * @note This macro can be used to deactivate a power saving mode. + */ +#define CH_CFG_IDLE_LEAVE_HOOK() { \ + /* Idle-leave code here.*/ \ +} + +/** + * @brief Idle Loop hook. + * @details This hook is continuously invoked by the idle thread loop. + */ +#define CH_CFG_IDLE_LOOP_HOOK() { \ + /* Idle loop code here.*/ \ +} + +/** + * @brief System tick event hook. + * @details This hook is invoked in the system tick handler immediately + * after processing the virtual timers queue. + */ +#define CH_CFG_SYSTEM_TICK_HOOK() { \ + /* System tick event code here.*/ \ +} + +/** + * @brief System halt hook. + * @details This hook is invoked in case to a system halting error before + * the system is halted. + */ +#define CH_CFG_SYSTEM_HALT_HOOK(reason) { \ + /* System halt code here.*/ \ +} + +/** + * @brief Trace hook. + * @details This hook is invoked each time a new record is written in the + * trace buffer. + */ +#define CH_CFG_TRACE_HOOK(tep) { \ + /* Trace code here.*/ \ +} + +/** @} */ + +/*===========================================================================*/ +/* Port-specific settings (override port settings defaulted in chcore.h). */ +/*===========================================================================*/ + +#endif /* CHCONF_H */ + +/** @} */ diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/debug/STM32F4xx-SPI-LIS3DSH (OpenOCD, Flash and Run).launch b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/debug/STM32F4xx-SPI-LIS3DSH (OpenOCD, Flash and Run).launch new file mode 100644 index 000000000..bfde2a1c3 --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/debug/STM32F4xx-SPI-LIS3DSH (OpenOCD, Flash and Run).launch @@ -0,0 +1,52 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/halconf.h b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/halconf.h new file mode 100644 index 000000000..3a7f0161f --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/halconf.h @@ -0,0 +1,381 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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. +*/ + +/** + * @file templates/halconf.h + * @brief HAL configuration header. + * @details HAL configuration file, this file allows to enable or disable the + * various device drivers from your application. You may also use + * this file in order to override the device drivers default settings. + * + * @addtogroup HAL_CONF + * @{ + */ + +#ifndef HALCONF_H +#define HALCONF_H + +#include "mcuconf.h" + +/** + * @brief Enables the PAL subsystem. + */ +#if !defined(HAL_USE_PAL) || defined(__DOXYGEN__) +#define HAL_USE_PAL TRUE +#endif + +/** + * @brief Enables the ADC subsystem. + */ +#if !defined(HAL_USE_ADC) || defined(__DOXYGEN__) +#define HAL_USE_ADC FALSE +#endif + +/** + * @brief Enables the CAN subsystem. + */ +#if !defined(HAL_USE_CAN) || defined(__DOXYGEN__) +#define HAL_USE_CAN FALSE +#endif + +/** + * @brief Enables the DAC subsystem. + */ +#if !defined(HAL_USE_DAC) || defined(__DOXYGEN__) +#define HAL_USE_DAC FALSE +#endif + +/** + * @brief Enables the EXT subsystem. + */ +#if !defined(HAL_USE_EXT) || defined(__DOXYGEN__) +#define HAL_USE_EXT FALSE +#endif + +/** + * @brief Enables the GPT subsystem. + */ +#if !defined(HAL_USE_GPT) || defined(__DOXYGEN__) +#define HAL_USE_GPT FALSE +#endif + +/** + * @brief Enables the I2C subsystem. + */ +#if !defined(HAL_USE_I2C) || defined(__DOXYGEN__) +#define HAL_USE_I2C FALSE +#endif + +/** + * @brief Enables the I2S subsystem. + */ +#if !defined(HAL_USE_I2S) || defined(__DOXYGEN__) +#define HAL_USE_I2S FALSE +#endif + +/** + * @brief Enables the ICU subsystem. + */ +#if !defined(HAL_USE_ICU) || defined(__DOXYGEN__) +#define HAL_USE_ICU FALSE +#endif + +/** + * @brief Enables the MAC subsystem. + */ +#if !defined(HAL_USE_MAC) || defined(__DOXYGEN__) +#define HAL_USE_MAC FALSE +#endif + +/** + * @brief Enables the MMC_SPI subsystem. + */ +#if !defined(HAL_USE_MMC_SPI) || defined(__DOXYGEN__) +#define HAL_USE_MMC_SPI FALSE +#endif + +/** + * @brief Enables the PWM subsystem. + */ +#if !defined(HAL_USE_PWM) || defined(__DOXYGEN__) +#define HAL_USE_PWM FALSE +#endif + +/** + * @brief Enables the RTC subsystem. + */ +#if !defined(HAL_USE_RTC) || defined(__DOXYGEN__) +#define HAL_USE_RTC FALSE +#endif + +/** + * @brief Enables the SDC subsystem. + */ +#if !defined(HAL_USE_SDC) || defined(__DOXYGEN__) +#define HAL_USE_SDC FALSE +#endif + +/** + * @brief Enables the SERIAL subsystem. + */ +#if !defined(HAL_USE_SERIAL) || defined(__DOXYGEN__) +#define HAL_USE_SERIAL FALSE +#endif + +/** + * @brief Enables the SERIAL over USB subsystem. + */ +#if !defined(HAL_USE_SERIAL_USB) || defined(__DOXYGEN__) +#define HAL_USE_SERIAL_USB TRUE +#endif + +/** + * @brief Enables the SPI subsystem. + */ +#if !defined(HAL_USE_SPI) || defined(__DOXYGEN__) +#define HAL_USE_SPI TRUE +#endif + +/** + * @brief Enables the UART subsystem. + */ +#if !defined(HAL_USE_UART) || defined(__DOXYGEN__) +#define HAL_USE_UART FALSE +#endif + +/** + * @brief Enables the USB subsystem. + */ +#if !defined(HAL_USE_USB) || defined(__DOXYGEN__) +#define HAL_USE_USB TRUE +#endif + +/** + * @brief Enables the WDG subsystem. + */ +#if !defined(HAL_USE_WDG) || defined(__DOXYGEN__) +#define HAL_USE_WDG FALSE +#endif + +/*===========================================================================*/ +/* ADC driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables synchronous APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(ADC_USE_WAIT) || defined(__DOXYGEN__) +#define ADC_USE_WAIT TRUE +#endif + +/** + * @brief Enables the @p adcAcquireBus() and @p adcReleaseBus() APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(ADC_USE_MUTUAL_EXCLUSION) || defined(__DOXYGEN__) +#define ADC_USE_MUTUAL_EXCLUSION TRUE +#endif + +/*===========================================================================*/ +/* CAN driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Sleep mode related APIs inclusion switch. + */ +#if !defined(CAN_USE_SLEEP_MODE) || defined(__DOXYGEN__) +#define CAN_USE_SLEEP_MODE TRUE +#endif + +/*===========================================================================*/ +/* I2C driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables the mutual exclusion APIs on the I2C bus. + */ +#if !defined(I2C_USE_MUTUAL_EXCLUSION) || defined(__DOXYGEN__) +#define I2C_USE_MUTUAL_EXCLUSION TRUE +#endif + +/*===========================================================================*/ +/* MAC driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables an event sources for incoming packets. + */ +#if !defined(MAC_USE_ZERO_COPY) || defined(__DOXYGEN__) +#define MAC_USE_ZERO_COPY FALSE +#endif + +/** + * @brief Enables an event sources for incoming packets. + */ +#if !defined(MAC_USE_EVENTS) || defined(__DOXYGEN__) +#define MAC_USE_EVENTS TRUE +#endif + +/*===========================================================================*/ +/* MMC_SPI driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Delays insertions. + * @details If enabled this options inserts delays into the MMC waiting + * routines releasing some extra CPU time for the threads with + * lower priority, this may slow down the driver a bit however. + * This option is recommended also if the SPI driver does not + * use a DMA channel and heavily loads the CPU. + */ +#if !defined(MMC_NICE_WAITING) || defined(__DOXYGEN__) +#define MMC_NICE_WAITING TRUE +#endif + +/*===========================================================================*/ +/* SDC driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Number of initialization attempts before rejecting the card. + * @note Attempts are performed at 10mS intervals. + */ +#if !defined(SDC_INIT_RETRY) || defined(__DOXYGEN__) +#define SDC_INIT_RETRY 100 +#endif + +/** + * @brief Include support for MMC cards. + * @note MMC support is not yet implemented so this option must be kept + * at @p FALSE. + */ +#if !defined(SDC_MMC_SUPPORT) || defined(__DOXYGEN__) +#define SDC_MMC_SUPPORT FALSE +#endif + +/** + * @brief Delays insertions. + * @details If enabled this options inserts delays into the MMC waiting + * routines releasing some extra CPU time for the threads with + * lower priority, this may slow down the driver a bit however. + */ +#if !defined(SDC_NICE_WAITING) || defined(__DOXYGEN__) +#define SDC_NICE_WAITING TRUE +#endif + +/*===========================================================================*/ +/* SERIAL driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Default bit rate. + * @details Configuration parameter, this is the baud rate selected for the + * default configuration. + */ +#if !defined(SERIAL_DEFAULT_BITRATE) || defined(__DOXYGEN__) +#define SERIAL_DEFAULT_BITRATE 38400 +#endif + +/** + * @brief Serial buffers size. + * @details Configuration parameter, you can change the depth of the queue + * buffers depending on the requirements of your application. + * @note The default is 16 bytes for both the transmission and receive + * buffers. + */ +#if !defined(SERIAL_BUFFERS_SIZE) || defined(__DOXYGEN__) +#define SERIAL_BUFFERS_SIZE 16 +#endif + +/*===========================================================================*/ +/* SERIAL_USB driver related setting. */ +/*===========================================================================*/ + +/** + * @brief Serial over USB buffers size. + * @details Configuration parameter, the buffer size must be a multiple of + * the USB data endpoint maximum packet size. + * @note The default is 256 bytes for both the transmission and receive + * buffers. + */ +#if !defined(SERIAL_USB_BUFFERS_SIZE) || defined(__DOXYGEN__) +#define SERIAL_USB_BUFFERS_SIZE 256 +#endif + +/** + * @brief Serial over USB number of buffers. + * @note The default is 2 buffers. + */ +#if !defined(SERIAL_USB_BUFFERS_NUMBER) || defined(__DOXYGEN__) +#define SERIAL_USB_BUFFERS_NUMBER 2 +#endif + +/*===========================================================================*/ +/* SPI driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables synchronous APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(SPI_USE_WAIT) || defined(__DOXYGEN__) +#define SPI_USE_WAIT TRUE +#endif + +/** + * @brief Enables the @p spiAcquireBus() and @p spiReleaseBus() APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(SPI_USE_MUTUAL_EXCLUSION) || defined(__DOXYGEN__) +#define SPI_USE_MUTUAL_EXCLUSION TRUE +#endif + +/*===========================================================================*/ +/* UART driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables synchronous APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(UART_USE_WAIT) || defined(__DOXYGEN__) +#define UART_USE_WAIT FALSE +#endif + +/** + * @brief Enables the @p uartAcquireBus() and @p uartReleaseBus() APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(UART_USE_MUTUAL_EXCLUSION) || defined(__DOXYGEN__) +#define UART_USE_MUTUAL_EXCLUSION FALSE +#endif + +/*===========================================================================*/ +/* USB driver related settings. */ +/*===========================================================================*/ + +/** + * @brief Enables synchronous APIs. + * @note Disabling this option saves both code and data space. + */ +#if !defined(USB_USE_WAIT) || defined(__DOXYGEN__) +#define USB_USE_WAIT FALSE +#endif + +#endif /* HALCONF_H */ + +/** @} */ diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/main.c b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/main.c new file mode 100644 index 000000000..011a30cda --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/main.c @@ -0,0 +1,132 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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 "ch.h" +#include "hal.h" + +#include "usbcfg.h" + +#include "chprintf.h" +#include "lis3dsh.h" + +/* Enable use of special ANSI escape sequences */ +#define CHPRINTF_USE_ANSI_CODE TRUE + +static BaseSequentialStream * chp = (BaseSequentialStream*) &SDU1; + +/* LIS3DSH Driver: This object represent an LIS3DSH instance */ +static LIS3DSHDriver LIS3DSHD1; + +static int32_t rawdata[LIS3DSH_NUMBER_OF_AXES]; +static float cookeddata[LIS3DSH_NUMBER_OF_AXES]; + +static char axesID[LIS3DSH_NUMBER_OF_AXES] = {'X', 'Y', 'Z'}; +static uint32_t i; + +static const SPIConfig spicfg = { + NULL, + GPIOE, /* port of LIS3DSH CS */ + GPIOE_CS_SPI, /* pin of LIS3DSH CS */ + SPI_CR1_BR_1 | SPI_CR1_CPOL | SPI_CR1_CPHA,/* CR1 register*/ /* CR2 register */ +}; + +static LIS3DSHConfig lis3dshcfg = { + &SPID1, /* Pointer to SPI Driver */ + &spicfg, /* Pointer to SPI Configuration */ + LIS3DSH_FS_2G, /* Full scale value */ + LIS3DSH_ODR_100HZ, /* Output data rate */ + LIS3DSH_BW_200HZ, /* AA filter BW 200 Hz */ + LIS3DSH_AE_XYZ, /* Enabled axes */ + LIS3DSH_BDU_BLOCKED, /* Block data update blocked */ + LIS3DSH_ACC_UNIT_G /* Measurement unit for cooked */ +}; + +/* + * LED blinker thread, times are in milliseconds. + */ +static THD_WORKING_AREA(waThread1, 128); +static THD_FUNCTION(Thread1, arg) { + + (void)arg; + chRegSetThreadName("blinker"); + while (true) { + palToggleLine(LINE_LED6); + chThdSleepMilliseconds(250); + } +} + +/* + * Application entry point. + */ +int main(void) { + + /* + * System initializations. + * - HAL initialization, this also initializes the configured device drivers + * and performs the board-specific initializations. + * - Kernel initialization, the main() function becomes a thread and the + * RTOS is active. + */ + halInit(); + chSysInit(); + + /* + * Initializes a serial-over-USB CDC driver. + */ + sduObjectInit(&SDU1); + sduStart(&SDU1, &serusbcfg); + + /* + * Activates the USB driver and then the USB bus pull-up on D+. + * Note, a delay is inserted in order to not have to disconnect the cable + * after a reset. + */ + usbDisconnectBus(serusbcfg.usbp); + chThdSleepMilliseconds(1500); + usbStart(serusbcfg.usbp, &usbcfg); + usbConnectBus(serusbcfg.usbp); + /* + * Creates the blinker thread. + */ + chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO + 1, Thread1, NULL); + + /* + * LIS3DSH Object Initialization + */ + lis3dshObjectInit(&LIS3DSHD1); + + /* + * Activates the LIS3DSH driver. + */ + lis3dshStart(&LIS3DSHD1, &lis3dshcfg); + + while (TRUE) { + palToggleLine(LINE_LED3); + accelerometerReadRaw(&LIS3DSHD1, rawdata); + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + chprintf(chp, "RAW-%c:%d\r\n", axesID[i], rawdata[i]); + + accelerometerReadCooked(&LIS3DSHD1, cookeddata); + for(i = 0; i < LIS3DSH_NUMBER_OF_AXES; i++) + chprintf(chp, "COOKED-%c:%.3f\r\n", axesID[i], cookeddata[i]); + + chThdSleepMilliseconds(150); +#if CHPRINTF_USE_ANSI_CODE + chprintf(chp, "\033[2J\033[1;1H"); +#endif + } + lis3dshStop(&LIS3DSHD1); +} diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/mcuconf.h b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/mcuconf.h new file mode 100644 index 000000000..e7046eda7 --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/mcuconf.h @@ -0,0 +1,342 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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. +*/ + +#ifndef MCUCONF_H +#define MCUCONF_H + +/* + * STM32F4xx drivers configuration. + * The following settings override the default settings present in + * the various device driver implementation headers. + * Note that the settings for each driver only have effect if the whole + * driver is enabled in halconf.h. + * + * IRQ priorities: + * 15...0 Lowest...Highest. + * + * DMA priorities: + * 0...3 Lowest...Highest. + */ + +#define STM32F4xx_MCUCONF + +/* + * HAL driver system settings. + */ +#define STM32_NO_INIT FALSE +#define STM32_HSI_ENABLED TRUE +#define STM32_LSI_ENABLED TRUE +#define STM32_HSE_ENABLED TRUE +#define STM32_LSE_ENABLED FALSE +#define STM32_CLOCK48_REQUIRED TRUE +#define STM32_SW STM32_SW_PLL +#define STM32_PLLSRC STM32_PLLSRC_HSE +#define STM32_PLLM_VALUE 8 +#define STM32_PLLN_VALUE 336 +#define STM32_PLLP_VALUE 2 +#define STM32_PLLQ_VALUE 7 +#define STM32_HPRE STM32_HPRE_DIV1 +#define STM32_PPRE1 STM32_PPRE1_DIV4 +#define STM32_PPRE2 STM32_PPRE2_DIV2 +#define STM32_RTCSEL STM32_RTCSEL_LSI +#define STM32_RTCPRE_VALUE 8 +#define STM32_MCO1SEL STM32_MCO1SEL_HSI +#define STM32_MCO1PRE STM32_MCO1PRE_DIV1 +#define STM32_MCO2SEL STM32_MCO2SEL_SYSCLK +#define STM32_MCO2PRE STM32_MCO2PRE_DIV5 +#define STM32_I2SSRC STM32_I2SSRC_CKIN +#define STM32_PLLI2SN_VALUE 192 +#define STM32_PLLI2SR_VALUE 5 +#define STM32_PVD_ENABLE FALSE +#define STM32_PLS STM32_PLS_LEV0 +#define STM32_BKPRAM_ENABLE FALSE + +/* + * ADC driver system settings. + */ +#define STM32_ADC_ADCPRE ADC_CCR_ADCPRE_DIV4 +#define STM32_ADC_USE_ADC1 FALSE +#define STM32_ADC_USE_ADC2 FALSE +#define STM32_ADC_USE_ADC3 FALSE +#define STM32_ADC_ADC1_DMA_STREAM STM32_DMA_STREAM_ID(2, 4) +#define STM32_ADC_ADC2_DMA_STREAM STM32_DMA_STREAM_ID(2, 2) +#define STM32_ADC_ADC3_DMA_STREAM STM32_DMA_STREAM_ID(2, 1) +#define STM32_ADC_ADC1_DMA_PRIORITY 2 +#define STM32_ADC_ADC2_DMA_PRIORITY 2 +#define STM32_ADC_ADC3_DMA_PRIORITY 2 +#define STM32_ADC_IRQ_PRIORITY 6 +#define STM32_ADC_ADC1_DMA_IRQ_PRIORITY 6 +#define STM32_ADC_ADC2_DMA_IRQ_PRIORITY 6 +#define STM32_ADC_ADC3_DMA_IRQ_PRIORITY 6 + +/* + * CAN driver system settings. + */ +#define STM32_CAN_USE_CAN1 FALSE +#define STM32_CAN_USE_CAN2 FALSE +#define STM32_CAN_CAN1_IRQ_PRIORITY 11 +#define STM32_CAN_CAN2_IRQ_PRIORITY 11 + +/* + * DAC driver system settings. + */ +#define STM32_DAC_DUAL_MODE FALSE +#define STM32_DAC_USE_DAC1_CH1 FALSE +#define STM32_DAC_USE_DAC1_CH2 FALSE +#define STM32_DAC_DAC1_CH1_IRQ_PRIORITY 10 +#define STM32_DAC_DAC1_CH2_IRQ_PRIORITY 10 +#define STM32_DAC_DAC1_CH1_DMA_PRIORITY 2 +#define STM32_DAC_DAC1_CH2_DMA_PRIORITY 2 +#define STM32_DAC_DAC1_CH1_DMA_STREAM STM32_DMA_STREAM_ID(1, 5) +#define STM32_DAC_DAC1_CH2_DMA_STREAM STM32_DMA_STREAM_ID(1, 6) + +/* + * EXT driver system settings. + */ +#define STM32_EXT_EXTI0_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI1_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI2_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI3_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI4_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI5_9_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI10_15_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI16_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI17_IRQ_PRIORITY 15 +#define STM32_EXT_EXTI18_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI19_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI20_IRQ_PRIORITY 6 +#define STM32_EXT_EXTI21_IRQ_PRIORITY 15 +#define STM32_EXT_EXTI22_IRQ_PRIORITY 15 + +/* + * GPT driver system settings. + */ +#define STM32_GPT_USE_TIM1 FALSE +#define STM32_GPT_USE_TIM2 FALSE +#define STM32_GPT_USE_TIM3 FALSE +#define STM32_GPT_USE_TIM4 FALSE +#define STM32_GPT_USE_TIM5 FALSE +#define STM32_GPT_USE_TIM6 FALSE +#define STM32_GPT_USE_TIM7 FALSE +#define STM32_GPT_USE_TIM8 FALSE +#define STM32_GPT_USE_TIM9 FALSE +#define STM32_GPT_USE_TIM11 FALSE +#define STM32_GPT_USE_TIM12 FALSE +#define STM32_GPT_USE_TIM14 FALSE +#define STM32_GPT_TIM1_IRQ_PRIORITY 7 +#define STM32_GPT_TIM2_IRQ_PRIORITY 7 +#define STM32_GPT_TIM3_IRQ_PRIORITY 7 +#define STM32_GPT_TIM4_IRQ_PRIORITY 7 +#define STM32_GPT_TIM5_IRQ_PRIORITY 7 +#define STM32_GPT_TIM6_IRQ_PRIORITY 7 +#define STM32_GPT_TIM7_IRQ_PRIORITY 7 +#define STM32_GPT_TIM8_IRQ_PRIORITY 7 +#define STM32_GPT_TIM9_IRQ_PRIORITY 7 +#define STM32_GPT_TIM11_IRQ_PRIORITY 7 +#define STM32_GPT_TIM12_IRQ_PRIORITY 7 +#define STM32_GPT_TIM14_IRQ_PRIORITY 7 + +/* + * I2C driver system settings. + */ +#define STM32_I2C_USE_I2C1 FALSE +#define STM32_I2C_USE_I2C2 FALSE +#define STM32_I2C_USE_I2C3 FALSE +#define STM32_I2C_BUSY_TIMEOUT 50 +#define STM32_I2C_I2C1_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 0) +#define STM32_I2C_I2C1_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 6) +#define STM32_I2C_I2C2_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 2) +#define STM32_I2C_I2C2_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 7) +#define STM32_I2C_I2C3_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 2) +#define STM32_I2C_I2C3_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 4) +#define STM32_I2C_I2C1_IRQ_PRIORITY 5 +#define STM32_I2C_I2C2_IRQ_PRIORITY 5 +#define STM32_I2C_I2C3_IRQ_PRIORITY 5 +#define STM32_I2C_I2C1_DMA_PRIORITY 3 +#define STM32_I2C_I2C2_DMA_PRIORITY 3 +#define STM32_I2C_I2C3_DMA_PRIORITY 3 +#define STM32_I2C_DMA_ERROR_HOOK(i2cp) osalSysHalt("DMA failure") + +/* + * I2S driver system settings. + */ +#define STM32_I2S_USE_SPI2 FALSE +#define STM32_I2S_USE_SPI3 FALSE +#define STM32_I2S_SPI2_IRQ_PRIORITY 10 +#define STM32_I2S_SPI3_IRQ_PRIORITY 10 +#define STM32_I2S_SPI2_DMA_PRIORITY 1 +#define STM32_I2S_SPI3_DMA_PRIORITY 1 +#define STM32_I2S_SPI2_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 3) +#define STM32_I2S_SPI2_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 4) +#define STM32_I2S_SPI3_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 0) +#define STM32_I2S_SPI3_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 7) +#define STM32_I2S_DMA_ERROR_HOOK(i2sp) osalSysHalt("DMA failure") + +/* + * ICU driver system settings. + */ +#define STM32_ICU_USE_TIM1 FALSE +#define STM32_ICU_USE_TIM2 FALSE +#define STM32_ICU_USE_TIM3 FALSE +#define STM32_ICU_USE_TIM4 FALSE +#define STM32_ICU_USE_TIM5 FALSE +#define STM32_ICU_USE_TIM8 FALSE +#define STM32_ICU_USE_TIM9 FALSE +#define STM32_ICU_TIM1_IRQ_PRIORITY 7 +#define STM32_ICU_TIM2_IRQ_PRIORITY 7 +#define STM32_ICU_TIM3_IRQ_PRIORITY 7 +#define STM32_ICU_TIM4_IRQ_PRIORITY 7 +#define STM32_ICU_TIM5_IRQ_PRIORITY 7 +#define STM32_ICU_TIM8_IRQ_PRIORITY 7 +#define STM32_ICU_TIM9_IRQ_PRIORITY 7 + +/* + * MAC driver system settings. + */ +#define STM32_MAC_TRANSMIT_BUFFERS 2 +#define STM32_MAC_RECEIVE_BUFFERS 4 +#define STM32_MAC_BUFFERS_SIZE 1522 +#define STM32_MAC_PHY_TIMEOUT 100 +#define STM32_MAC_ETH1_CHANGE_PHY_STATE TRUE +#define STM32_MAC_ETH1_IRQ_PRIORITY 13 +#define STM32_MAC_IP_CHECKSUM_OFFLOAD 0 + +/* + * PWM driver system settings. + */ +#define STM32_PWM_USE_ADVANCED FALSE +#define STM32_PWM_USE_TIM1 FALSE +#define STM32_PWM_USE_TIM2 FALSE +#define STM32_PWM_USE_TIM3 FALSE +#define STM32_PWM_USE_TIM4 FALSE +#define STM32_PWM_USE_TIM5 FALSE +#define STM32_PWM_USE_TIM8 FALSE +#define STM32_PWM_USE_TIM9 FALSE +#define STM32_PWM_TIM1_IRQ_PRIORITY 7 +#define STM32_PWM_TIM2_IRQ_PRIORITY 7 +#define STM32_PWM_TIM3_IRQ_PRIORITY 7 +#define STM32_PWM_TIM4_IRQ_PRIORITY 7 +#define STM32_PWM_TIM5_IRQ_PRIORITY 7 +#define STM32_PWM_TIM8_IRQ_PRIORITY 7 +#define STM32_PWM_TIM9_IRQ_PRIORITY 7 + +/* + * SDC driver system settings. + */ +#define STM32_SDC_SDIO_DMA_PRIORITY 3 +#define STM32_SDC_SDIO_IRQ_PRIORITY 9 +#define STM32_SDC_WRITE_TIMEOUT_MS 250 +#define STM32_SDC_READ_TIMEOUT_MS 25 +#define STM32_SDC_CLOCK_ACTIVATION_DELAY 10 +#define STM32_SDC_SDIO_UNALIGNED_SUPPORT TRUE +#define STM32_SDC_SDIO_DMA_STREAM STM32_DMA_STREAM_ID(2, 3) + +/* + * SERIAL driver system settings. + */ +#define STM32_SERIAL_USE_USART1 FALSE +#define STM32_SERIAL_USE_USART2 FALSE +#define STM32_SERIAL_USE_USART3 FALSE +#define STM32_SERIAL_USE_UART4 FALSE +#define STM32_SERIAL_USE_UART5 FALSE +#define STM32_SERIAL_USE_USART6 FALSE +#define STM32_SERIAL_USART1_PRIORITY 12 +#define STM32_SERIAL_USART2_PRIORITY 12 +#define STM32_SERIAL_USART3_PRIORITY 12 +#define STM32_SERIAL_UART4_PRIORITY 12 +#define STM32_SERIAL_UART5_PRIORITY 12 +#define STM32_SERIAL_USART6_PRIORITY 12 + +/* + * SPI driver system settings. + */ +#define STM32_SPI_USE_SPI1 TRUE +#define STM32_SPI_USE_SPI2 TRUE +#define STM32_SPI_USE_SPI3 TRUE +#define STM32_SPI_SPI1_RX_DMA_STREAM STM32_DMA_STREAM_ID(2, 0) +#define STM32_SPI_SPI1_TX_DMA_STREAM STM32_DMA_STREAM_ID(2, 3) +#define STM32_SPI_SPI2_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 3) +#define STM32_SPI_SPI2_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 4) +#define STM32_SPI_SPI3_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 0) +#define STM32_SPI_SPI3_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 7) +#define STM32_SPI_SPI1_DMA_PRIORITY 1 +#define STM32_SPI_SPI2_DMA_PRIORITY 1 +#define STM32_SPI_SPI3_DMA_PRIORITY 1 +#define STM32_SPI_SPI1_IRQ_PRIORITY 10 +#define STM32_SPI_SPI2_IRQ_PRIORITY 10 +#define STM32_SPI_SPI3_IRQ_PRIORITY 10 +#define STM32_SPI_DMA_ERROR_HOOK(spip) osalSysHalt("DMA failure") + +/* + * ST driver system settings. + */ +#define STM32_ST_IRQ_PRIORITY 8 +#define STM32_ST_USE_TIMER 2 + +/* + * UART driver system settings. + */ +#define STM32_UART_USE_USART1 FALSE +#define STM32_UART_USE_USART2 FALSE +#define STM32_UART_USE_USART3 FALSE +#define STM32_UART_USE_UART4 FALSE +#define STM32_UART_USE_UART5 FALSE +#define STM32_UART_USE_USART6 FALSE +#define STM32_UART_USART1_RX_DMA_STREAM STM32_DMA_STREAM_ID(2, 5) +#define STM32_UART_USART1_TX_DMA_STREAM STM32_DMA_STREAM_ID(2, 7) +#define STM32_UART_USART2_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 5) +#define STM32_UART_USART2_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 6) +#define STM32_UART_USART3_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 1) +#define STM32_UART_USART3_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 3) +#define STM32_UART_UART4_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 2) +#define STM32_UART_UART4_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 4) +#define STM32_UART_UART5_RX_DMA_STREAM STM32_DMA_STREAM_ID(1, 0) +#define STM32_UART_UART5_TX_DMA_STREAM STM32_DMA_STREAM_ID(1, 7) +#define STM32_UART_USART6_RX_DMA_STREAM STM32_DMA_STREAM_ID(2, 2) +#define STM32_UART_USART6_TX_DMA_STREAM STM32_DMA_STREAM_ID(2, 7) +#define STM32_UART_USART1_IRQ_PRIORITY 12 +#define STM32_UART_USART2_IRQ_PRIORITY 12 +#define STM32_UART_USART3_IRQ_PRIORITY 12 +#define STM32_UART_UART4_IRQ_PRIORITY 12 +#define STM32_UART_UART5_IRQ_PRIORITY 12 +#define STM32_UART_USART6_IRQ_PRIORITY 12 +#define STM32_UART_USART1_DMA_PRIORITY 0 +#define STM32_UART_USART2_DMA_PRIORITY 0 +#define STM32_UART_USART3_DMA_PRIORITY 0 +#define STM32_UART_UART4_DMA_PRIORITY 0 +#define STM32_UART_UART5_DMA_PRIORITY 0 +#define STM32_UART_USART6_DMA_PRIORITY 0 +#define STM32_UART_DMA_ERROR_HOOK(uartp) osalSysHalt("DMA failure") + +/* + * USB driver system settings. + */ +#define STM32_USB_USE_OTG1 TRUE +#define STM32_USB_USE_OTG2 FALSE +#define STM32_USB_OTG1_IRQ_PRIORITY 14 +#define STM32_USB_OTG2_IRQ_PRIORITY 14 +#define STM32_USB_OTG1_RX_FIFO_SIZE 512 +#define STM32_USB_OTG2_RX_FIFO_SIZE 1024 +#define STM32_USB_OTG_THREAD_PRIO LOWPRIO +#define STM32_USB_OTG_THREAD_STACK_SIZE 128 +#define STM32_USB_OTGFIFO_FILL_BASEPRI 0 + +/* + * WDG driver system settings. + */ +#define STM32_WDG_USE_IWDG FALSE + +#endif /* MCUCONF_H */ diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/readme.txt b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/readme.txt new file mode 100644 index 000000000..c5d7d7bfb --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/readme.txt @@ -0,0 +1,27 @@ +***************************************************************************** +** ChibiOS/HAL + ChibiOS/EX - SPI + LIS3DSH demo for STM32F4xx. ** +***************************************************************************** + +** TARGET ** + +The demo runs on an STM32F407 Discovery board rev MB997C and MB997D. + +** The Demo ** + +The demo flashes the board LED using a thread, read data from LIS3DSH printing +it on a BaseSequentialStream (SDU1, mapped on USB virtual COM port). + +** Build Procedure ** + +The demo has been tested by using the free Codesourcery GCC-based toolchain +and YAGARTO. +Just modify the TRGT line in the makefile in order to use different GCC ports. + +** Notes ** + +Some files used by the demo are not part of ChibiOS/RT but are copyright of +ST Microelectronics and are licensed under a different license. +Also note that not all the files present in the ST library are distributed +with ChibiOS/RT, you can find the whole library on the ST web site: + + http://www.st.com diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.c b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.c new file mode 100644 index 000000000..13a2e7ee3 --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.c @@ -0,0 +1,334 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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 "hal.h" + +/* Virtual serial port over USB.*/ +SerialUSBDriver SDU1; + +/* + * Endpoints to be used for USBD1. + */ +#define USBD1_DATA_REQUEST_EP 1 +#define USBD1_DATA_AVAILABLE_EP 1 +#define USBD1_INTERRUPT_REQUEST_EP 2 + +/* + * USB Device Descriptor. + */ +static const uint8_t vcom_device_descriptor_data[18] = { + USB_DESC_DEVICE (0x0110, /* bcdUSB (1.1). */ + 0x02, /* bDeviceClass (CDC). */ + 0x00, /* bDeviceSubClass. */ + 0x00, /* bDeviceProtocol. */ + 0x40, /* bMaxPacketSize. */ + 0x0483, /* idVendor (ST). */ + 0x5740, /* idProduct. */ + 0x0200, /* bcdDevice. */ + 1, /* iManufacturer. */ + 2, /* iProduct. */ + 3, /* iSerialNumber. */ + 1) /* bNumConfigurations. */ +}; + +/* + * Device Descriptor wrapper. + */ +static const USBDescriptor vcom_device_descriptor = { + sizeof vcom_device_descriptor_data, + vcom_device_descriptor_data +}; + +/* Configuration Descriptor tree for a CDC.*/ +static const uint8_t vcom_configuration_descriptor_data[67] = { + /* Configuration Descriptor.*/ + USB_DESC_CONFIGURATION(67, /* wTotalLength. */ + 0x02, /* bNumInterfaces. */ + 0x01, /* bConfigurationValue. */ + 0, /* iConfiguration. */ + 0xC0, /* bmAttributes (self powered). */ + 50), /* bMaxPower (100mA). */ + /* Interface Descriptor.*/ + USB_DESC_INTERFACE (0x00, /* bInterfaceNumber. */ + 0x00, /* bAlternateSetting. */ + 0x01, /* bNumEndpoints. */ + 0x02, /* bInterfaceClass (Communications + Interface Class, CDC section + 4.2). */ + 0x02, /* bInterfaceSubClass (Abstract + Control Model, CDC section 4.3). */ + 0x01, /* bInterfaceProtocol (AT commands, + CDC section 4.4). */ + 0), /* iInterface. */ + /* Header Functional Descriptor (CDC section 5.2.3).*/ + USB_DESC_BYTE (5), /* bLength. */ + USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */ + USB_DESC_BYTE (0x00), /* bDescriptorSubtype (Header + Functional Descriptor. */ + USB_DESC_BCD (0x0110), /* bcdCDC. */ + /* Call Management Functional Descriptor. */ + USB_DESC_BYTE (5), /* bFunctionLength. */ + USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */ + USB_DESC_BYTE (0x01), /* bDescriptorSubtype (Call Management + Functional Descriptor). */ + USB_DESC_BYTE (0x00), /* bmCapabilities (D0+D1). */ + USB_DESC_BYTE (0x01), /* bDataInterface. */ + /* ACM Functional Descriptor.*/ + USB_DESC_BYTE (4), /* bFunctionLength. */ + USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */ + USB_DESC_BYTE (0x02), /* bDescriptorSubtype (Abstract + Control Management Descriptor). */ + USB_DESC_BYTE (0x02), /* bmCapabilities. */ + /* Union Functional Descriptor.*/ + USB_DESC_BYTE (5), /* bFunctionLength. */ + USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */ + USB_DESC_BYTE (0x06), /* bDescriptorSubtype (Union + Functional Descriptor). */ + USB_DESC_BYTE (0x00), /* bMasterInterface (Communication + Class Interface). */ + USB_DESC_BYTE (0x01), /* bSlaveInterface0 (Data Class + Interface). */ + /* Endpoint 2 Descriptor.*/ + USB_DESC_ENDPOINT (USBD1_INTERRUPT_REQUEST_EP|0x80, + 0x03, /* bmAttributes (Interrupt). */ + 0x0008, /* wMaxPacketSize. */ + 0xFF), /* bInterval. */ + /* Interface Descriptor.*/ + USB_DESC_INTERFACE (0x01, /* bInterfaceNumber. */ + 0x00, /* bAlternateSetting. */ + 0x02, /* bNumEndpoints. */ + 0x0A, /* bInterfaceClass (Data Class + Interface, CDC section 4.5). */ + 0x00, /* bInterfaceSubClass (CDC section + 4.6). */ + 0x00, /* bInterfaceProtocol (CDC section + 4.7). */ + 0x00), /* iInterface. */ + /* Endpoint 3 Descriptor.*/ + USB_DESC_ENDPOINT (USBD1_DATA_AVAILABLE_EP, /* bEndpointAddress.*/ + 0x02, /* bmAttributes (Bulk). */ + 0x0040, /* wMaxPacketSize. */ + 0x00), /* bInterval. */ + /* Endpoint 1 Descriptor.*/ + USB_DESC_ENDPOINT (USBD1_DATA_REQUEST_EP|0x80, /* bEndpointAddress.*/ + 0x02, /* bmAttributes (Bulk). */ + 0x0040, /* wMaxPacketSize. */ + 0x00) /* bInterval. */ +}; + +/* + * Configuration Descriptor wrapper. + */ +static const USBDescriptor vcom_configuration_descriptor = { + sizeof vcom_configuration_descriptor_data, + vcom_configuration_descriptor_data +}; + +/* + * U.S. English language identifier. + */ +static const uint8_t vcom_string0[] = { + USB_DESC_BYTE(4), /* bLength. */ + USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */ + USB_DESC_WORD(0x0409) /* wLANGID (U.S. English). */ +}; + +/* + * Vendor string. + */ +static const uint8_t vcom_string1[] = { + USB_DESC_BYTE(38), /* bLength. */ + USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */ + 'S', 0, 'T', 0, 'M', 0, 'i', 0, 'c', 0, 'r', 0, 'o', 0, 'e', 0, + 'l', 0, 'e', 0, 'c', 0, 't', 0, 'r', 0, 'o', 0, 'n', 0, 'i', 0, + 'c', 0, 's', 0 +}; + +/* + * Device Description string. + */ +static const uint8_t vcom_string2[] = { + USB_DESC_BYTE(56), /* bLength. */ + USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */ + 'C', 0, 'h', 0, 'i', 0, 'b', 0, 'i', 0, 'O', 0, 'S', 0, '/', 0, + 'R', 0, 'T', 0, ' ', 0, 'V', 0, 'i', 0, 'r', 0, 't', 0, 'u', 0, + 'a', 0, 'l', 0, ' ', 0, 'C', 0, 'O', 0, 'M', 0, ' ', 0, 'P', 0, + 'o', 0, 'r', 0, 't', 0 +}; + +/* + * Serial Number string. + */ +static const uint8_t vcom_string3[] = { + USB_DESC_BYTE(8), /* bLength. */ + USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */ + '0' + CH_KERNEL_MAJOR, 0, + '0' + CH_KERNEL_MINOR, 0, + '0' + CH_KERNEL_PATCH, 0 +}; + +/* + * Strings wrappers array. + */ +static const USBDescriptor vcom_strings[] = { + {sizeof vcom_string0, vcom_string0}, + {sizeof vcom_string1, vcom_string1}, + {sizeof vcom_string2, vcom_string2}, + {sizeof vcom_string3, vcom_string3} +}; + +/* + * Handles the GET_DESCRIPTOR callback. All required descriptors must be + * handled here. + */ +static const USBDescriptor *get_descriptor(USBDriver *usbp, + uint8_t dtype, + uint8_t dindex, + uint16_t lang) { + + (void)usbp; + (void)lang; + switch (dtype) { + case USB_DESCRIPTOR_DEVICE: + return &vcom_device_descriptor; + case USB_DESCRIPTOR_CONFIGURATION: + return &vcom_configuration_descriptor; + case USB_DESCRIPTOR_STRING: + if (dindex < 4) + return &vcom_strings[dindex]; + } + return NULL; +} + +/** + * @brief IN EP1 state. + */ +static USBInEndpointState ep1instate; + +/** + * @brief OUT EP1 state. + */ +static USBOutEndpointState ep1outstate; + +/** + * @brief EP1 initialization structure (both IN and OUT). + */ +static const USBEndpointConfig ep1config = { + USB_EP_MODE_TYPE_BULK, + NULL, + sduDataTransmitted, + sduDataReceived, + 0x0040, + 0x0040, + &ep1instate, + &ep1outstate, + 2, + NULL +}; + +/** + * @brief IN EP2 state. + */ +static USBInEndpointState ep2instate; + +/** + * @brief EP2 initialization structure (IN only). + */ +static const USBEndpointConfig ep2config = { + USB_EP_MODE_TYPE_INTR, + NULL, + sduInterruptTransmitted, + NULL, + 0x0010, + 0x0000, + &ep2instate, + NULL, + 1, + NULL +}; + +/* + * Handles the USB driver global events. + */ +static void usb_event(USBDriver *usbp, usbevent_t event) { + extern SerialUSBDriver SDU1; + + switch (event) { + case USB_EVENT_RESET: + return; + case USB_EVENT_ADDRESS: + return; + case USB_EVENT_CONFIGURED: + chSysLockFromISR(); + + /* Enables the endpoints specified into the configuration. + Note, this callback is invoked from an ISR so I-Class functions + must be used.*/ + usbInitEndpointI(usbp, USBD1_DATA_REQUEST_EP, &ep1config); + usbInitEndpointI(usbp, USBD1_INTERRUPT_REQUEST_EP, &ep2config); + + /* Resetting the state of the CDC subsystem.*/ + sduConfigureHookI(&SDU1); + + chSysUnlockFromISR(); + return; + case USB_EVENT_SUSPEND: + chSysLockFromISR(); + + /* Disconnection event on suspend.*/ + sduDisconnectI(&SDU1); + + chSysUnlockFromISR(); + return; + case USB_EVENT_WAKEUP: + return; + case USB_EVENT_STALLED: + return; + } + return; +} + +/* + * Handles the USB driver global events. + */ +static void sof_handler(USBDriver *usbp) { + + (void)usbp; + + osalSysLockFromISR(); + sduSOFHookI(&SDU1); + osalSysUnlockFromISR(); +} + +/* + * USB driver configuration. + */ +const USBConfig usbcfg = { + usb_event, + get_descriptor, + sduRequestsHook, + sof_handler +}; + +/* + * Serial over USB driver configuration. + */ +const SerialUSBConfig serusbcfg = { + &USBD1, + USBD1_DATA_REQUEST_EP, + USBD1_DATA_AVAILABLE_EP, + USBD1_INTERRUPT_REQUEST_EP +}; diff --git a/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.h b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.h new file mode 100644 index 000000000..3833bf9fd --- /dev/null +++ b/testhal/STM32/STM32F4xx/SPI-LIS3DSH/usbcfg.h @@ -0,0 +1,26 @@ +/* + ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio + + 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. +*/ + +#ifndef USBCFG_H +#define USBCFG_H + +extern const USBConfig usbcfg; +extern SerialUSBConfig serusbcfg; +extern SerialUSBDriver SDU1; + +#endif /* USBCFG_H */ + +/** @} */