Fix S curve acceleration issues

Ensure the values send with the A and AA commands always satisfy
the following condition: 1/2*A <= AA <= A. If this is not the case
the motor controller responds with an "*INVALID CONDITIONS FOR
S_CURVE ACCELERATION" error.
Merge pull request #14 from mark0n/fixAccelBug

Fix S curve acceleration issues