mirror of
https://github.com/eclipse/upm.git
synced 2025-03-22 00:17:30 +03:00
03e72e02f8
This driver has been rewritten from scratch. It is implemented as 3 seperate drivers now (but all included as part of the mpu9150 UPM library): AK8975 (Magnetometer) MPU60X0 (Accelerometer, Gyroscope, and Temperature sensor) MPU9150 (composed of AK8975 and MPU60X0) Each driver can be used independently and includes examples in C++/JS/Python. Commonly used capabilities are supported, and methods/register definitions exist to easily implement any desired functionality that is missing. Interrupt support has also been added. Scaling support has also been properly implemented for both the Accelerometer and Gyroscope. Signed-off-by: Jon Trulson <jtrulson@ics.com> Signed-off-by: Mihai Tudor Panu <mihai.tudor.panu@intel.com>
71 lines
2.4 KiB
Python
71 lines
2.4 KiB
Python
#!/usr/bin/python
|
|
# Author: Jon Trulson <jtrulson@ics.com>
|
|
# Copyright (c) 2015 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_mpu9150 as sensorObj
|
|
|
|
# Instantiate an MPU9150 on I2C bus 0
|
|
sensor = sensorObj.MPU9150()
|
|
|
|
## 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)
|
|
|
|
sensor.init()
|
|
|
|
x = sensorObj.new_floatp()
|
|
y = sensorObj.new_floatp()
|
|
z = sensorObj.new_floatp()
|
|
|
|
while (1):
|
|
sensor.update()
|
|
sensor.getAccelerometer(x, y, z)
|
|
print "Accelerometer: AX: ", sensorObj.floatp_value(x),
|
|
print " AY: ", sensorObj.floatp_value(y),
|
|
print " AZ: ", sensorObj.floatp_value(z)
|
|
|
|
sensor.getGyroscope(x, y, z)
|
|
print "Gyroscope: GX: ", sensorObj.floatp_value(x),
|
|
print " GY: ", sensorObj.floatp_value(y),
|
|
print " GZ: ", sensorObj.floatp_value(z)
|
|
|
|
sensor.getMagnetometer(x, y, z)
|
|
print "Magnetometer: MX: ", sensorObj.floatp_value(x),
|
|
print " MY: ", sensorObj.floatp_value(y),
|
|
print " MZ: ", sensorObj.floatp_value(z)
|
|
|
|
print "Temperature: ", sensor.getTemperature()
|
|
print
|
|
|
|
time.sleep(.5)
|