intial commit of new function which uses robot dynamics to simulate robot motion, in place of its abstraction