mirror of
https://github.com/eclipse/upm.git
synced 2025-03-22 00:17:30 +03:00
456bde0726
This driver implements support for the Bosch BNO055 Absolute Orientation 9DOF Fusion Hub. It was implemented on the Adafruit variant at https://www.adafruit.com/products/2472. The BNO055 is a System in Package (SiP), integrating a triaxial 14-bit accelerometer, a triaxial 16-bit gyroscope with a range of ±2000 degrees per second, a triaxial geomagnetic sensor and a 32-bit cortex M0+ microcontroller running Bosch Sensortec sensor fusion software, in a single package. This sensor handles the hard problem of combining various sensor information into a reliable measurement of sensor orientation (refered to as 'sensor fusion'). The onboard MCU runs this software and can provide fusion output in the form of Euler Angles, Quaternions, Linear Acceleration, and Gravity Vectors in 3 axes. The focus on this driver has been on supporting the fusion components. Less support is available for use of this device as a generic accelerometer, gyroscope and magnetometer, however enough infrastructure is available to add any missing functionality. Signed-off-by: Jon Trulson <jtrulson@ics.com> Signed-off-by: Noel Eck <noel.eck@intel.com>
106 lines
3.6 KiB
Python
106 lines
3.6 KiB
Python
#!/usr/bin/python
|
|
# Author: Jon Trulson <jtrulson@ics.com>
|
|
# Copyright (c) 2016 Intel Corporation.
|
|
#
|
|
# 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.
|
|
|
|
import time, sys, signal, atexit
|
|
import pyupm_bno055 as sensorObj
|
|
|
|
# Instantiate an BNO055 using default parameters (bus 0, addr
|
|
# 0x28). The default running mode is NDOF absolute orientation
|
|
# mode.
|
|
sensor = sensorObj.BNO055()
|
|
|
|
## Exit handlers ##
|
|
# This function stops python from printing a stacktrace when you hit control-C
|
|
def SIGINTHandler(signum, frame):
|
|
raise SystemExit
|
|
|
|
# This function lets you run code on exit
|
|
def exitHandler():
|
|
print "Exiting..."
|
|
sys.exit(0)
|
|
|
|
# Register exit handlers
|
|
atexit.register(exitHandler)
|
|
signal.signal(signal.SIGINT, SIGINTHandler)
|
|
|
|
mag = sensorObj.new_intp()
|
|
acc = sensorObj.new_intp()
|
|
gyr = sensorObj.new_intp()
|
|
syst = sensorObj.new_intp()
|
|
|
|
w = sensorObj.new_floatp()
|
|
x = sensorObj.new_floatp()
|
|
y = sensorObj.new_floatp()
|
|
z = sensorObj.new_floatp()
|
|
|
|
print "First we need to calibrate. 4 numbers will be output every"
|
|
print "second for each sensor. 0 means uncalibrated, and 3 means"
|
|
print "fully calibrated."
|
|
print "See the UPM documentation on this sensor for instructions on"
|
|
print "what actions are required to calibrate."
|
|
print
|
|
|
|
while (not sensor.isFullyCalibrated()):
|
|
sensor.getCalibrationStatus(mag, acc, gyr, syst)
|
|
print "Magnetometer:", sensorObj.intp_value(mag),
|
|
print " Accelerometer:", sensorObj.intp_value(acc),
|
|
print " Gyroscope:", sensorObj.intp_value(gyr),
|
|
print " System:", sensorObj.intp_value(syst),
|
|
time.sleep(1)
|
|
|
|
print
|
|
print "Calibration complete."
|
|
print
|
|
|
|
# now output various fusion data every 250 milliseconds
|
|
|
|
while (True):
|
|
sensor.update()
|
|
|
|
sensor.getEulerAngles(x, y, z)
|
|
print "Euler: Heading:", sensorObj.floatp_value(x),
|
|
print " Roll:", sensorObj.floatp_value(y),
|
|
print " Pitch:", sensorObj.floatp_value(z),
|
|
print " degrees"
|
|
|
|
sensor.getQuaternions(w, x, y, z)
|
|
print "Quaternion: W:", sensorObj.floatp_value(w),
|
|
print " X:", sensorObj.floatp_value(x),
|
|
print " Y:", sensorObj.floatp_value(y),
|
|
print " Z:", sensorObj.floatp_value(z)
|
|
|
|
sensor.getLinearAcceleration(x, y, z)
|
|
print "Linear Acceleration: X:", sensorObj.floatp_value(x),
|
|
print " Y:", sensorObj.floatp_value(y),
|
|
print " Z:", sensorObj.floatp_value(z),
|
|
print " m/s^2"
|
|
|
|
sensor.getGravityVectors(x, y, z)
|
|
print "Gravity Vector: X:", sensorObj.floatp_value(x),
|
|
print " Y:", sensorObj.floatp_value(y),
|
|
print " Z:", sensorObj.floatp_value(z),
|
|
print " m/s^2"
|
|
|
|
print
|
|
time.sleep(.25);
|