added dynamic trajectory creator; unable to make a KDL tree from this version