#!/usr/bin/python
import RoboPiLib as RoboPi
import time as time
RoboPi.RoboPiInit("/dev/ttyAMA0", 115200)
HC_SR04 = 16
while 1:
print "Distance is ", RoboPi.readDistance(HC_SR04)
time.sleep(0.1)
RoboPi.RoboPiExit()
def stop():
RPL.servoWrite(0,0)
RPL.servoWrite(1,0)
def hard_turn_left():
RPL.servoWrite(0,1500)
def turn_left():
RPL.servoWrite(0,1000)
def turn_right():
RPL.servoWrite(1,1000)
def hard_turn_right():
RPL.ServoWrite(1,1500)
print "Input command"
command = raw_input("> ")
if command == "Initialize":
while True:
if RPL.readDistance(1) < 30:
turn_left()
start_time = time.time()
if time.time - start_time > 3 and RPL.readDistance(1) > 30:
cease()
elif readDistance(0) < 30:
turn_right()
start_time=time.time()
if time.time - start_time > 3 and RPL.readDistance(1) > 30:
cease()
else:
turn_left()
turn_right()
halt = raw_input("> ")
if halt == "Halt":
