4H-ALARM / 2024-Hydra

Other
0 stars 2 forks source link

Write Autonomous Command to check motor functions #6

Open nicholastmosher opened 8 months ago

nicholastmosher commented 8 months ago

Amit suggested yesterday to use autonomous mode to test the drive system, which I think is a great idea. Let's create a Command that runs each motor in a known sequence, so we can run it any time needed (e.g. in the pit while diagnosing a problem). As a first-pass, let's make the command do the following:

One at a time, with a 2 second wait between, assign the position of each steering motor to angle 0

One at a time, with a 2 second wait between, run each motor at 50% for 1 second, then 75% for 1 second, then 100% for 1 second