Robot interaction with the surrounding environment is an important and newsworthy problem in the context of industrial and service robotics. Collision avoidance gives the robot the ability to avoid contacts with objects around it, but most of the industrial controls implementing collision avoidance checks only the robot Tool Center Point (TCP) over the… (More)