rename KinematicState to RobotState, KinematicTrajectory to RobotTrajectory