Simplified L3GD20 demos
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9460 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
parent
63f127f792
commit
cb24fff73c
|
@ -114,24 +114,11 @@ int main(void) {
|
|||
l3gd20Start(&L3GD20D1, &l3gd20cfg);
|
||||
|
||||
while(!palReadLine(LINE_BUTTON)){
|
||||
palToggleLine(LINE_LED3);
|
||||
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 BUTTON to continue...\r\n");
|
||||
chprintf(chp, "Press BTN to calibrate gyroscope...\r\n");
|
||||
chThdSleepMilliseconds(150);
|
||||
#if CHPRINTF_USE_ANSI_CODE
|
||||
chprintf(chp, "\033[2J\033[1;1H");
|
||||
#endif
|
||||
}
|
||||
|
||||
palClearLine(LINE_LED3);
|
||||
chprintf(chp, "Calibrating Gyroscope sampling bias...\r\n");
|
||||
|
|
|
@ -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);
|
||||
|
||||
|
|
Loading…
Reference in New Issue