amiro-os / modules / DiWheelDrive_1-1 / module.c @ 2745c37f
History | View | Annotate | Download (19.563 KB)
| 1 | e545e620 | Thomas Schöpping | /*
|
|---|---|---|---|
| 2 | AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
|
||
| 3 | 96621a83 | Thomas Schöpping | Copyright (C) 2016..2020 Thomas Schöpping et al.
|
| 4 | e545e620 | Thomas Schöpping | |
| 5 | This program is free software: you can redistribute it and/or modify
|
||
| 6 | it under the terms of the GNU General Public License as published by
|
||
| 7 | the Free Software Foundation, either version 3 of the License, or
|
||
| 8 | (at your option) any later version.
|
||
| 9 | |||
| 10 | This program is distributed in the hope that it will be useful,
|
||
| 11 | but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
| 12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
| 13 | GNU General Public License for more details.
|
||
| 14 | |||
| 15 | You should have received a copy of the GNU General Public License
|
||
| 16 | along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
| 17 | */
|
||
| 18 | |||
| 19 | 53710ca3 | Marc Rothmann | /**
|
| 20 | acc97cbf | Thomas Schöpping | * @file
|
| 21 | 53710ca3 | Marc Rothmann | * @brief Structures and constant for the DiWheelDrive module.
|
| 22 | *
|
||
| 23 | * @addtogroup diwheeldrive_module
|
||
| 24 | * @{
|
||
| 25 | */
|
||
| 26 | |||
| 27 | c53ef0b1 | Thomas Schöpping | #include <amiroos.h> |
| 28 | |||
| 29 | #include <string.h> |
||
| 30 | e545e620 | Thomas Schöpping | |
| 31 | /*===========================================================================*/
|
||
| 32 | /**
|
||
| 33 | * @name Module specific functions
|
||
| 34 | * @{
|
||
| 35 | */
|
||
| 36 | /*===========================================================================*/
|
||
| 37 | |||
| 38 | /** @} */
|
||
| 39 | |||
| 40 | /*===========================================================================*/
|
||
| 41 | /**
|
||
| 42 | * @name ChibiOS/HAL configuration
|
||
| 43 | * @{
|
||
| 44 | */
|
||
| 45 | /*===========================================================================*/
|
||
| 46 | |||
| 47 | CANConfig moduleHalCanConfig = {
|
||
| 48 | /* mcr */ CAN_MCR_ABOM | CAN_MCR_AWUM | CAN_MCR_TXFP,
|
||
| 49 | /* btr */ CAN_BTR_SJW(1) | CAN_BTR_TS2(2) | CAN_BTR_TS1(13) | CAN_BTR_BRP(1), |
||
| 50 | }; |
||
| 51 | |||
| 52 | I2CConfig moduleHalI2cCompassConfig = {
|
||
| 53 | /* I²C mode */ OPMODE_I2C,
|
||
| 54 | /* frequency */ 400000, |
||
| 55 | /* duty cycle */ FAST_DUTY_CYCLE_2,
|
||
| 56 | }; |
||
| 57 | |||
| 58 | I2CConfig moduleHalI2cProxEepromPwrmtrConfig = {
|
||
| 59 | /* I²C mode */ OPMODE_I2C,
|
||
| 60 | /* frequency */ 400000, |
||
| 61 | /* duty cycle */ FAST_DUTY_CYCLE_2,
|
||
| 62 | }; |
||
| 63 | |||
| 64 | PWMConfig moduleHalPwmDriveConfig = {
|
||
| 65 | /* frequency */ 7200000, |
||
| 66 | /* period */ 360, |
||
| 67 | /* callback */ NULL, |
||
| 68 | /* channel configurations */ {
|
||
| 69 | /* channel 0 */ {
|
||
| 70 | /* mode */ PWM_OUTPUT_ACTIVE_HIGH,
|
||
| 71 | /* callback */ NULL |
||
| 72 | }, |
||
| 73 | /* channel 1 */ {
|
||
| 74 | /* mode */ PWM_OUTPUT_ACTIVE_HIGH,
|
||
| 75 | /* callback */ NULL |
||
| 76 | }, |
||
| 77 | /* channel 2 */ {
|
||
| 78 | /* mode */ PWM_OUTPUT_ACTIVE_HIGH,
|
||
| 79 | /* callback */ NULL |
||
| 80 | }, |
||
| 81 | /* channel 3 */ {
|
||
| 82 | /* mode */ PWM_OUTPUT_ACTIVE_HIGH,
|
||
| 83 | /* callback */ NULL |
||
| 84 | }, |
||
| 85 | }, |
||
| 86 | /* TIM CR2 register */ 0, |
||
| 87 | 7de0cc90 | Thomas Schöpping | #if (STM32_PWM_USE_ADVANCED == TRUE)
|
| 88 | e545e620 | Thomas Schöpping | /* TIM BDTR register */ 0, |
| 89 | 7de0cc90 | Thomas Schöpping | #endif /* (STM32_PWM_USE_ADVANCED == TRUE) */ |
| 90 | e545e620 | Thomas Schöpping | /* TIM DIER register */ 0 |
| 91 | }; |
||
| 92 | |||
| 93 | QEIConfig moduleHalQeiConfig = {
|
||
| 94 | /* mode */ QEI_COUNT_BOTH,
|
||
| 95 | /* channel config */ {
|
||
| 96 | /* channel 0 */ {
|
||
| 97 | /* input mode */ QEI_INPUT_NONINVERTED,
|
||
| 98 | }, |
||
| 99 | /* channel 1 */ {
|
||
| 100 | /* input mode */ QEI_INPUT_NONINVERTED,
|
||
| 101 | }, |
||
| 102 | }, |
||
| 103 | /* encoder range */ 0x10000u, |
||
| 104 | }; |
||
| 105 | |||
| 106 | SerialConfig moduleHalProgIfConfig = {
|
||
| 107 | /* bit rate */ 115200, |
||
| 108 | /* CR1 */ 0, |
||
| 109 | /* CR1 */ 0, |
||
| 110 | /* CR1 */ 0, |
||
| 111 | }; |
||
| 112 | |||
| 113 | SPIConfig moduleHalSpiAccelerometerConfig = {
|
||
| 114 | 0128be0f | Marc Rothmann | /* circular buffer mode */ false, |
| 115 | e545e620 | Thomas Schöpping | /* callback function pointer */ NULL, |
| 116 | 3106e8cc | Thomas Schöpping | /* chip select line port */ PAL_PORT(LINE_ACCEL_SS_N),
|
| 117 | /* chip select line pad number */ PAL_PAD(LINE_ACCEL_SS_N),
|
||
| 118 | e545e620 | Thomas Schöpping | /* CR1 */ SPI_CR1_BR_0,
|
| 119 | /* CR2 */ SPI_CR2_RXDMAEN | SPI_CR2_TXDMAEN,
|
||
| 120 | }; |
||
| 121 | |||
| 122 | SPIConfig moduleHalSpiGyroscopeConfig = {
|
||
| 123 | 0128be0f | Marc Rothmann | /* circular buffer mode */ false, |
| 124 | e545e620 | Thomas Schöpping | /* callback function pointer */ NULL, |
| 125 | 3106e8cc | Thomas Schöpping | /* chip select line port */ PAL_PORT(LINE_GYRO_SS_N),
|
| 126 | /* chip select line pad number */ PAL_PAD(LINE_GYRO_SS_N),
|
||
| 127 | e545e620 | Thomas Schöpping | /* CR1 */ SPI_CR1_BR_0,
|
| 128 | /* CR2 */ SPI_CR2_RXDMAEN | SPI_CR2_TXDMAEN,
|
||
| 129 | }; |
||
| 130 | |||
| 131 | /** @} */
|
||
| 132 | |||
| 133 | /*===========================================================================*/
|
||
| 134 | /**
|
||
| 135 | * @name GPIO definitions
|
||
| 136 | * @{
|
||
| 137 | */
|
||
| 138 | /*===========================================================================*/
|
||
| 139 | |||
| 140 | 1e5f7648 | Thomas Schöpping | /**
|
| 141 | * @brief LED output signal GPIO.
|
||
| 142 | */
|
||
| 143 | static apalGpio_t _gpioLed = {
|
||
| 144 | 3106e8cc | Thomas Schöpping | /* line */ LINE_LED,
|
| 145 | e545e620 | Thomas Schöpping | }; |
| 146 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioLed = {
|
| 147 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioLed,
|
| 148 | /* meta */ {
|
||
| 149 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
| 150 | 4c72a54c | Thomas Schöpping | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
| 151 | 1e5f7648 | Thomas Schöpping | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
| 152 | }, |
||
| 153 | }; |
||
| 154 | e545e620 | Thomas Schöpping | |
| 155 | 1e5f7648 | Thomas Schöpping | /**
|
| 156 | * @brief POWER_EN output signal GPIO.
|
||
| 157 | */
|
||
| 158 | static apalGpio_t _gpioPowerEn = {
|
||
| 159 | 3106e8cc | Thomas Schöpping | /* line */ LINE_POWER_EN,
|
| 160 | e545e620 | Thomas Schöpping | }; |
| 161 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioPowerEn = {
|
| 162 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioPowerEn,
|
| 163 | /* meta */ {
|
||
| 164 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
| 165 | /* active state */ APAL_GPIO_ACTIVE_HIGH,
|
||
| 166 | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
||
| 167 | }, |
||
| 168 | }; |
||
| 169 | e545e620 | Thomas Schöpping | |
| 170 | 1e5f7648 | Thomas Schöpping | /**
|
| 171 | * @brief COMPASS_DRDY output signal GPIO.
|
||
| 172 | */
|
||
| 173 | static apalGpio_t _gpioCompassDrdy = {
|
||
| 174 | 3106e8cc | Thomas Schöpping | /* line */ LINE_COMPASS_DRDY,
|
| 175 | e545e620 | Thomas Schöpping | }; |
| 176 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioCompassDrdy = {
|
| 177 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioCompassDrdy,
|
| 178 | /* meta */ {
|
||
| 179 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 180 | /* active state */ (L3G4200D_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
| 181 | /* interrupt edge */ L3G4200D_LLD_INT_EDGE,
|
||
| 182 | }, |
||
| 183 | }; |
||
| 184 | e545e620 | Thomas Schöpping | |
| 185 | 1e5f7648 | Thomas Schöpping | /**
|
| 186 | * @brief IR_INT input signal GPIO.
|
||
| 187 | */
|
||
| 188 | static apalGpio_t _gpioIrInt = {
|
||
| 189 | 3106e8cc | Thomas Schöpping | /* line */ LINE_IR_INT,
|
| 190 | e545e620 | Thomas Schöpping | }; |
| 191 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioIrInt = {
|
| 192 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioIrInt,
|
| 193 | /* meta */ {
|
||
| 194 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 195 | /* active state */ (VCNL4020_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
| 196 | /* interrupt edge */ VCNL4020_LLD_INT_EDGE,
|
||
| 197 | }, |
||
| 198 | }; |
||
| 199 | e545e620 | Thomas Schöpping | |
| 200 | 1e5f7648 | Thomas Schöpping | /**
|
| 201 | * @brief GYRO_DRDY input signal GPIO.
|
||
| 202 | */
|
||
| 203 | static apalGpio_t _gpioGyroDrdy = {
|
||
| 204 | 3106e8cc | Thomas Schöpping | /* line */ LINE_GYRO_DRDY,
|
| 205 | e545e620 | Thomas Schöpping | }; |
| 206 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioGyroDrdy = {
|
| 207 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioGyroDrdy,
|
| 208 | /* meta */ {
|
||
| 209 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 210 | /* active state */ (L3G4200D_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
| 211 | /* interrupt edge */ L3G4200D_LLD_INT_EDGE,
|
||
| 212 | }, |
||
| 213 | }; |
||
| 214 | e545e620 | Thomas Schöpping | |
| 215 | 1e5f7648 | Thomas Schöpping | /**
|
| 216 | * @brief SYS_UART_UP bidirectional signal GPIO.
|
||
| 217 | */
|
||
| 218 | static apalGpio_t _gpioSysUartUp = {
|
||
| 219 | 3106e8cc | Thomas Schöpping | /* line */ LINE_SYS_UART_UP,
|
| 220 | e545e620 | Thomas Schöpping | }; |
| 221 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioSysUartUp = {
|
| 222 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioSysUartUp,
|
| 223 | /* meta */ {
|
||
| 224 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
| 225 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
| 226 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 227 | }, |
||
| 228 | }; |
||
| 229 | e545e620 | Thomas Schöpping | |
| 230 | 1e5f7648 | Thomas Schöpping | /**
|
| 231 | * @brief ACCEL_INT input signal GPIO.
|
||
| 232 | */
|
||
| 233 | static apalGpio_t _gpioAccelInt = {
|
||
| 234 | 3106e8cc | Thomas Schöpping | /* line */ LINE_ACCEL_INT_N,
|
| 235 | e545e620 | Thomas Schöpping | }; |
| 236 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioAccelInt = {
|
| 237 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioAccelInt,
|
| 238 | /* meta */ {
|
||
| 239 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 240 | /* active state */ (LIS331DLH_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
| 241 | /* interrupt edge */ LIS331DLH_LLD_INT_EDGE,
|
||
| 242 | }, |
||
| 243 | }; |
||
| 244 | e545e620 | Thomas Schöpping | |
| 245 | 1e5f7648 | Thomas Schöpping | /**
|
| 246 | * @brief SYS_SNYC bidirectional signal GPIO.
|
||
| 247 | */
|
||
| 248 | static apalGpio_t _gpioSysSync = {
|
||
| 249 | 3106e8cc | Thomas Schöpping | /* line */ LINE_SYS_INT_N,
|
| 250 | e545e620 | Thomas Schöpping | }; |
| 251 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioSysSync = {
|
| 252 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioSysSync,
|
| 253 | /* meta */ {
|
||
| 254 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
| 255 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
| 256 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 257 | }, |
||
| 258 | }; |
||
| 259 | e545e620 | Thomas Schöpping | |
| 260 | 1e5f7648 | Thomas Schöpping | /**
|
| 261 | * @brief PATH_DCSTAT input signal GPIO.
|
||
| 262 | */
|
||
| 263 | static apalGpio_t _gpioPathDcStat = {
|
||
| 264 | 3106e8cc | Thomas Schöpping | /* line */ LINE_PATH_DCSTAT,
|
| 265 | e545e620 | Thomas Schöpping | }; |
| 266 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioPathDcStat = {
|
| 267 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioPathDcStat,
|
| 268 | /* meta */ {
|
||
| 269 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 270 | /* active state */ LTC4412_LLD_STAT_ACTIVE_STATE,
|
||
| 271 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 272 | }, |
||
| 273 | }; |
||
| 274 | e545e620 | Thomas Schöpping | |
| 275 | 1e5f7648 | Thomas Schöpping | /**
|
| 276 | * @brief PATH_DCEN output signal GPIO.
|
||
| 277 | */
|
||
| 278 | static apalGpio_t _gpioPathDcEn = {
|
||
| 279 | 3106e8cc | Thomas Schöpping | /* line */ LINE_PATH_DCEN,
|
| 280 | e545e620 | Thomas Schöpping | }; |
| 281 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioPathDcEn = {
|
| 282 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioPathDcEn,
|
| 283 | /* meta */ {
|
||
| 284 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
| 285 | /* active state */ LTC4412_LLD_CTRL_ACTIVE_STATE,
|
||
| 286 | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
||
| 287 | }, |
||
| 288 | }; |
||
| 289 | e545e620 | Thomas Schöpping | |
| 290 | 1e5f7648 | Thomas Schöpping | /**
|
| 291 | * @brief SYS_PD bidirectional signal GPIO.
|
||
| 292 | */
|
||
| 293 | static apalGpio_t _gpioSysPd = {
|
||
| 294 | 3106e8cc | Thomas Schöpping | /* line */ LINE_SYS_PD_N,
|
| 295 | e545e620 | Thomas Schöpping | }; |
| 296 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioSysPd = {
|
| 297 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioSysPd,
|
| 298 | /* meta */ {
|
||
| 299 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
| 300 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
| 301 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 302 | }, |
||
| 303 | }; |
||
| 304 | e545e620 | Thomas Schöpping | |
| 305 | 1e5f7648 | Thomas Schöpping | /**
|
| 306 | * @brief SYS_REG_EN input signal GPIO.
|
||
| 307 | */
|
||
| 308 | static apalGpio_t _gpioSysRegEn = {
|
||
| 309 | 3106e8cc | Thomas Schöpping | /* line */ LINE_SYS_REG_EN,
|
| 310 | e545e620 | Thomas Schöpping | }; |
| 311 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioSysRegEn = {
|
| 312 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioSysRegEn,
|
| 313 | /* meta */ {
|
||
| 314 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
| 315 | /* active state */ APAL_GPIO_ACTIVE_HIGH,
|
||
| 316 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 317 | }, |
||
| 318 | }; |
||
| 319 | e545e620 | Thomas Schöpping | |
| 320 | 1e5f7648 | Thomas Schöpping | /**
|
| 321 | * @brief SYS_WARMRST bidirectional signal GPIO.
|
||
| 322 | */
|
||
| 323 | static apalGpio_t _gpioSysWarmrst = {
|
||
| 324 | 3106e8cc | Thomas Schöpping | /* line */ LINE_SYS_WARMRST_N,
|
| 325 | e545e620 | Thomas Schöpping | }; |
| 326 | acc97cbf | Thomas Schöpping | ROMCONST apalControlGpio_t moduleGpioSysWarmrst = {
|
| 327 | 1e5f7648 | Thomas Schöpping | /* GPIO */ &_gpioSysWarmrst,
|
| 328 | /* meta */ {
|
||
| 329 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
| 330 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
| 331 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
| 332 | }, |
||
| 333 | }; |
||
| 334 | e545e620 | Thomas Schöpping | |
| 335 | /** @} */
|
||
| 336 | |||
| 337 | /*===========================================================================*/
|
||
| 338 | /**
|
||
| 339 | * @name AMiRo-OS core configurations
|
||
| 340 | * @{
|
||
| 341 | */
|
||
| 342 | /*===========================================================================*/
|
||
| 343 | |||
| 344 | cda14729 | Thomas Schöpping | #if (AMIROOS_CFG_SHELL_ENABLE == true) || defined(__DOXYGEN__) |
| 345 | acc97cbf | Thomas Schöpping | ROMCONST char* moduleShellPrompt = "DiWheelDrive"; |
| 346 | cda14729 | Thomas Schöpping | #endif /* (AMIROOS_CFG_SHELL_ENABLE == true) */ |
| 347 | 6b53f6bf | Thomas Schöpping | |
| 348 | /** @} */
|
||
| 349 | |||
| 350 | /*===========================================================================*/
|
||
| 351 | /**
|
||
| 352 | * @name Startup Shutdown Synchronization Protocol (SSSP)
|
||
| 353 | * @{
|
||
| 354 | */
|
||
| 355 | /*===========================================================================*/
|
||
| 356 | |||
| 357 | c53ef0b1 | Thomas Schöpping | #if ((AMIROOS_CFG_SSSP_ENABLE == true) && (AMIROOS_CFG_SSSP_MSI == true)) || defined(__DOXYGEN__) |
| 358 | |||
| 359 | /* some local definitions */
|
||
| 360 | // maximum number of bytes per CAN frame
|
||
| 361 | #define CAN_BYTES_PER_FRAME 8 |
||
| 362 | // identifier (as dominant as possible)
|
||
| 363 | #define MSI_BCBMSG_CANID 0 |
||
| 364 | |||
| 365 | aos_ssspbcbstatus_t moduleSsspBcbTransmit(const uint8_t* buffer, size_t length)
|
||
| 366 | {
|
||
| 367 | aosDbgCheck(buffer != NULL);
|
||
| 368 | aosDbgCheck(length > 0 && length <= CAN_BYTES_PER_FRAME);
|
||
| 369 | |||
| 370 | // local variables
|
||
| 371 | CANTxFrame frame; |
||
| 372 | |||
| 373 | // setup the common parts of the message frame
|
||
| 374 | frame.DLC = (uint8_t)length; |
||
| 375 | frame.RTR = CAN_RTR_DATA; |
||
| 376 | frame.IDE = CAN_IDE_STD; |
||
| 377 | frame.SID = MSI_BCBMSG_CANID; |
||
| 378 | memcpy(frame.data8, buffer, length); |
||
| 379 | |||
| 380 | // sent the frame and return
|
||
| 381 | return (canTransmitTimeout(&MODULE_HAL_CAN, CAN_ANY_MAILBOX, &frame, TIME_IMMEDIATE) == MSG_OK) ? AOS_SSSP_BCB_SUCCESS : AOS_SSSP_BCB_ERROR;
|
||
| 382 | } |
||
| 383 | |||
| 384 | aos_ssspbcbstatus_t moduleSsspBcbReceive(uint8_t* buffer, size_t length) |
||
| 385 | {
|
||
| 386 | aosDbgCheck(buffer != NULL);
|
||
| 387 | aosDbgCheck(length > 0 && length <= CAN_BYTES_PER_FRAME);
|
||
| 388 | |||
| 389 | // local variables
|
||
| 390 | CANRxFrame frame; |
||
| 391 | |||
| 392 | // receive a frame and check for errors
|
||
| 393 | if (canReceiveTimeout(&MODULE_HAL_CAN, CAN_ANY_MAILBOX, &frame, TIME_IMMEDIATE) == MSG_OK) {
|
||
| 394 | // a correct frame was received
|
||
| 395 | if (frame.DLC == length &&
|
||
| 396 | frame.RTR == CAN_RTR_DATA && |
||
| 397 | frame.IDE == CAN_IDE_STD && |
||
| 398 | frame.SID == MSI_BCBMSG_CANID) {
|
||
| 399 | // success: fetch the data and return
|
||
| 400 | memcpy(buffer, frame.data8, length); |
||
| 401 | return AOS_SSSP_BCB_SUCCESS;
|
||
| 402 | } |
||
| 403 | // an unexpected frame was received
|
||
| 404 | else {
|
||
| 405 | return AOS_SSSP_BCB_INVALIDMSG;
|
||
| 406 | } |
||
| 407 | } else {
|
||
| 408 | // failure: return with error
|
||
| 409 | return AOS_SSSP_BCB_ERROR;
|
||
| 410 | } |
||
| 411 | } |
||
| 412 | |||
| 413 | #undef MSI_BCBMSG_CANID
|
||
| 414 | #undef CAN_BYTES_PER_FRAME
|
||
| 415 | |||
| 416 | #endif /* (AMIROOS_CFG_SSSP_ENABLE == true) && (AMIROOS_CFG_SSSP_MSI == true) */ |
||
| 417 | |||
| 418 | e545e620 | Thomas Schöpping | /** @} */
|
| 419 | |||
| 420 | /*===========================================================================*/
|
||
| 421 | /**
|
||
| 422 | * @name Low-level drivers
|
||
| 423 | * @{
|
||
| 424 | */
|
||
| 425 | /*===========================================================================*/
|
||
| 426 | |||
| 427 | A3906Driver moduleLldMotors = {
|
||
| 428 | 1e5f7648 | Thomas Schöpping | /* power enable GPIO */ &moduleGpioPowerEn,
|
| 429 | e545e620 | Thomas Schöpping | }; |
| 430 | |||
| 431 | ddf34c3d | Thomas Schöpping | AT24C01BDriver moduleLldEeprom = {
|
| 432 | e545e620 | Thomas Schöpping | /* I2C driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
| 433 | ddf34c3d | Thomas Schöpping | /* I²C address */ AT24C01B_LLD_I2C_ADDR_FIXED,
|
| 434 | e545e620 | Thomas Schöpping | }; |
| 435 | |||
| 436 | HMC5883LDriver moduleLldCompass = {
|
||
| 437 | /* I²C Driver */ &MODULE_HAL_I2C_COMPASS,
|
||
| 438 | }; |
||
| 439 | |||
| 440 | INA219Driver moduleLldPowerMonitorVdd = {
|
||
| 441 | /* I2C Driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
| 442 | /* I²C address */ INA219_LLD_I2C_ADDR_FIXED,
|
||
| 443 | /* current LSB (uA) */ 0x00u, |
||
| 444 | /* configuration */ NULL, |
||
| 445 | }; |
||
| 446 | |||
| 447 | L3G4200DDriver moduleLldGyroscope = {
|
||
| 448 | /* SPI Driver */ &MODULE_HAL_SPI_MOTION,
|
||
| 449 | }; |
||
| 450 | |||
| 451 | LEDDriver moduleLldStatusLed = {
|
||
| 452 | 1e5f7648 | Thomas Schöpping | /* LED enable Gpio */ &moduleGpioLed,
|
| 453 | e545e620 | Thomas Schöpping | }; |
| 454 | |||
| 455 | LIS331DLHDriver moduleLldAccelerometer = {
|
||
| 456 | /* SPI Driver */ &MODULE_HAL_SPI_MOTION,
|
||
| 457 | }; |
||
| 458 | |||
| 459 | LTC4412Driver moduleLldPowerPathController = {
|
||
| 460 | 1e5f7648 | Thomas Schöpping | /* Control GPIO */ &moduleGpioPathDcEn,
|
| 461 | /* Status GPIO */ &moduleGpioPathDcStat,
|
||
| 462 | e545e620 | Thomas Schöpping | }; |
| 463 | |||
| 464 | PCA9544ADriver moduleLldI2cMultiplexer = {
|
||
| 465 | /* I²C driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
| 466 | /* I²C address */ PCA9544A_LLD_I2C_ADDR_FIXED | PCA9544A_LLD_I2C_ADDR_A0 | PCA9544A_LLD_I2C_ADDR_A1 | PCA9544A_LLD_I2C_ADDR_A2,
|
||
| 467 | }; |
||
| 468 | |||
| 469 | ddf34c3d | Thomas Schöpping | TPS6211xDriver moduleLldStepDownConverterVdrive = {
|
| 470 | 1e5f7648 | Thomas Schöpping | /* Power enable Gpio */ &moduleGpioPowerEn,
|
| 471 | e545e620 | Thomas Schöpping | }; |
| 472 | |||
| 473 | VCNL4020Driver moduleLldProximity = {
|
||
| 474 | /* I²C Driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
| 475 | }; |
||
| 476 | |||
| 477 | /** @} */
|
||
| 478 | |||
| 479 | /*===========================================================================*/
|
||
| 480 | /**
|
||
| 481 | 4c72a54c | Thomas Schöpping | * @name Tests
|
| 482 | e545e620 | Thomas Schöpping | * @{
|
| 483 | */
|
||
| 484 | /*===========================================================================*/
|
||
| 485 | #if (AMIROOS_CFG_TESTS_ENABLE == true) || defined(__DOXYGEN__) |
||
| 486 | |||
| 487 | 8be006e0 | Thomas Schöpping | /*
|
| 488 | * A3906 (motor driver)
|
||
| 489 | */
|
||
| 490 | 4c72a54c | Thomas Schöpping | #include <module_test_A3906.h> |
| 491 | static int _testA3906ShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 492 | e545e620 | Thomas Schöpping | {
|
| 493 | 4c72a54c | Thomas Schöpping | return moduleTestA3906ShellCb(stream, argc, argv, NULL); |
| 494 | e545e620 | Thomas Schöpping | } |
| 495 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestA3906ShellCmd, "test:MotorDriver", _testA3906ShellCmdCb);
|
| 496 | e545e620 | Thomas Schöpping | |
| 497 | 8be006e0 | Thomas Schöpping | /*
|
| 498 | 4c72a54c | Thomas Schöpping | * AT24C01BN-SH-B (EEPROM)
|
| 499 | 8be006e0 | Thomas Schöpping | */
|
| 500 | 4c72a54c | Thomas Schöpping | #include <module_test_AT24C01B.h> |
| 501 | static int _testAt24co1bShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 502 | e545e620 | Thomas Schöpping | {
|
| 503 | 4c72a54c | Thomas Schöpping | return moduleTestAt24c01bShellCb(stream, argc, argv, NULL); |
| 504 | e545e620 | Thomas Schöpping | } |
| 505 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestAt24c01bShellCmd, "test:EEPROM", _testAt24co1bShellCmdCb);
|
| 506 | e545e620 | Thomas Schöpping | |
| 507 | 8be006e0 | Thomas Schöpping | /*
|
| 508 | * HMC5883L (compass)
|
||
| 509 | */
|
||
| 510 | 4c72a54c | Thomas Schöpping | #include <module_test_HMC5883L.h> |
| 511 | static int _testHmc5883lShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 512 | e545e620 | Thomas Schöpping | {
|
| 513 | 4c72a54c | Thomas Schöpping | return moduleTestHmc5883lShellCb(stream, argc, argv, NULL); |
| 514 | e545e620 | Thomas Schöpping | } |
| 515 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestHmc5883lShellCmd, "test:Compass", _testHmc5883lShellCmdCb);
|
| 516 | e545e620 | Thomas Schöpping | |
| 517 | 8be006e0 | Thomas Schöpping | /*
|
| 518 | * INA219 (power monitor)
|
||
| 519 | */
|
||
| 520 | 4c72a54c | Thomas Schöpping | #include <module_test_INA219.h> |
| 521 | static int _testIna219ShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 522 | e545e620 | Thomas Schöpping | {
|
| 523 | 4c72a54c | Thomas Schöpping | return moduleTestIna219ShellCb(stream, argc, argv, NULL); |
| 524 | e545e620 | Thomas Schöpping | } |
| 525 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestIna219ShellCmd, "test:PowerMonitor", _testIna219ShellCmdCb);
|
| 526 | e545e620 | Thomas Schöpping | |
| 527 | 8be006e0 | Thomas Schöpping | /*
|
| 528 | * L3G4200D (gyroscope)
|
||
| 529 | */
|
||
| 530 | 4c72a54c | Thomas Schöpping | #include <module_test_L3G4200D.h> |
| 531 | static int _testL3g4200dShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 532 | e545e620 | Thomas Schöpping | {
|
| 533 | 4c72a54c | Thomas Schöpping | return moduleTestL3g4200dShellCb(stream, argc, argv, NULL); |
| 534 | e545e620 | Thomas Schöpping | } |
| 535 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestL3g4200dShellCmd, "test:Gyroscope", _testL3g4200dShellCmdCb);
|
| 536 | e545e620 | Thomas Schöpping | |
| 537 | 8be006e0 | Thomas Schöpping | /*
|
| 538 | * Status LED
|
||
| 539 | */
|
||
| 540 | 4c72a54c | Thomas Schöpping | #include <module_test_LED.h> |
| 541 | static int _testLedShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 542 | e545e620 | Thomas Schöpping | {
|
| 543 | 4c72a54c | Thomas Schöpping | return moduleTestLedShellCb(stream, argc, argv, NULL); |
| 544 | e545e620 | Thomas Schöpping | } |
| 545 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestLedShellCmd, "test:StatusLED", _testLedShellCmdCb);
|
| 546 | e545e620 | Thomas Schöpping | |
| 547 | 8be006e0 | Thomas Schöpping | /*
|
| 548 | * LIS331DLH (accelerometer)
|
||
| 549 | */
|
||
| 550 | 4c72a54c | Thomas Schöpping | #include <module_test_LIS331DLH.h> |
| 551 | static int _testLis331dlhShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 552 | e545e620 | Thomas Schöpping | {
|
| 553 | 4c72a54c | Thomas Schöpping | return moduleTestLis331dlhShellCb(stream, argc, argv, NULL); |
| 554 | e545e620 | Thomas Schöpping | } |
| 555 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestLis331dlhShellCmd, "test:Accelerometer", _testLis331dlhShellCmdCb);
|
| 556 | e545e620 | Thomas Schöpping | |
| 557 | 8be006e0 | Thomas Schöpping | /*
|
| 558 | * LTC4412 (power path controller)
|
||
| 559 | */
|
||
| 560 | 4c72a54c | Thomas Schöpping | #include <module_test_LTC4412.h> |
| 561 | static int _testLtc4412ShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 562 | e545e620 | Thomas Schöpping | {
|
| 563 | 4c72a54c | Thomas Schöpping | return moduleTestLtc4412ShellCb(stream, argc, argv, NULL); |
| 564 | e545e620 | Thomas Schöpping | } |
| 565 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestLtc4412ShellCmd, "test:PowerPathController", _testLtc4412ShellCmdCb);
|
| 566 | e545e620 | Thomas Schöpping | |
| 567 | 8be006e0 | Thomas Schöpping | /*
|
| 568 | * PCA9544A (I2C multiplexer)
|
||
| 569 | */
|
||
| 570 | 4c72a54c | Thomas Schöpping | #include <module_test_PCA9544A.h> |
| 571 | static int _testPca9544aShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 572 | e545e620 | Thomas Schöpping | {
|
| 573 | 4c72a54c | Thomas Schöpping | return moduleTestPca9544aShellCb(stream, argc, argv, NULL); |
| 574 | e545e620 | Thomas Schöpping | } |
| 575 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestPca9544aShellCmd, "test:I2CMultiplexer", _testPca9544aShellCmdCb);
|
| 576 | e545e620 | Thomas Schöpping | |
| 577 | 8be006e0 | Thomas Schöpping | /*
|
| 578 | * TPS62113 (step-down converter)
|
||
| 579 | */
|
||
| 580 | 4c72a54c | Thomas Schöpping | #include <module_test_TPS6211x.h> |
| 581 | static int _testTps6211xShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 582 | e545e620 | Thomas Schöpping | {
|
| 583 | 4c72a54c | Thomas Schöpping | return moduleTestTps6211xShellCb(stream, argc, argv, NULL); |
| 584 | e545e620 | Thomas Schöpping | } |
| 585 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestTps62113ShellCmd, "test:StepDownConverter", _testTps6211xShellCmdCb);
|
| 586 | e545e620 | Thomas Schöpping | |
| 587 | 8be006e0 | Thomas Schöpping | /*
|
| 588 | * VCNL4020 (proximity sensor)
|
||
| 589 | */
|
||
| 590 | 4c72a54c | Thomas Schöpping | #include <module_test_VCNL4020.h> |
| 591 | static int _testVcnl4020ShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 592 | e545e620 | Thomas Schöpping | {
|
| 593 | 4c72a54c | Thomas Schöpping | return moduleTestVcnl4020ShellCb(stream, argc, argv, NULL); |
| 594 | e545e620 | Thomas Schöpping | } |
| 595 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestVcnl4020ShellCmd, "test:ProximitySensor", _testVcnl4020ShellCmdCb);
|
| 596 | |||
| 597 | /*
|
||
| 598 | * entire module
|
||
| 599 | */
|
||
| 600 | static int _testAllShellCmdCb(BaseSequentialStream* stream, int argc, char* argv[]) |
||
| 601 | e545e620 | Thomas Schöpping | {
|
| 602 | 4c72a54c | Thomas Schöpping | (void)argc;
|
| 603 | (void)argv;
|
||
| 604 | |||
| 605 | int status = AOS_OK;
|
||
| 606 | char* targv[AMIROOS_CFG_SHELL_MAXARGS] = {NULL}; |
||
| 607 | aos_testresult_t result_test = {0, 0};
|
||
| 608 | aos_testresult_t result_total = {0, 0};
|
||
| 609 | |||
| 610 | /* A3906 (motor driver) */
|
||
| 611 | status |= moduleTestA3906ShellCb(stream, 0, targv, &result_test);
|
||
| 612 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 613 | |||
| 614 | /* AT24C01B (EEPROM) */
|
||
| 615 | status |= moduleTestAt24c01bShellCb(stream, 0, targv, &result_test);
|
||
| 616 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 617 | |||
| 618 | /* HMC5883L (compass) */
|
||
| 619 | status |= moduleTestHmc5883lShellCb(stream, 0, targv, &result_test);
|
||
| 620 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 621 | |||
| 622 | /* INA219 (power monitor) */
|
||
| 623 | status |= moduleTestIna219ShellCb(stream, 0, targv, &result_test);
|
||
| 624 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 625 | |||
| 626 | /* L3G4200D (gyroscope) */
|
||
| 627 | status |= moduleTestL3g4200dShellCb(stream, 0, targv, &result_test);
|
||
| 628 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 629 | |||
| 630 | /* Status LED */
|
||
| 631 | status |= moduleTestLedShellCb(stream, 0, targv, &result_test);
|
||
| 632 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 633 | |||
| 634 | /* LIS331DLH (accelerometer) */
|
||
| 635 | status |= moduleTestLis331dlhShellCb(stream, 0, targv, &result_test);
|
||
| 636 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 637 | |||
| 638 | /* LTC4412 (power path controller) */
|
||
| 639 | status |= moduleTestLtc4412ShellCb(stream, 0, targv, &result_test);
|
||
| 640 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 641 | |||
| 642 | /* PCA9544A (I2C multiplexer) */
|
||
| 643 | status |= moduleTestPca9544aShellCb(stream, 0, targv, &result_test);
|
||
| 644 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 645 | |||
| 646 | /* TPS62113 (step-down converter) */
|
||
| 647 | status |= moduleTestTps6211xShellCb(stream, 0, targv, &result_test);
|
||
| 648 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 649 | |||
| 650 | /* VCNL4020 (proximity sensor) */
|
||
| 651 | // wheel left
|
||
| 652 | targv[1] = "-wl"; |
||
| 653 | status |= moduleTestVcnl4020ShellCb(stream, 2, targv, &result_test);
|
||
| 654 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 655 | // front left
|
||
| 656 | targv[1] = "-fl"; |
||
| 657 | status |= moduleTestVcnl4020ShellCb(stream, 2, targv, &result_test);
|
||
| 658 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 659 | // front right
|
||
| 660 | targv[1] = "-fr"; |
||
| 661 | status |= moduleTestVcnl4020ShellCb(stream, 2, targv, &result_test);
|
||
| 662 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 663 | // wheel right
|
||
| 664 | targv[1] = "-wr"; |
||
| 665 | status |= moduleTestVcnl4020ShellCb(stream, 2, targv, &result_test);
|
||
| 666 | result_total = aosTestResultAdd(result_total, result_test); |
||
| 667 | targv[1] = ""; |
||
| 668 | |||
| 669 | // print total result
|
||
| 670 | chprintf(stream, "\n");
|
||
| 671 | aosTestResultPrintSummary(stream, &result_total, "entire module");
|
||
| 672 | |||
| 673 | return status;
|
||
| 674 | e545e620 | Thomas Schöpping | } |
| 675 | 4c72a54c | Thomas Schöpping | AOS_SHELL_COMMAND(moduleTestAllShellCmd, "test:all", _testAllShellCmdCb);
|
| 676 | e545e620 | Thomas Schöpping | |
| 677 | 7de0cc90 | Thomas Schöpping | #endif /* (AMIROOS_CFG_TESTS_ENABLE == true) */ |
| 678 | e545e620 | Thomas Schöpping | |
| 679 | /** @} */
|
||
| 680 | 53710ca3 | Marc Rothmann | /** @} */ |