def test720DegreeAntiClock(self):
d = DriveSystem(2)
d.spin(-720)
self.assertEqual(d.get_position(), (0,0))
self.assertEqual(d.get_bearing(), 0)
def test360DegreeTravel(self):
d = DriveSystem(2)
d.spin(360)
d.forward(5)
self.assertAlmostEqual(d.get_position()[0], 0)
self.assertAlmostEqual(d.get_position()[1], 5)
def test30DegreeClock(self):
d = DriveSystem(2)
d.spin(30)
self.assertEqual(d.get_position(), (0,0))
self.assertEqual(d.get_bearing(), 30)
def test330DegreeTravel(self):
d = DriveSystem(2)
d.spin(330)
d.forward(5)
self.assertAlmostEqual(d.get_position()[0], -2.5)
self.assertAlmostEqual(d.get_position()[1], 4.330127)
