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