Speed of encoder is now printed to dashboard

Grabs the rate of the encoder and pushes it to the smartdashboard.