1 #!/usr/bin/python 2 # Author: Jon Trulson <jtrulson (at] ics.com> 3 # Copyright (c) 2015 Intel Corporation. 4 # 5 # Permission is hereby granted, free of charge, to any person obtaining 6 # a copy of this software and associated documentation files (the 7 # "Software"), to deal in the Software without restriction, including 8 # without limitation the rights to use, copy, modify, merge, publish, 9 # distribute, sublicense, and/or sell copies of the Software, and to 10 # permit persons to whom the Software is furnished to do so, subject to 11 # the following conditions: 12 # 13 # The above copyright notice and this permission notice shall be 14 # included in all copies or substantial portions of the Software. 15 # 16 # THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 17 # EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 18 # MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 19 # NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE 20 # LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION 21 # OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 22 # WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 23 24 import time, sys, signal, atexit 25 import pyupm_lsm9ds0 as sensorObj 26 27 # Instantiate an LSM9DS0 using default parameters (bus 1, gyro addr 6b, 28 # xm addr 1d) 29 sensor = sensorObj.LSM9DS0() 30 31 ## Exit handlers ## 32 # This function stops python from printing a stacktrace when you hit control-C 33 def SIGINTHandler(signum, frame): 34 raise SystemExit 35 36 # This function lets you run code on exit 37 def exitHandler(): 38 print "Exiting" 39 sys.exit(0) 40 41 # Register exit handlers 42 atexit.register(exitHandler) 43 signal.signal(signal.SIGINT, SIGINTHandler) 44 45 sensor.init() 46 47 x = sensorObj.new_floatp() 48 y = sensorObj.new_floatp() 49 z = sensorObj.new_floatp() 50 51 while (1): 52 sensor.update() 53 sensor.getAccelerometer(x, y, z) 54 print "Accelerometer: AX: ", sensorObj.floatp_value(x), 55 print " AY: ", sensorObj.floatp_value(y), 56 print " AZ: ", sensorObj.floatp_value(z) 57 58 sensor.getGyroscope(x, y, z) 59 print "Gyroscope: GX: ", sensorObj.floatp_value(x), 60 print " GY: ", sensorObj.floatp_value(y), 61 print " GZ: ", sensorObj.floatp_value(z) 62 63 sensor.getMagnetometer(x, y, z) 64 print "Magnetometer: MX: ", sensorObj.floatp_value(x), 65 print " MY: ", sensorObj.floatp_value(y), 66 print " MZ: ", sensorObj.floatp_value(z) 67 68 print "Temperature: ", sensor.getTemperature() 69 print 70 71 time.sleep(.5) 72
