Add function to return current speed.
Rename functions to follow more closely with Arduino conventions.