Added Motor Constants
Cleaned up code

Got rid of stupid functions and comments and add a nice paragraph under
the constants.h