Set trajectory state to match robot state initially
A few fixes
Changed names and adapted CMakeLists.txt accordingly
cartesian_teleoperation class done
Added doxygen comments