import sys from geopy import distance import threading from imProc import imProcessing from capturing import ImageCap from cmds import calculateReading, issueCommands from globals import pixelStrip, startFrom, logInitial from gps import GPS if __name__ == "__main__": gps = GPS(logging=False) while gps.getCoords() == (0,0): print("Awaiting gps lock.") #time.sleep(0.2) gps.getGPS(force=1) startingPos = gps.getCoords() #so we know to stop 15m afterwards issueCommands(0,0) #connect to car distanceAway = 0 while distanceAway < 12: #go forward 15m distanceAway = distance.distance(gps.getGPS(force=1), startingPos).m print("Distance away from destination: ", distanceAway) issueCommands(1,100) #go straight issueCommands(0,0)
from cmds import issueCommands from gps import GPS import math if __name__ == "__main__": gps = GPS(logging=False) gps.getGPS() while gps.getCoords() == (0, 0): print("Awaiting gps lock.") startingPos = gps.getCoords() issueCommands(0, 0) distanceAway = 0 while distanceAway < 0: #go forward 15m gps.getGPS() distanceAway = (distance.distance(gps.getCoords(), startingPos)).m print("Distance away from destination: ", distanceAway) issueCommands(0, 85) issueCommands(0, 0) #connect to car startLeft = issueCommands.car.get_left_pulse() #should be 0 startRight = issueCommands.car.get_right_pulse() #should be 0 carWidth = 1.17 #in meters fullCircleDistance = 2 * math.pi * carWidth tyreCirc = math.pi * 0.58 fullCircleRotations = fullCircleDistance / tyreCirc