initial commit before merging calligraphy TG and our standard TG
reverted the patch
merged TG and calligraphy traj. contr.
fixed connection loss -> merged call. traj. controller with TG
merged the trajectory following from the calligraphy project into the TG