Create commands for ferrying fuel. One for ferrying to driver oriented left, and one for right.
The commands should
- Get the appropriate Pose3d depending on the current alliance, and stash it in a variable
- Have a member Transform2d that starts at the default 0
- Adjust the transform based on the operator left stick input
- Have a method that returns the Pose3d represented by adding the transform to the original pose
- Create have a 'ShootToPose' command in the constructor that is passed that method as its Pose supplier
- Call
schedule() on that 'ShootToPose' in initialize, and cancel() in end
Map these commands to operator Left Trigger and Right Trigger appropriately
Create commands for ferrying fuel. One for ferrying to driver oriented left, and one for right.
The commands should
schedule()on that 'ShootToPose' in initialize, andcancel()in endMap these commands to operator Left Trigger and Right Trigger appropriately