1#!/usr/bin/python 2# Author: Jon Trulson <jtrulson@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 24import time, sys, signal, atexit 25import pyupm_h3lis331dl as upmH3LIS331DL 26 27# Instantiate an H3LIS331DL on I2C bus 0 28myDigitalAccelerometer = upmH3LIS331DL.H3LIS331DL( 29 upmH3LIS331DL.H3LIS331DL_I2C_BUS, 30 upmH3LIS331DL.H3LIS331DL_DEFAULT_I2C_ADDR); 31 32 33## Exit handlers ## 34# This function stops python from printing a stacktrace when you hit control-C 35def SIGINTHandler(signum, frame): 36 raise SystemExit 37 38# This function lets you run code on exit, including functions from myDigitalAccelerometer 39def exitHandler(): 40 print "Exiting" 41 sys.exit(0) 42 43# Register exit handlers 44atexit.register(exitHandler) 45signal.signal(signal.SIGINT, SIGINTHandler) 46 47 48# Initialize the device with default values 49myDigitalAccelerometer.init() 50 51x = upmH3LIS331DL.new_intp() 52y = upmH3LIS331DL.new_intp() 53z = upmH3LIS331DL.new_intp() 54 55ax = upmH3LIS331DL.new_floatp() 56ay = upmH3LIS331DL.new_floatp() 57az = upmH3LIS331DL.new_floatp() 58 59while (1): 60 myDigitalAccelerometer.update() 61 myDigitalAccelerometer.getRawXYZ(x, y, z) 62 outputStr = ("Raw: X = {0}" 63 " Y = {1}" 64 " Z = {2}").format(upmH3LIS331DL.intp_value(x), 65 upmH3LIS331DL.intp_value(y), 66 upmH3LIS331DL.intp_value(z)) 67 print outputStr 68 69 myDigitalAccelerometer.getAcceleration(ax, ay, az) 70 outputStr = ("Acceleration: AX = {0}" 71 " AY = {1}" 72 " AZ = {2}").format(upmH3LIS331DL.floatp_value(ax), 73 upmH3LIS331DL.floatp_value(ay), 74 upmH3LIS331DL.floatp_value(az)) 75 print outputStr 76 time.sleep(.5) 77