Add equals override to ChassisSpeeds

[srimanachanta]

The ChassisSpeeds class is missing an equals override method

[auscompgeek]

Can you give an example where this would be useful?

[srimanachanta]

Can you give an example where this would be useful?

Trajectory State, checking if one trajectory state is equal to another for interpolation. Speaking of, this should probably implement Interpolatable<ChassisSpeeds> too