Improved steering trig, fixed steering timing

Changed to simply sin for left wheels, cos for right
Multiplied timeActive by 1000 instead of divide to convert to
milliseconds.
Minor code changes and cleanup