init
This commit is contained in:
parent
471a8e5b31
commit
679d770b33
78
sketch-rotabators.ino
Normal file
78
sketch-rotabators.ino
Normal file
|
@ -0,0 +1,78 @@
|
||||||
|
/*
|
||||||
|
* Library: https://github.com/bolderflight/MPU9250
|
||||||
|
Basic_I2C.ino
|
||||||
|
Brian R Taylor
|
||||||
|
brian.taylor@bolderflight.com
|
||||||
|
|
||||||
|
Copyright (c) 2017 Bolder Flight Systems
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy of this software
|
||||||
|
and associated documentation files (the "Software"), to deal in the Software without restriction,
|
||||||
|
including without limitation the rights to use, copy, modify, merge, publish, distribute,
|
||||||
|
sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice and this permission notice shall be included in all copies or
|
||||||
|
substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
|
||||||
|
BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||||
|
NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
|
||||||
|
DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
* Updated by Ahmad Shamshiri on July 09, 2018 for Robojax.com
|
||||||
|
* in Ajax, Ontario, Canada
|
||||||
|
* watch instrucion video for this code:
|
||||||
|
For this sketch you need to connect:
|
||||||
|
VCC to 5V and GND to GND of Arduino
|
||||||
|
SDA to A4 and SCL to A5
|
||||||
|
|
||||||
|
S20A is 3.3V voltage regulator MIC5205-3.3BM5
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "MPU9250.h"
|
||||||
|
#include "AccelStepper.h"
|
||||||
|
|
||||||
|
float biai = 1.25;
|
||||||
|
|
||||||
|
// an MPU9250 object with the MPU-9250 sensor on I2C bus 0 with address 0x68
|
||||||
|
MPU9250 IMU(Wire,0x68);
|
||||||
|
int status;
|
||||||
|
AccelStepper stepper;
|
||||||
|
|
||||||
|
void setup() {
|
||||||
|
// serial to display data
|
||||||
|
Serial.begin(115200);
|
||||||
|
stepper.setMaxSpeed(1700);
|
||||||
|
stepper.setSpeed(1700);
|
||||||
|
while(!Serial) {}
|
||||||
|
|
||||||
|
// start communication with IMU
|
||||||
|
status = IMU.begin();
|
||||||
|
if (status < 0) {
|
||||||
|
Serial.println("IMU initialization unsuccessful");
|
||||||
|
Serial.println("Check IMU wiring or try cycling power");
|
||||||
|
Serial.print("Status: ");
|
||||||
|
Serial.println(status);
|
||||||
|
while(1) {}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void loop() {
|
||||||
|
// read the sensor
|
||||||
|
IMU.readSensor();
|
||||||
|
stepper.runSpeed();
|
||||||
|
// display the data
|
||||||
|
Serial.print("AccelX: ");
|
||||||
|
Serial.print(IMU.getAccelX_mss(),2);
|
||||||
|
Serial.print(" ");
|
||||||
|
Serial.print("AccelY: ");
|
||||||
|
Serial.print(IMU.getAccelY_mss(),2);
|
||||||
|
Serial.print(" ");
|
||||||
|
Serial.print("AccelZ: ");
|
||||||
|
Serial.println(IMU.getAccelZ_mss() + biai,2);
|
||||||
|
|
||||||
|
delay(200);
|
||||||
|
}
|
Loading…
Reference in a new issue