def setUp(self): self.stationKeeping = stationkeeping.StationKeeping() topLeftCoord= datatypes.GPSCoordinate(50,-123) topRightCoord=datatypes.GPSCoordinate(50,-122) botLeftCoord=datatypes.GPSCoordinate(49,-123) botRightCoord=datatypes.GPSCoordinate(49,-122) self.boxCoords = standardcalc.setBoxCoords(topLeftCoord, topRightCoord, botLeftCoord, botRightCoord) self.waypoints = self.stationKeeping.setWayPtCoords(self.boxCoords)
def run(self, wayList):
boxCoords = standardcalc.setBoxCoords(wayList[0].coordinate, wayList[1].coordinate, wayList[2].coordinate, wayList[3].coordinate)
self.wayPtCoords = self.setWayPtCoords(boxCoords) #top, right, bottom, left
gVars.logger.info("North waypoint: " + str(self.wayPtCoords[0]) + " East waypoint: " + str(self.wayPtCoords[1]) +" South waypoint: " + str(self.wayPtCoords[2]) + " West waypoint: " + str(self.wayPtCoords[3]) )
spdList = [self.meanSpd] * 100
boxDistList = self.getBoxDist(boxCoords) #top, right, bottom, left
self.currentWaypoint = self.getStartDirection(self.wayPtCoords)
self.printDistanceLogs(boxDistList)
gVars.logger.info("------CURRENT WAYPOINT=" + str(self.currentWaypoint)+" ---------")
gVars.logger.info("Station Keeping Initialization finished. Now running Station Keeping Challenge")
if (gVars.currentData.awa > 0):
self.upwindWaypoint = (self.currentWaypoint + 1) % 4
else:
self.upwindWaypoint = (self.currentWaypoint + 3) % 4
gVars.logger.info("------UPWIND WAYPOINT=" + str(self.upwindWaypoint)+" ---------")
self.stationKeep(boxCoords, spdList)
def testSetLSquare(self):
self.coordlist5 = standardcalc.setBoxCoords(self.coord15, self.coord13, self.coord14, self.coord16)
self.assertEqual((self.coordlist5[0] == self.coord15),1)
self.assertEqual((self.coordlist5[1] == self.coord16),1)
self.assertEqual((self.coordlist5[2] == self.coord13),1)
self.assertEqual((self.coordlist5[3] == self.coord14),1)
def testSetRSquare(self):
self.coordlist4 = standardcalc.setBoxCoords(self.coord10, self.coord11, self.coord9, self.coord12)
self.assertEqual((self.coordlist4[0] == self.coord10),1)
self.assertEqual((self.coordlist4[1] == self.coord12),1)
self.assertEqual((self.coordlist4[2] == self.coord11),1)
self.assertEqual((self.coordlist4[3] == self.coord9),1)
def testSetDiamond2(self):
self.coordlist3 = standardcalc.setBoxCoords(self.coord5, self.coord6, self.coord8, self.coord7)
self.assertEqual((self.coordlist3[0] == self.coord8),1)
self.assertEqual((self.coordlist3[1] == self.coord7),1)
self.assertEqual((self.coordlist3[2] == self.coord6),1)
self.assertEqual((self.coordlist3[3] == self.coord5),1)
def testSetDiamond1(self):
self.coordlist2 = standardcalc.setBoxCoords(self.coord7, self.coord8, self.coord6, self.coord5)
self.assertEqual((self.coordlist2[0] == self.coord8),1)
self.assertEqual((self.coordlist2[1] == self.coord7),1)
self.assertEqual((self.coordlist2[2] == self.coord6),1)
self.assertEqual((self.coordlist2[3] == self.coord5),1)
def testSetSquare(self):
self.coordlist1 = standardcalc.setBoxCoords(self.coord2, self.coord4, self.coord3, self.coord1)
self.assertEqual((self.coordlist1[0] == self.coord1),1)
self.assertEqual((self.coordlist1[1] == self.coord2),1)
self.assertEqual((self.coordlist1[2] == self.coord3),1)
self.assertEqual((self.coordlist1[3] == self.coord4),1)
def testCase3(self):
self.coordlist1 = standardcalc.setBoxCoords(self.coord0, self.coord2, self.coord1, self.coord3)
self.assertIs(self.coordlist1[0],self.coord1)
self.assertIs(self.coordlist1[3],self.coord0)
self.assertIs(self.coordlist1[2],self.coord3)
self.assertIs(self.coordlist1[1],self.coord2)
def initialize(self, c0, c1, c2, c3):
self.roundBuoyCR = roundbuoychaserace.RoundBuoyChaseRace()
self.boxCoords = standardcalc.setBoxCoords(c0, c1, c2, c3)
self.currentWaypoint = self.getStartDirection(self.boxCoords)
gVars.logger.info("Current Waypoint is " + str(self.currentWaypoint))
def initialize(self,c0, c1, c2, c3):
self.roundBuoyCR = roundbuoychaserace.RoundBuoyChaseRace()
self.boxCoords = standardcalc.setBoxCoords(c0, c1, c2, c3)
self.currentWaypoint = self.getStartDirection(self.boxCoords)
gVars.logger.info("Current Waypoint is "+str(self.currentWaypoint))
