Adjust speeds based on maximum accelerations

[merose]

There are parameters for maximum linear and angular acceleration but they are not yet used. This causes a noticeable lurch and possibly jerk to new orientation when the robot starts moving. Need to limit speed changes to keep under the acceleration limits.