No Description

curieimu.py 1.7KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556
  1. #!/usr/bin/python
  2. # Author: Ron Evans (@deadprogram)
  3. # Copyright (c) 2016 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. import mraa
  24. print (mraa.getVersion())
  25. # open connection to Firmata
  26. mraa.addSubplatform(mraa.GENERIC_FIRMATA, "/dev/ttyACM0")
  27. import time, sys, signal, atexit
  28. import pyupm_curieimu as curieimu
  29. sensor = curieimu.CurieImu()
  30. ## Exit handlers ##
  31. def SIGINTHandler(signum, frame):
  32. raise SystemExit
  33. def exitHandler():
  34. print "Exiting"
  35. sys.exit(0)
  36. # Register exit handlers
  37. atexit.register(exitHandler)
  38. signal.signal(signal.SIGINT, SIGINTHandler)
  39. while(1):
  40. sensor.updateAccel();
  41. outputStr = "acc: gX {0} - gY {1} - gZ {2}".format(
  42. sensor.getAccelX(), sensor.getAccelY(),
  43. sensor.getAccelZ())
  44. print outputStr
  45. time.sleep(1)