amiro-os / modules / DiWheelDrive_1-1 / module.c @ 27e4a312
History | View | Annotate | Download (23.67 KB)
1 | e545e620 | Thomas Schöpping | /*
|
---|---|---|---|
2 | AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
|
||
3 | Copyright (C) 2016..2018 Thomas Schöpping et al.
|
||
4 | |||
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 | * @file
|
||
21 | * @brief Structures and constant for the DiWheelDrive module.
|
||
22 | *
|
||
23 | * @addtogroup diwheeldrive_module
|
||
24 | * @{
|
||
25 | */
|
||
26 | |||
27 | e545e620 | Thomas Schöpping | #include "module.h" |
28 | |||
29 | 1e5f7648 | Thomas Schöpping | #include <amiroos.h> |
30 | |||
31 | e545e620 | Thomas Schöpping | /*===========================================================================*/
|
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 | #if STM32_PWM_USE_ADVANCED
|
||
88 | /* TIM BDTR register */ 0, |
||
89 | #endif
|
||
90 | /* 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 | /* chip select line port */ GPIOC,
|
||
117 | /* chip select line pad number */ GPIOC_ACCEL_SS_N,
|
||
118 | /* 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 | /* chip select line port */ GPIOC,
|
||
126 | /* chip select line pad number */ GPIOC_GYRO_SS_N,
|
||
127 | /* 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 | e545e620 | Thomas Schöpping | /* port */ GPIOA,
|
145 | /* pad */ GPIOA_LED,
|
||
146 | }; |
||
147 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioLed = { |
148 | /* GPIO */ &_gpioLed,
|
||
149 | /* meta */ {
|
||
150 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
151 | /* active state */ LED_LLD_GPIO_ACTIVE_STATE,
|
||
152 | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
||
153 | }, |
||
154 | }; |
||
155 | e545e620 | Thomas Schöpping | |
156 | 1e5f7648 | Thomas Schöpping | /**
|
157 | * @brief POWER_EN output signal GPIO.
|
||
158 | */
|
||
159 | static apalGpio_t _gpioPowerEn = {
|
||
160 | /* port */ GPIOB,
|
||
161 | e545e620 | Thomas Schöpping | /* pad */ GPIOB_POWER_EN,
|
162 | }; |
||
163 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioPowerEn = { |
164 | /* GPIO */ &_gpioPowerEn,
|
||
165 | /* meta */ {
|
||
166 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
167 | /* active state */ APAL_GPIO_ACTIVE_HIGH,
|
||
168 | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
||
169 | }, |
||
170 | }; |
||
171 | e545e620 | Thomas Schöpping | |
172 | 1e5f7648 | Thomas Schöpping | /**
|
173 | * @brief COMPASS_DRDY output signal GPIO.
|
||
174 | */
|
||
175 | static apalGpio_t _gpioCompassDrdy = {
|
||
176 | e545e620 | Thomas Schöpping | /* port */ GPIOB,
|
177 | /* pad */ GPIOB_COMPASS_DRDY,
|
||
178 | }; |
||
179 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioCompassDrdy = { |
180 | /* GPIO */ &_gpioCompassDrdy,
|
||
181 | /* meta */ {
|
||
182 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
183 | /* active state */ (L3G4200D_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
184 | /* interrupt edge */ L3G4200D_LLD_INT_EDGE,
|
||
185 | }, |
||
186 | }; |
||
187 | e545e620 | Thomas Schöpping | |
188 | 1e5f7648 | Thomas Schöpping | /**
|
189 | * @brief IR_INT input signal GPIO.
|
||
190 | */
|
||
191 | static apalGpio_t _gpioIrInt = {
|
||
192 | e545e620 | Thomas Schöpping | /* port */ GPIOB,
|
193 | /* pad */ GPIOB_IR_INT,
|
||
194 | }; |
||
195 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioIrInt = { |
196 | /* GPIO */ &_gpioIrInt,
|
||
197 | /* meta */ {
|
||
198 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
199 | /* active state */ (VCNL4020_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
200 | /* interrupt edge */ VCNL4020_LLD_INT_EDGE,
|
||
201 | }, |
||
202 | }; |
||
203 | e545e620 | Thomas Schöpping | |
204 | 1e5f7648 | Thomas Schöpping | /**
|
205 | * @brief GYRO_DRDY input signal GPIO.
|
||
206 | */
|
||
207 | static apalGpio_t _gpioGyroDrdy = {
|
||
208 | e545e620 | Thomas Schöpping | /* port */ GPIOB,
|
209 | /* pad */ GPIOB_GYRO_DRDY,
|
||
210 | }; |
||
211 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioGyroDrdy = { |
212 | /* GPIO */ &_gpioGyroDrdy,
|
||
213 | /* meta */ {
|
||
214 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
215 | /* active state */ (L3G4200D_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
216 | /* interrupt edge */ L3G4200D_LLD_INT_EDGE,
|
||
217 | }, |
||
218 | }; |
||
219 | e545e620 | Thomas Schöpping | |
220 | 1e5f7648 | Thomas Schöpping | /**
|
221 | * @brief SYS_UART_UP bidirectional signal GPIO.
|
||
222 | */
|
||
223 | static apalGpio_t _gpioSysUartUp = {
|
||
224 | e545e620 | Thomas Schöpping | /* port */ GPIOB,
|
225 | /* pad */ GPIOB_SYS_UART_UP,
|
||
226 | }; |
||
227 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioSysUartUp = { |
228 | /* GPIO */ &_gpioSysUartUp,
|
||
229 | /* meta */ {
|
||
230 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
231 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
232 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
233 | }, |
||
234 | }; |
||
235 | e545e620 | Thomas Schöpping | |
236 | 1e5f7648 | Thomas Schöpping | /**
|
237 | * @brief ACCEL_INT input signal GPIO.
|
||
238 | */
|
||
239 | static apalGpio_t _gpioAccelInt = {
|
||
240 | e545e620 | Thomas Schöpping | /* port */ GPIOB,
|
241 | /* pad */ GPIOB_ACCEL_INT_N,
|
||
242 | }; |
||
243 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioAccelInt = { |
244 | /* GPIO */ &_gpioAccelInt,
|
||
245 | /* meta */ {
|
||
246 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
247 | /* active state */ (LIS331DLH_LLD_INT_EDGE == APAL_GPIO_EDGE_RISING) ? APAL_GPIO_ACTIVE_HIGH : APAL_GPIO_ACTIVE_LOW,
|
||
248 | /* interrupt edge */ LIS331DLH_LLD_INT_EDGE,
|
||
249 | }, |
||
250 | }; |
||
251 | e545e620 | Thomas Schöpping | |
252 | 1e5f7648 | Thomas Schöpping | /**
|
253 | * @brief SYS_SNYC bidirectional signal GPIO.
|
||
254 | */
|
||
255 | static apalGpio_t _gpioSysSync = {
|
||
256 | e545e620 | Thomas Schöpping | /* port */ GPIOC,
|
257 | /* pad */ GPIOC_SYS_INT_N,
|
||
258 | }; |
||
259 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioSysSync = { |
260 | /* GPIO */ &_gpioSysSync,
|
||
261 | /* meta */ {
|
||
262 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
263 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
264 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
265 | }, |
||
266 | }; |
||
267 | e545e620 | Thomas Schöpping | |
268 | 1e5f7648 | Thomas Schöpping | /**
|
269 | * @brief PATH_DCSTAT input signal GPIO.
|
||
270 | */
|
||
271 | static apalGpio_t _gpioPathDcStat = {
|
||
272 | e545e620 | Thomas Schöpping | /* port */ GPIOC,
|
273 | /* pad */ GPIOC_PATH_DCSTAT,
|
||
274 | }; |
||
275 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioPathDcStat = { |
276 | /* GPIO */ &_gpioPathDcStat,
|
||
277 | /* meta */ {
|
||
278 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
279 | /* active state */ LTC4412_LLD_STAT_ACTIVE_STATE,
|
||
280 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
281 | }, |
||
282 | }; |
||
283 | e545e620 | Thomas Schöpping | |
284 | 1e5f7648 | Thomas Schöpping | /**
|
285 | * @brief PATH_DCEN output signal GPIO.
|
||
286 | */
|
||
287 | static apalGpio_t _gpioPathDcEn = {
|
||
288 | e545e620 | Thomas Schöpping | /* port */ GPIOC,
|
289 | /* pad */ GPIOC_PATH_DCEN,
|
||
290 | }; |
||
291 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioPathDcEn = { |
292 | /* GPIO */ &_gpioPathDcEn,
|
||
293 | /* meta */ {
|
||
294 | /* direction */ APAL_GPIO_DIRECTION_OUTPUT,
|
||
295 | /* active state */ LTC4412_LLD_CTRL_ACTIVE_STATE,
|
||
296 | /* interrupt edge */ APAL_GPIO_EDGE_NONE,
|
||
297 | }, |
||
298 | }; |
||
299 | e545e620 | Thomas Schöpping | |
300 | 1e5f7648 | Thomas Schöpping | /**
|
301 | * @brief SYS_PD bidirectional signal GPIO.
|
||
302 | */
|
||
303 | static apalGpio_t _gpioSysPd = {
|
||
304 | e545e620 | Thomas Schöpping | /* port */ GPIOC,
|
305 | /* pad */ GPIOC_SYS_PD_N,
|
||
306 | }; |
||
307 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioSysPd = { |
308 | /* GPIO */ &_gpioSysPd,
|
||
309 | /* meta */ {
|
||
310 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
311 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
312 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
313 | }, |
||
314 | }; |
||
315 | e545e620 | Thomas Schöpping | |
316 | 1e5f7648 | Thomas Schöpping | /**
|
317 | * @brief SYS_REG_EN input signal GPIO.
|
||
318 | */
|
||
319 | static apalGpio_t _gpioSysRegEn = {
|
||
320 | e545e620 | Thomas Schöpping | /* port */ GPIOC,
|
321 | /* pad */ GPIOC_SYS_REG_EN,
|
||
322 | }; |
||
323 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioSysRegEn = { |
324 | /* GPIO */ &_gpioSysRegEn,
|
||
325 | /* meta */ {
|
||
326 | /* direction */ APAL_GPIO_DIRECTION_INPUT,
|
||
327 | /* active state */ APAL_GPIO_ACTIVE_HIGH,
|
||
328 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
329 | }, |
||
330 | }; |
||
331 | e545e620 | Thomas Schöpping | |
332 | 1e5f7648 | Thomas Schöpping | /**
|
333 | * @brief SYS_WARMRST bidirectional signal GPIO.
|
||
334 | */
|
||
335 | static apalGpio_t _gpioSysWarmrst = {
|
||
336 | e545e620 | Thomas Schöpping | /* port */ GPIOD,
|
337 | /* pad */ GPIOD_SYS_WARMRST_N,
|
||
338 | }; |
||
339 | 1e5f7648 | Thomas Schöpping | apalControlGpio_t moduleGpioSysWarmrst = { |
340 | /* GPIO */ &_gpioSysWarmrst,
|
||
341 | /* meta */ {
|
||
342 | /* direction */ APAL_GPIO_DIRECTION_BIDIRECTIONAL,
|
||
343 | /* active state */ APAL_GPIO_ACTIVE_LOW,
|
||
344 | /* interrupt edge */ APAL_GPIO_EDGE_BOTH,
|
||
345 | }, |
||
346 | }; |
||
347 | e545e620 | Thomas Schöpping | |
348 | /** @} */
|
||
349 | |||
350 | /*===========================================================================*/
|
||
351 | /**
|
||
352 | * @name AMiRo-OS core configurations
|
||
353 | * @{
|
||
354 | */
|
||
355 | /*===========================================================================*/
|
||
356 | |||
357 | 6b53f6bf | Thomas Schöpping | #if (AMIROOS_CFG_SHELL_ENABLE == true) || defined(__DOXYGEN__) |
358 | const char* moduleShellPrompt = "DiWheelDrive"; |
||
359 | #endif
|
||
360 | |||
361 | /** @} */
|
||
362 | |||
363 | /*===========================================================================*/
|
||
364 | /**
|
||
365 | * @name Startup Shutdown Synchronization Protocol (SSSP)
|
||
366 | * @{
|
||
367 | */
|
||
368 | /*===========================================================================*/
|
||
369 | |||
370 | e545e620 | Thomas Schöpping | /** @} */
|
371 | |||
372 | /*===========================================================================*/
|
||
373 | /**
|
||
374 | * @name Low-level drivers
|
||
375 | * @{
|
||
376 | */
|
||
377 | /*===========================================================================*/
|
||
378 | |||
379 | A3906Driver moduleLldMotors = { |
||
380 | 1e5f7648 | Thomas Schöpping | /* power enable GPIO */ &moduleGpioPowerEn,
|
381 | e545e620 | Thomas Schöpping | }; |
382 | |||
383 | AT24C01BNDriver moduleLldEeprom = { |
||
384 | /* I2C driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
385 | /* I²C address */ AT24C01BN_LLD_I2C_ADDR_FIXED,
|
||
386 | }; |
||
387 | |||
388 | HMC5883LDriver moduleLldCompass = { |
||
389 | /* I²C Driver */ &MODULE_HAL_I2C_COMPASS,
|
||
390 | }; |
||
391 | |||
392 | INA219Driver moduleLldPowerMonitorVdd = { |
||
393 | /* I2C Driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
394 | /* I²C address */ INA219_LLD_I2C_ADDR_FIXED,
|
||
395 | /* current LSB (uA) */ 0x00u, |
||
396 | /* configuration */ NULL, |
||
397 | }; |
||
398 | |||
399 | L3G4200DDriver moduleLldGyroscope = { |
||
400 | /* SPI Driver */ &MODULE_HAL_SPI_MOTION,
|
||
401 | }; |
||
402 | |||
403 | LEDDriver moduleLldStatusLed = { |
||
404 | 1e5f7648 | Thomas Schöpping | /* LED enable Gpio */ &moduleGpioLed,
|
405 | e545e620 | Thomas Schöpping | }; |
406 | |||
407 | LIS331DLHDriver moduleLldAccelerometer = { |
||
408 | /* SPI Driver */ &MODULE_HAL_SPI_MOTION,
|
||
409 | }; |
||
410 | |||
411 | LTC4412Driver moduleLldPowerPathController = { |
||
412 | 1e5f7648 | Thomas Schöpping | /* Control GPIO */ &moduleGpioPathDcEn,
|
413 | /* Status GPIO */ &moduleGpioPathDcStat,
|
||
414 | e545e620 | Thomas Schöpping | }; |
415 | |||
416 | PCA9544ADriver moduleLldI2cMultiplexer = { |
||
417 | /* I²C driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
418 | /* I²C address */ PCA9544A_LLD_I2C_ADDR_FIXED | PCA9544A_LLD_I2C_ADDR_A0 | PCA9544A_LLD_I2C_ADDR_A1 | PCA9544A_LLD_I2C_ADDR_A2,
|
||
419 | }; |
||
420 | |||
421 | TPS62113Driver moduleLldStepDownConverterVdrive = { |
||
422 | 1e5f7648 | Thomas Schöpping | /* Power enable Gpio */ &moduleGpioPowerEn,
|
423 | e545e620 | Thomas Schöpping | }; |
424 | |||
425 | VCNL4020Driver moduleLldProximity = { |
||
426 | /* I²C Driver */ &MODULE_HAL_I2C_PROX_EEPROM_PWRMTR,
|
||
427 | }; |
||
428 | |||
429 | /** @} */
|
||
430 | |||
431 | /*===========================================================================*/
|
||
432 | /**
|
||
433 | * @name Unit tests (UT)
|
||
434 | * @{
|
||
435 | */
|
||
436 | /*===========================================================================*/
|
||
437 | #if (AMIROOS_CFG_TESTS_ENABLE == true) || defined(__DOXYGEN__) |
||
438 | #include <string.h> |
||
439 | #include <chprintf.h> |
||
440 | |||
441 | /* A3906 (motor driver) */
|
||
442 | static int _utShellCmdCb_AlldA3906(BaseSequentialStream* stream, int argc, char* argv[]) |
||
443 | { |
||
444 | (void)argc;
|
||
445 | (void)argv;
|
||
446 | aosUtRun(stream, &moduleUtAlldA3906, NULL);
|
||
447 | return AOS_OK;
|
||
448 | } |
||
449 | static ut_a3906data_t _utA3906Data = {
|
||
450 | /* driver */ &moduleLldMotors,
|
||
451 | /* PWM information */ {
|
||
452 | /* driver */ &MODULE_HAL_PWM_DRIVE,
|
||
453 | /* channels */ {
|
||
454 | /* left wheel forward */ MODULE_HAL_PWM_DRIVE_CHANNEL_LEFT_FORWARD,
|
||
455 | /* left wheel backward */ MODULE_HAL_PWM_DRIVE_CHANNEL_LEFT_BACKWARD,
|
||
456 | /* right wheel forward */ MODULE_HAL_PWM_DRIVE_CHANNEL_RIGHT_FORWARD,
|
||
457 | /* right wheel backward */ MODULE_HAL_PWM_DRIVE_CHANNEL_RIGHT_BACKWARD,
|
||
458 | }, |
||
459 | }, |
||
460 | /* QEI information */ {
|
||
461 | /* left wheel */ &MODULE_HAL_QEI_LEFT_WHEEL,
|
||
462 | /* right wheel */ &MODULE_HAL_QEI_RIGHT_WHEEL,
|
||
463 | /* increment per revolution */ MODULE_HAL_QEI_INCREMENTS_PER_REVOLUTION,
|
||
464 | }, |
||
465 | /* Wheel diameter */ 0.05571f, |
||
466 | 1e5f7648 | Thomas Schöpping | /* timeout */ 10 * MICROSECONDS_PER_SECOND, |
467 | e545e620 | Thomas Schöpping | }; |
468 | aos_unittest_t moduleUtAlldA3906 = { |
||
469 | /* name */ "A3906", |
||
470 | /* info */ "motor driver", |
||
471 | /* test function */ utAlldA3906Func,
|
||
472 | /* shell command */ {
|
||
473 | /* name */ "unittest:MotorDriver", |
||
474 | /* callback */ _utShellCmdCb_AlldA3906,
|
||
475 | /* next */ NULL, |
||
476 | }, |
||
477 | /* data */ &_utA3906Data,
|
||
478 | }; |
||
479 | |||
480 | /* AT24C01BN (EEPROM) */
|
||
481 | static int _utShellCmdCb_AlldAt24c01bn(BaseSequentialStream* stream, int argc, char* argv[]) |
||
482 | { |
||
483 | (void)argc;
|
||
484 | (void)argv;
|
||
485 | aosUtRun(stream, &moduleUtAlldAt24c01bn, NULL);
|
||
486 | return AOS_OK;
|
||
487 | } |
||
488 | static ut_at24c01bndata_t _utAt24c01bnData = {
|
||
489 | /* driver */ &moduleLldEeprom,
|
||
490 | /* timeout */ MICROSECONDS_PER_SECOND,
|
||
491 | }; |
||
492 | aos_unittest_t moduleUtAlldAt24c01bn = { |
||
493 | /* name */ "AT24C01BN-SH-B", |
||
494 | /* info */ "1kbit EEPROM", |
||
495 | /* test function */ utAlldAt24c01bnFunc,
|
||
496 | /* shell command */ {
|
||
497 | /* name */ "unittest:EEPROM", |
||
498 | /* callback */ _utShellCmdCb_AlldAt24c01bn,
|
||
499 | /* next */ NULL, |
||
500 | }, |
||
501 | /* data */ &_utAt24c01bnData,
|
||
502 | }; |
||
503 | |||
504 | /* HMC5883L (compass) */
|
||
505 | static int _utShellCmdCb_AlldHmc5883l(BaseSequentialStream* stream, int argc, char* argv[]) |
||
506 | { |
||
507 | (void)argc;
|
||
508 | (void)argv;
|
||
509 | aosUtRun(stream, &moduleUtAlldHmc5883l, NULL);
|
||
510 | return AOS_OK;
|
||
511 | } |
||
512 | static ut_hmc5883ldata_t _utHmc5883lData = {
|
||
513 | /* HMC driver */ &moduleLldCompass,
|
||
514 | 6b53f6bf | Thomas Schöpping | /* event source */ &aos.events.io,
|
515 | 1e5f7648 | Thomas Schöpping | /* event flags */ MODULE_OS_IOEVENTFLAGS_COMPASSDRDY,
|
516 | e545e620 | Thomas Schöpping | /* timeout */ MICROSECONDS_PER_SECOND,
|
517 | }; |
||
518 | aos_unittest_t moduleUtAlldHmc5883l = { |
||
519 | /* name */ "HMC5883L", |
||
520 | /* info */ "compass", |
||
521 | /* test function */ utAlldHmc5883lFunc,
|
||
522 | /* shell command */ {
|
||
523 | /* name */ "unittest:Compass", |
||
524 | /* callback */ _utShellCmdCb_AlldHmc5883l,
|
||
525 | /* next */ NULL, |
||
526 | }, |
||
527 | /* data */ &_utHmc5883lData,
|
||
528 | }; |
||
529 | |||
530 | /* INA219 (power monitor) */
|
||
531 | static int _utShellCmdCb_AlldIna219(BaseSequentialStream* stream, int argc, char* argv[]) |
||
532 | { |
||
533 | (void)argc;
|
||
534 | (void)argv;
|
||
535 | aosUtRun(stream, &moduleUtAlldIna219, "VDD (3.3V)");
|
||
536 | return AOS_OK;
|
||
537 | } |
||
538 | static ut_ina219data_t _utIna219Data = {
|
||
539 | /* driver */ &moduleLldPowerMonitorVdd,
|
||
540 | /* expected voltage */ 3.3f, |
||
541 | /* tolerance */ 0.05f, |
||
542 | /* timeout */ MICROSECONDS_PER_SECOND,
|
||
543 | }; |
||
544 | aos_unittest_t moduleUtAlldIna219 = { |
||
545 | /* name */ "INA219", |
||
546 | /* info */ "power monitor", |
||
547 | /* test function */ utAlldIna219Func,
|
||
548 | /* shell command */ {
|
||
549 | /* name */ "unittest:PowerMonitor", |
||
550 | /* callback */ _utShellCmdCb_AlldIna219,
|
||
551 | /* next */ NULL, |
||
552 | }, |
||
553 | /* data */ &_utIna219Data,
|
||
554 | }; |
||
555 | |||
556 | /* L3G4200D (gyroscope) */
|
||
557 | static int _utShellCmdCb_AlldL3g4200d(BaseSequentialStream* stream, int argc, char* argv[]) |
||
558 | { |
||
559 | (void)argc;
|
||
560 | (void)argv;
|
||
561 | spiStart(((ut_l3g4200ddata_t*)moduleUtAlldL3g4200d.data)->l3gd->spid, ((ut_l3g4200ddata_t*)moduleUtAlldL3g4200d.data)->spiconf); |
||
562 | aosUtRun(stream, &moduleUtAlldL3g4200d, NULL);
|
||
563 | spiStop(((ut_l3g4200ddata_t*)moduleUtAlldL3g4200d.data)->l3gd->spid); |
||
564 | return AOS_OK;
|
||
565 | } |
||
566 | static ut_l3g4200ddata_t _utL3g4200dData = {
|
||
567 | /* driver */ &moduleLldGyroscope,
|
||
568 | /* SPI configuration */ &moduleHalSpiGyroscopeConfig,
|
||
569 | 6b53f6bf | Thomas Schöpping | /* event source */ &aos.events.io,
|
570 | 1e5f7648 | Thomas Schöpping | /* event flags */ MODULE_OS_IOEVENTFLAGS_GYRODRDY,
|
571 | e545e620 | Thomas Schöpping | }; |
572 | aos_unittest_t moduleUtAlldL3g4200d = { |
||
573 | /* name */ "L3G4200D", |
||
574 | /* info */ "Gyroscope", |
||
575 | /* test function */ utAlldL3g4200dFunc,
|
||
576 | /* shell command */ {
|
||
577 | /* name */ "unittest:Gyroscope", |
||
578 | /* callback */ _utShellCmdCb_AlldL3g4200d,
|
||
579 | /* next */ NULL, |
||
580 | }, |
||
581 | /* data */ &_utL3g4200dData,
|
||
582 | }; |
||
583 | |||
584 | /* Status LED */
|
||
585 | static int _utShellCmdCb_AlldLed(BaseSequentialStream* stream, int argc, char* argv[]) |
||
586 | { |
||
587 | (void)argc;
|
||
588 | (void)argv;
|
||
589 | aosUtRun(stream, &moduleUtAlldLed, NULL);
|
||
590 | return AOS_OK;
|
||
591 | } |
||
592 | aos_unittest_t moduleUtAlldLed = { |
||
593 | /* name */ "LED", |
||
594 | /* info */ NULL, |
||
595 | /* test function */ utAlldLedFunc,
|
||
596 | /* shell command */ {
|
||
597 | /* name */ "unittest:StatusLED", |
||
598 | /* callback */ _utShellCmdCb_AlldLed,
|
||
599 | /* next */ NULL, |
||
600 | }, |
||
601 | /* data */ &moduleLldStatusLed,
|
||
602 | }; |
||
603 | |||
604 | /* LIS331DLH (accelerometer) */
|
||
605 | static int _utShellCmdCb_AlldLis331dlh(BaseSequentialStream* stream, int argc, char* argv[]) |
||
606 | { |
||
607 | (void)argc;
|
||
608 | (void)argv;
|
||
609 | spiStart(((ut_lis331dlhdata_t*)moduleUtAlldLis331dlh.data)->lisd->spid, ((ut_lis331dlhdata_t*)moduleUtAlldLis331dlh.data)->spiconf); |
||
610 | aosUtRun(stream, &moduleUtAlldLis331dlh, NULL);
|
||
611 | spiStop(((ut_lis331dlhdata_t*)moduleUtAlldLis331dlh.data)->lisd->spid); |
||
612 | return AOS_OK;
|
||
613 | } |
||
614 | static ut_lis331dlhdata_t _utLis331dlhData = {
|
||
615 | /* driver */ &moduleLldAccelerometer,
|
||
616 | /* SPI configuration */ &moduleHalSpiAccelerometerConfig,
|
||
617 | 6b53f6bf | Thomas Schöpping | /* event source */ &aos.events.io,
|
618 | 1e5f7648 | Thomas Schöpping | /* event flags */ MODULE_OS_IOEVENTFLAGS_ACCELINT,
|
619 | e545e620 | Thomas Schöpping | }; |
620 | aos_unittest_t moduleUtAlldLis331dlh = { |
||
621 | /* name */ "LIS331DLH", |
||
622 | /* info */ "Accelerometer", |
||
623 | /* test function */ utAlldLis331dlhFunc,
|
||
624 | /* shell command */ {
|
||
625 | /* name */ "unittest:Accelerometer", |
||
626 | /* callback */ _utShellCmdCb_AlldLis331dlh,
|
||
627 | /* next */ NULL, |
||
628 | }, |
||
629 | /* data */ &_utLis331dlhData,
|
||
630 | }; |
||
631 | |||
632 | /* LTC4412 (power path controller) */
|
||
633 | static int _utShellCmdCb_AlldLtc4412(BaseSequentialStream* stream, int argc, char* argv[]) |
||
634 | { |
||
635 | (void)argc;
|
||
636 | (void)argv;
|
||
637 | aosUtRun(stream, &moduleUtAlldLtc4412, NULL);
|
||
638 | return AOS_OK;
|
||
639 | } |
||
640 | aos_unittest_t moduleUtAlldLtc4412 = { |
||
641 | /* name */ "LTC4412", |
||
642 | /* info */ "Power path controller", |
||
643 | /* test function */ utAlldLtc4412Func,
|
||
644 | /* shell command */ {
|
||
645 | /* name */ "unittest:PowerPathController", |
||
646 | /* callback */ _utShellCmdCb_AlldLtc4412,
|
||
647 | /* next */ NULL, |
||
648 | }, |
||
649 | /* data */ &moduleLldPowerPathController,
|
||
650 | }; |
||
651 | |||
652 | /* PCA9544A (I2C multiplexer) */
|
||
653 | static int _utShellCmdCb_AlldPca9544a(BaseSequentialStream* stream, int argc, char* argv[]) |
||
654 | { |
||
655 | (void)argc;
|
||
656 | (void)argv;
|
||
657 | aosUtRun(stream, &moduleUtAlldPca9544a, NULL);
|
||
658 | return AOS_OK;
|
||
659 | } |
||
660 | static ut_pca9544adata_t _utPca9544aData = {
|
||
661 | /* driver */ &moduleLldI2cMultiplexer,
|
||
662 | /* timeout */ MICROSECONDS_PER_SECOND,
|
||
663 | }; |
||
664 | aos_unittest_t moduleUtAlldPca9544a = { |
||
665 | /* name */ "PCA9544A", |
||
666 | /* info */ "I2C multiplexer", |
||
667 | /* test function */ utAlldPca9544aFunc,
|
||
668 | /* shell command */ {
|
||
669 | /* name */ "unittest:I2CMultiplexer", |
||
670 | /* callback */ _utShellCmdCb_AlldPca9544a,
|
||
671 | /* next */ NULL, |
||
672 | }, |
||
673 | /* data */ &_utPca9544aData,
|
||
674 | }; |
||
675 | |||
676 | /* TPS62113 (step-down converter) */
|
||
677 | static int _utShellCmdCb_AlldTps62113(BaseSequentialStream* stream, int argc, char* argv[]) |
||
678 | { |
||
679 | (void)argc;
|
||
680 | (void)argv;
|
||
681 | aosUtRun(stream, &moduleUtAlldTps62113, NULL);
|
||
682 | return AOS_OK;
|
||
683 | } |
||
684 | aos_unittest_t moduleUtAlldTps62113 = { |
||
685 | /* name */ "TPS62113", |
||
686 | /* info */ "Step down converter", |
||
687 | /* test function */ utAlldTps62113Func,
|
||
688 | /* shell command */ {
|
||
689 | /* name */ "unittest:StepDownConverter", |
||
690 | /* callback */ _utShellCmdCb_AlldTps62113,
|
||
691 | /* next */ NULL, |
||
692 | }, |
||
693 | /* data */ &moduleLldStepDownConverterVdrive,
|
||
694 | }; |
||
695 | |||
696 | /* VCNL4020 (proximity sensor) */
|
||
697 | static void _utAlldVcnl4020_disableInterrupt(VCNL4020Driver* vcnl) |
||
698 | { |
||
699 | uint8_t intstatus; |
||
700 | vcnl4020_lld_writereg(vcnl, VCNL4020_LLD_REGADDR_INTCTRL, 0, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout);
|
||
701 | vcnl4020_lld_readreg(vcnl, VCNL4020_LLD_REGADDR_INTSTATUS, &intstatus, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
702 | if (intstatus) {
|
||
703 | vcnl4020_lld_writereg(vcnl, VCNL4020_LLD_REGADDR_INTSTATUS, intstatus, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
704 | } |
||
705 | return;
|
||
706 | } |
||
707 | static int _utShellCmdCb_AlldVcnl4020(BaseSequentialStream* stream, int argc, char* argv[]) |
||
708 | { |
||
709 | enum {
|
||
710 | UNKNOWN, |
||
711 | FL, FR, WL, WR, |
||
712 | } sensor = UNKNOWN; |
||
713 | // evaluate arguments
|
||
714 | if (argc == 2) { |
||
715 | if (strcmp(argv[1], "--frontleft") == 0 || strcmp(argv[1], "-fl") == 0) { |
||
716 | sensor = FL; |
||
717 | } else if (strcmp(argv[1], "--frontright") == 0 || strcmp(argv[1], "-fr") == 0) { |
||
718 | sensor = FR; |
||
719 | } else if (strcmp(argv[1], "--wheelleft") == 0 || strcmp(argv[1], "-wl") == 0) { |
||
720 | sensor = WL; |
||
721 | } else if (strcmp(argv[1], "--wheelright") == 0 || strcmp(argv[1], "-wr") == 0) { |
||
722 | sensor = WR; |
||
723 | } |
||
724 | } |
||
725 | if (sensor != UNKNOWN) {
|
||
726 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH0, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
727 | _utAlldVcnl4020_disableInterrupt(((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->vcnld); |
||
728 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH1, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
729 | _utAlldVcnl4020_disableInterrupt(((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->vcnld); |
||
730 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH2, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
731 | _utAlldVcnl4020_disableInterrupt(((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->vcnld); |
||
732 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH3, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
733 | _utAlldVcnl4020_disableInterrupt(((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->vcnld); |
||
734 | switch (sensor) {
|
||
735 | case FL:
|
||
736 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH3, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
737 | 1e5f7648 | Thomas Schöpping | aosUtRun(stream, &moduleUtAlldVcnl4020, "front left sensor");
|
738 | e545e620 | Thomas Schöpping | break;
|
739 | case FR:
|
||
740 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH0, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
741 | aosUtRun(stream, &moduleUtAlldVcnl4020, "front right sensor");
|
||
742 | break;
|
||
743 | case WL:
|
||
744 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH2, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
745 | aosUtRun(stream, &moduleUtAlldVcnl4020, "left wheel sensor");
|
||
746 | break;
|
||
747 | case WR:
|
||
748 | pca9544a_lld_setchannel(&moduleLldI2cMultiplexer, PCA9544A_LLD_CH1, ((ut_vcnl4020data_t*)moduleUtAlldVcnl4020.data)->timeout); |
||
749 | aosUtRun(stream, &moduleUtAlldVcnl4020, "right wheel sensor");
|
||
750 | break;
|
||
751 | default:
|
||
752 | break;
|
||
753 | } |
||
754 | return AOS_OK;
|
||
755 | } |
||
756 | // print help
|
||
757 | chprintf(stream, "Usage: %s OPTION\n", argv[0]); |
||
758 | chprintf(stream, "Options:\n");
|
||
759 | chprintf(stream, " --frontleft, -fl\n");
|
||
760 | chprintf(stream, " Test front left proximity sensor.\n");
|
||
761 | chprintf(stream, " --frontrigt, -fr\n");
|
||
762 | chprintf(stream, " Test front right proximity sensor.\n");
|
||
763 | chprintf(stream, " --wheelleft, -wl\n");
|
||
764 | chprintf(stream, " Test left wheel proximity sensor.\n");
|
||
765 | chprintf(stream, " --wheelright, -wr\n");
|
||
766 | chprintf(stream, " Test right wheel proximity sensor.\n");
|
||
767 | return AOS_INVALID_ARGUMENTS;
|
||
768 | } |
||
769 | static ut_vcnl4020data_t _utVcnl4020Data = {
|
||
770 | /* driver */ &moduleLldProximity,
|
||
771 | /* timeout */ MICROSECONDS_PER_SECOND,
|
||
772 | 6b53f6bf | Thomas Schöpping | /* event source */ &aos.events.io,
|
773 | 1e5f7648 | Thomas Schöpping | /* event flags */ MODULE_OS_IOEVENTFLAGS_IRINT,
|
774 | e545e620 | Thomas Schöpping | }; |
775 | aos_unittest_t moduleUtAlldVcnl4020 = { |
||
776 | /* name */ "VCNL4020", |
||
777 | /* info */ "proximity sensor", |
||
778 | /* test function */ utAlldVcnl4020Func,
|
||
779 | /* shell command */ {
|
||
780 | /* name */ "unittest:Proximity", |
||
781 | /* callback */ _utShellCmdCb_AlldVcnl4020,
|
||
782 | /* next */ NULL, |
||
783 | }, |
||
784 | /* data */ &_utVcnl4020Data,
|
||
785 | }; |
||
786 | |||
787 | #endif /* AMIROOS_CFG_TESTS_ENABLE == true */ |
||
788 | |||
789 | /** @} */
|
||
790 | 53710ca3 | Marc Rothmann | /** @} */ |