Open JimTripi opened 5 years ago
The previous code was already written for a SWD (last year's robot). For reference, here's the code:
This anti tilt will need to be toggled off for the end climb. The current climbing mechanism intentionally tilts the robot platform dramatically. Not sure what we should use to time this. Perhaps the elapse time since start of match, to the start of climb period. As with many special functions, we may want a manual override toggle as well.
The magnitude of motor input may need to be tuned for the new robot’s center of gravity and momentum characteristics. The Mecanum could strafe into the fall if tipping sideways, so the 6 wheel like needs a little forward or backward input added so it will pirouette.