From cb24fff73ca3c72f7a1992165eb383100082c0e2 Mon Sep 17 00:00:00 2001 From: Rocco Marco Guglielmi Date: Tue, 10 May 2016 17:19:18 +0000 Subject: Simplified L3GD20 demos git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9460 35acf78f-673a-0410-8e92-d51de3d6d3f4 --- testhal/STM32/STM32L4xx/SPI-L3GD20/main.c | 19 ++----------------- 1 file changed, 2 insertions(+), 17 deletions(-) (limited to 'testhal/STM32/STM32L4xx/SPI-L3GD20/main.c') diff --git a/testhal/STM32/STM32L4xx/SPI-L3GD20/main.c b/testhal/STM32/STM32L4xx/SPI-L3GD20/main.c index 94850da3b..288a15c81 100644 --- a/testhal/STM32/STM32L4xx/SPI-L3GD20/main.c +++ b/testhal/STM32/STM32L4xx/SPI-L3GD20/main.c @@ -103,30 +103,15 @@ int main(void) { l3gd20Start(&L3GD20D1, &l3gd20cfg); while(!palReadLine(LINE_JOY_CENTER)){ - palToggleLine(LINE_LED_RED); - gyroscopeReadRaw(&L3GD20D1, rawdata); - for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++) - chprintf(chp, "RAW-%c:%d\r\n", axesID[i], rawdata[i]); - - gyroscopeReadCooked(&L3GD20D1, cookeddata); - for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++) - chprintf(chp, "COOKED-%c:%.3f\r\n", axesID[i], cookeddata[i]); - - gyroscopeGetTemp(&L3GD20D1, &temperature); - chprintf(chp, "TEMP:%.1f C°\r\n", temperature); - - chprintf(chp, "Press JOY to continue...\r\n"); + chprintf(chp, "Press JOY to calibrate gyroscope...\r\n"); chThdSleepMilliseconds(150); #if CHPRINTF_USE_ANSI_CODE chprintf(chp, "\033[2J\033[1;1H"); #endif } - - palClearLine(LINE_LED_RED); + chprintf(chp, "Calibrating Gyroscope sampling bias...\r\n"); chprintf(chp, "Keep it in the rest position while red LED is on\r\n"); - chThdSleepMilliseconds(3000); - palSetLine(LINE_LED_RED); chThdSleepMilliseconds(1000); -- cgit v1.2.3