Method and System for Assisting in the Handling of Robotized Machines in a Congested Environment

A method for handling of a first robotized mobile machine moving in a congested working environment under the control of a second robotized mobile machine, providing the operator, in real time, with a relevant view of the working scene, even if an object intrudes into the field of view of the camera and thereby obscures the operator's view. This method is based on use of properties of a physics engine of the constraint resolution type. For each object in the scene, the physics engine has a physical representation of said object in the form of a mesh. The engine calculates a wrench on the basis of the respective positions and velocities of two objects. In case of a collision between the manipulator and a fixed object in the scene, the engine determines the wrench to be applied to the manipulator in order to make it avoid the object.