Added locks
Imports were wrong because of file name change. Fixed
Added CommandPose, which uses JTCartesianController. Was not able to test because I don't have ROS on my computer. BTW we need to change the places that use your path to use an environment variable.