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_rfr359f as upmRfr359f
26765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
27765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Instantiate an RFR359F digital pin D2
28765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# This was tested on the Grove IR Distance Interrupter
29765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun ZhangmyDistInterrupter = upmRfr359f.RFR359F(2)
30765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
31765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
32765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang## Exit handlers ##
33765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# This function stops python from printing a stacktrace when you hit control-C
34765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangdef SIGINTHandler(signum, frame):
35765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	raise SystemExit
36765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
37765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# This function lets you run code on exit, including functions from myDistInterrupter
38765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangdef exitHandler():
39765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	print "Exiting"
40765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	sys.exit(0)
41765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
42765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang# Register exit handlers
43765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangatexit.register(exitHandler)
44765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangsignal.signal(signal.SIGINT, SIGINTHandler)
45765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
46765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang
47765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhangwhile(1):
48765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	if (myDistInterrupter.objectDetected()):
49765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang		print "Object detected"
50765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	else:
51765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang		print "Area is clear"
52765adb95dc941c32690d6c43bc08b9d07d197fcbJianxun Zhang	time.sleep(.1)
53