WIP - Added get_motion functions to mechanics core

New functions-
1) get_motion_pos
2) get_motion_vel
3) get_motion_acc

Have to correct two tests and add doctests