added support for surprise and adapt/stop control strategies using joint positions
added support for cartesian pose control using quaternions but have some issues with Eigen, so I will try to minimize use of Quaternions in the next code update and store orientation in a 4-vector until calculations are required
added support for cartesian control during teach and play and adapt