Robot Path and Trajectory Planning Considering a Spatially Fixed TCP