A mathematical algorithm is proposed that will generate an incremental motion for each position of the manipulator. Repeated use of this algorithm will automatically direct the mechanical arm (manipulator) to a specified destination avoiding collisions with obstacles.