Added roslaunch files that reduce trajectory filter time. MoveToPose works but it needs to wait for the previous request to finish.