Cody

Problem 2103. Simple Robotics 1: On track?

As a small extension to problem: http://www.mathworks.com/matlabcentral/cody/problems/2100-distance-to-a-straight-line-2d-given-any-2-distinct-points-on-this-straight-line, imagine that Pe represents the attitude of a robotic end effector with 3 degrees of freedom (x,y and tht).

The end-effector (kind of orange) has to stay parallel to the straight line within a distance indicated by "errorlevel". The error levels for the distance are 1 cm (ridiculous accuracy) and .5 degrees for the end effector angle.

Write a function which returns true if the end-effector is "on track" and false if the position of the origin of the coordinate frame which is considered to be attached to the centre of the end effector, falls outside the area indicated by the dash-dotted line. Also return false if the end effector orientation is too far off from the direction of the straight line.

Solution Stats

50.0% Correct | 50.0% Incorrect
Last Solution submitted on Apr 01, 2019