Create a class which uses the wheelRPM state variables, and calculates a net speed of the robot in ft/sec.
Will have to do some math which I haven't worked out yet.
Speed should be saved to a new varaiable defined in RobotState. Speed should be logged, displayed in the State webpage, and also displayed as a dial on the driver view webpage.
1) Convert wheel speeds from RPM to radians/sec
2) Calculate wheel radius in ft (4-inch diameter wheels)
3) use math from paper to calculate x/y velocities
4) calculate net speed using right-triangle maths
Create a class which uses the wheelRPM state variables, and calculates a net speed of the robot in ft/sec.
Will have to do some math which I haven't worked out yet.
Speed should be saved to a new varaiable defined in RobotState. Speed should be logged, displayed in the State webpage, and also displayed as a dial on the driver view webpage.