45 lines
1.0 KiB
C++
45 lines
1.0 KiB
C++
/*
|
|
Provided to you by Emlid Ltd (c) 2014.
|
|
twitter.com/emlidtech || www.emlid.com || info@emlid.com
|
|
|
|
Example: Read accelerometer, gyroscope and magnetometer values from
|
|
MPU9250 inertial measurement unit over SPI on Raspberry Pi + Navio.
|
|
|
|
Navio's onboard MPU9250 is connected to the SPI bus on Raspberry Pi
|
|
and can be read through /dev/spidev0.1
|
|
|
|
To run this example navigate to the directory containing it and run following commands:
|
|
make
|
|
./AccelGyroMag
|
|
*/
|
|
|
|
#include "darkwater/DW640.h"
|
|
#include "darkwater/Util.h"
|
|
#include <stdlib.h>
|
|
//=============================================================================
|
|
|
|
int main()
|
|
{
|
|
if (check_apm()) {
|
|
return 1;
|
|
}
|
|
//-------------------------------------------------------------------------
|
|
DW640 dw;
|
|
dw.initialize();
|
|
|
|
dw.setMotorOff( 1 );
|
|
printf("forward\n");
|
|
dw.setMotorSpeed( 1, 200 );
|
|
sleep(5);
|
|
printf("stop\n");
|
|
dw.setMotorOff( 1 );
|
|
sleep(5);
|
|
printf("reverse\n");
|
|
dw.setMotorSpeed( 1, -200 );
|
|
sleep(5);
|
|
printf("stop\n");
|
|
dw.setMotorOff( 1 );
|
|
|
|
|
|
}
|