Motor scheduler now does less work.

Pi will be sending three commands for every move - acceleration,
constant speed, and then deacceleration.
Moved test code out of the main code.
Made the checking for overflow a little more efficient.
Added code to process acceleration and constant speed commands.