Trajectory Planning of Industrial Robots in a Structured Environment