fixed various bugs, corrected feed-forward speed control, approximately tuned acceleration on 688, added a commented-out print statement for speed