1 #!/usr/bin/python 2 # Author: Zion Orent <zorent (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_mma7660 as upmMMA7660 26 27 # Instantiate an MMA7660 on I2C bus 0 28 myDigitalAccelerometer = upmMMA7660.MMA7660( 29 upmMMA7660.MMA7660_I2C_BUS, 30 upmMMA7660.MMA7660_DEFAULT_I2C_ADDR); 31 32 33 ## Exit handlers ## 34 # This function stops python from printing a stacktrace when you hit control-C 35 def SIGINTHandler(signum, frame): 36 raise SystemExit 37 38 # This function lets you run code on exit, including functions from myDigitalAccelerometer 39 def exitHandler(): 40 print "Exiting" 41 sys.exit(0) 42 43 # Register exit handlers 44 atexit.register(exitHandler) 45 signal.signal(signal.SIGINT, SIGINTHandler) 46 47 48 # place device in standby mode so we can write registers 49 myDigitalAccelerometer.setModeStandby() 50 51 # enable 64 samples per second 52 myDigitalAccelerometer.setSampleRate(upmMMA7660.MMA7660.AUTOSLEEP_64) 53 54 # place device into active mode 55 myDigitalAccelerometer.setModeActive() 56 57 x = upmMMA7660.new_intp() 58 y = upmMMA7660.new_intp() 59 z = upmMMA7660.new_intp() 60 61 ax = upmMMA7660.new_floatp() 62 ay = upmMMA7660.new_floatp() 63 az = upmMMA7660.new_floatp() 64 65 while (1): 66 myDigitalAccelerometer.getRawValues(x, y, z) 67 outputStr = ("Raw values: x = {0}" 68 " y = {1}" 69 " z = {2}").format(upmMMA7660.intp_value(x), 70 upmMMA7660.intp_value(y), 71 upmMMA7660.intp_value(z)) 72 print outputStr 73 74 myDigitalAccelerometer.getAcceleration(ax, ay, az) 75 outputStr = ("Acceleration: x = {0}" 76 "g y = {1}" 77 "g z = {2}g").format(upmMMA7660.floatp_value(ax), 78 upmMMA7660.floatp_value(ay), 79 upmMMA7660.floatp_value(az)) 80 print outputStr 81 time.sleep(.5) 82