Statistics
| Branch: | Tag: | Revision:

amiro-os / modules / DiWheelDrive_1-1 / module.c @ f606e2bf

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 84f0ce9e Thomas Schöpping
Copyright (C) 2016..2019  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
/** @} */