1765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang#!/usr/bin/python 2765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Author: Zion Orent <zorent@ics.com> 3765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Copyright (c) 2015 Intel Corporation. 4765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# 5765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Permission is hereby granted, free of charge, to any person obtaining 6765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# a copy of this software and associated documentation files (the 7765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# "Software"), to deal in the Software without restriction, including 8765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# without limitation the rights to use, copy, modify, merge, publish, 9765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# distribute, sublicense, and/or sell copies of the Software, and to 10765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# permit persons to whom the Software is furnished to do so, subject to 11765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# the following conditions: 12765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# 13765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# The above copyright notice and this permission notice shall be 14765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# included in all copies or substantial portions of the Software. 15765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# 16765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 17765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 18765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 19765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE 20765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION 21765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 22765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 23765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 24765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangimport time, sys, signal, atexit 25765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangimport pyupm_gp2y0a as upmGp2y0a 26765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 27765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Note, for the Grove 80cm version of this sensor, due to the way it is wired, 28765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# you need to plug this into the A0 port, where it will use the available 29765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# A1 pin for data. 30765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Instantiate a GP2Y0A on analog pin A1 31765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun ZhangmyIRProximity = upmGp2y0a.GP2Y0A(1) 32765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 33765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 34765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang## Exit handlers ## 35765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# This stops python from printing a stacktrace when you hit control-C 36765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangdef SIGINTHandler(signum, frame): 37765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang raise SystemExit 38765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 39765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# This lets you run code on exit, 40765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# including functions from myIRProximity 41765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangdef exitHandler(): 42765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang print "Exiting" 43765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang sys.exit(0) 44765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 45765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Register exit handlers 46765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangatexit.register(exitHandler) 47765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangsignal.signal(signal.SIGINT, SIGINTHandler) 48765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 49765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 50765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# analog voltage, usually 3.3 or 5.0 51765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun ZhangGP2Y0A_AREF = 5.0; 52765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun ZhangSAMPLES_PER_QUERY = 20; 53765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang 54765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# The higher the voltage (closer to AREF) the closer the object is. 55765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# NOTE: The measured voltage will probably not exceed 3.3 volts. 56765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Every second, print the averaged voltage value 57765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# (averaged over 20 samples). 58765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangwhile (1): 59765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang print "AREF: {0}, Voltage value (higher means closer): {1}".format( 60765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang GP2Y0A_AREF, 61765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang myIRProximity.value(GP2Y0A_AREF, SAMPLES_PER_QUERY)) 62765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang time.sleep(1) 63