Browse Source

uncrustify libraries/AP_InertialSensor/examples/MPU6000/MPU6000.pde

master
uncrustify 13 years ago committed by Pat Hickey
parent
commit
25eaeff6a8
  1. 36
      libraries/AP_InertialSensor/examples/MPU6000/MPU6000.pde

36
libraries/AP_InertialSensor/examples/MPU6000/MPU6000.pde

@ -15,13 +15,13 @@
FastSerialPort(Serial, 0); FastSerialPort(Serial, 0);
Arduino_Mega_ISR_Registry isr_registry; Arduino_Mega_ISR_Registry isr_registry;
AP_TimerProcess scheduler; AP_TimerProcess scheduler;
AP_InertialSensor_MPU6000 ins( 53 ); /* chip select is pin 53 */ AP_InertialSensor_MPU6000 ins( 53 ); /* chip select is pin 53 */
void setup(void) void setup(void)
{ {
Serial.begin(115200); Serial.begin(115200);
Serial.println("Doing INS startup..."); Serial.println("Doing INS startup...");
SPI.begin(); SPI.begin();
SPI.setClockDivider(SPI_CLOCK_DIV16); // 1MHZ SPI rate SPI.setClockDivider(SPI_CLOCK_DIV16); // 1MHZ SPI rate
@ -29,25 +29,25 @@ void setup(void)
isr_registry.init(); isr_registry.init();
scheduler.init(&isr_registry); scheduler.init(&isr_registry);
// we need to stop the barometer from holding the SPI bus // we need to stop the barometer from holding the SPI bus
pinMode(40, OUTPUT); pinMode(40, OUTPUT);
digitalWrite(40, HIGH); digitalWrite(40, HIGH);
ins.init(&scheduler); ins.init(&scheduler);
} }
void loop(void) void loop(void)
{ {
float accel[3]; float accel[3];
float gyro[3]; float gyro[3];
float temperature; float temperature;
delay(20); delay(20);
ins.update(); ins.update();
ins.get_gyros(gyro); ins.get_gyros(gyro);
ins.get_accels(accel); ins.get_accels(accel);
temperature = ins.temperature(); temperature = ins.temperature();
Serial.printf("AX: %f AY: %f AZ: %f GX: %f GY: %f GZ: %f T=%f\n", Serial.printf("AX: %f AY: %f AZ: %f GX: %f GY: %f GZ: %f T=%f\n",
accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2], temperature); accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2], temperature);
} }

Loading…
Cancel
Save