def testTwoMotorDriveSystemCreation(self):
d = DriveSystem(2)
self.assertEqual(d.get_position(), (0,0))
self.assertEqual(d.get_bearing(), 0)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.left), DriveSystem.MotorStatus.ready)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.right), DriveSystem.MotorStatus.ready)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.front_left), DriveSystem.MotorStatus.not_present)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.front_right), DriveSystem.MotorStatus.not_present)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.rear_right), DriveSystem.MotorStatus.not_present)
self.assertEqual(d.get_motor_status(DriveSystem.MotorPosition.rear_left), DriveSystem.MotorStatus.not_present)
def test720DegreeAntiClock(self):
d = DriveSystem(2)
d.spin(-720)
self.assertEqual(d.get_position(), (0,0))
self.assertEqual(d.get_bearing(), 0)
def test30DegreeClock(self):
d = DriveSystem(2)
d.spin(30)
self.assertEqual(d.get_position(), (0,0))
self.assertEqual(d.get_bearing(), 30)
def testBackwardTwoMetres(self):
d = DriveSystem(2)
d.backward(2)
self.assertEqual(d.get_position(), (0, -2))
self.assertEqual(d.get_bearing(), 0)
def testBackwardHalfMetre(self):
d = DriveSystem(2)
d.backward(0.5)
self.assertEqual(d.get_position(), (0, -0.5))
self.assertEqual(d.get_bearing(), 0)
def testBackwardOneMetre(self):
d = DriveSystem(2)
d.backward(1)
self.assertEqual(d.get_position(), (0, -1))
self.assertEqual(d.get_bearing(), 0)
