Use planar safety ceiling for entry coordinate

[kjy5]

• Compute entry coordinate as some point on the safety ceiling (3.5 mm DV above the reference coordinate)
• Warn users if this coordinate is too far away and there may not be enough range for the manipulator