for test 1 implement a ROS-Publisher on the laptop that publishes 5 different arrays of axis clicks with a certain delay in between. This should make the robot move as a first measure
Implement this test for the topics DriveDist and DriveTo
Use topic Home to reset the robot in the beginning
Use topic SetPidState to turn off the motors after driving
DriveDist
andDriveTo
Home
to reset the robot in the beginningSetPidState
to turn off the motors after driving