Work on position controlled surface, corrects some errors in dynamics computation.