Method for programming a force to be applied by a robot

Abstract

Method for programming a force to be applied by a working end of a robot, along at least part of a preprogrammed path of the working end, the method comprising the steps of: —moving the working end of the robot over the said at least part of the preprogrammed path, the driving of the robot being feedback-controlled in order to keep the working end in position without a force setpoint, —at least at one position during the movement, having an operator apply to the working end a force which is the opposite of that which is to be applied during the task and which has an intensity proportionate to that which is to be applied during the task, —determining the force that is to be applied during the task from the resistive force exerted by the robot in order to keep the working end on the path, —storing in memory the force thus determined in relation to the position of the working end while the opposing force is being applied.

Claims

1. A method for programming for a task a force to be exerted on a surface by a working end of a robot along at least a part of a preprogrammed trajectory of the working end, the method comprising the steps of: moving the working end of the robot on said at least a part of the preprogrammed trajectory on the surface, the motorization of the robot being controlled to maintain the working end in position, in at least one position during the movement, an operator causing a force to be exerted on the working end, which force is opposed to that to be applied during the task and which has an intensity proportional to that to be applied during the task, the robot maintains the working end on the trajectory by producing a resistant force opposing the force exerted by the operator, determining the force to be applied during the task from the resistant force exerted by the robot to maintain the working end on the trajectory, storing the force thus determined in association with the position of the working end during the exertion of the opposed force.

2. The method as claimed in claim 1, in which, since the task must be performed using a tool, the working end is equipped with the tool during the movement of the working end along the programmed trajectory.

3. The method as claimed in claim 1, in which the opposed force is exerted by means of a mechanical link connected to the working end or to an element secured thereto.

4. The method as claimed in claim 1, in which the opposed force is exerted by means of an elastic element connected to the working end.

5. The method as claimed in claim 1, in which the determination of the force to be applied, followed by its storing, is activated by an operator command.

6. The method as claimed in claim 1, in which the determination of the force to be applied and its storing are carried out continuously along at least a part of the trajectory.

7. The method as claimed in claim 1, in which the resistant force is determined by measuring an electrical supply current of the motorization of the robot arm.

8. The method as claimed in claim 1, in which the resistant force is determined from a measurement by a force sensor arranged on the working end or an element secured thereto.

9. The method as claimed in claim 1, in which the resistant force is determined from a measurement by a force sensor arranged on a handgrip of the working end or an element secured thereto, by the operator.

10. The method as claimed in claim 1, comprising a final step to check the programming, during which the robot arm is commanded to move along said at least a part of the trajectory while the operator is in contact with the working end such that the operator feels the force applied by the robot arm.

11. A robot having a computer control unit programmed to implement the method as claimed in claim 1.

12. The method as claimed in claim 1, wherein during the step of moving the working end of the robot on said at least a part of the preprogrammed trajectory on the surface, the motorization of the robot is controlled to maintain the working end in position without applying a predetermined force for carrying out the task.

13. A method for control of a robot for performing a task during which a working end of the robot exerts a force on a surface along at least a part of a preprogrammed trajectory of the working end, the method comprising the steps of: during a programming phase preceding the task carrying out the following steps: moving the working end of the robot on said at least a part of the preprogrammed trajectory, the motorization of the robot controlled to maintain the working end in position, in at least one position during the movement, an operator causing a force to be exerted on the working end, which force is opposed to that to be applied during the task and which has an intensity proportional to that to be applied during the task, determining the force to be applied during the task from the resistant force exerted by the robot to maintain the working end on the trajectory, and storing in a control program of the robot the force thus determined in association with the position of the working end during the exertion of the opposed force; and during performance of the task carrying out the following step: executing the control program of the robot so that the robot moves the working end along the preprogrammed trajectory and exerts the stored force on the surface.

14. The method as claimed in claim 13, wherein during the step of moving the working end of the robot on said at least a part of the preprogrammed trajectory, the motorization of the robot is controlled to maintain the working end in position without applying a predetermined force for carrying out the task.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) Reference will be made to the accompanying drawings, in which:

(2) FIG. 1 is a schematic view illustrating the phase of learning of the force by the robot according to the method of the invention;

(3) FIG. 2 is a schematic view illustrating the fulfillment of the task by the robot;

(4) FIG. 3 is a schematic view illustrating the phase of learning of the force by the robot according to a variant implementation of the method of the invention.

DETAILED DESCRIPTION OF THE INVENTION

(5) With reference to FIGS. 1 and 2, the method of the invention is implemented by means of a robotized arm 1 comprising a plurality of segments 2, including a working end, connected in pairs by at least one hinge 3 provided with a motor connected to a control unit 4 of the robotized arm 1. The control unit 4 is arranged to be able to control the motors of the robotized arm 1. Such a robotized system is known per se and will not be detailed further here.

(6) The task to be performed is in this case the polishing of a part P represented here by a sphere, using a polishing tool 5 moved according to a trajectory t while applying force F.

(7) The programming of the robotized arm is carried out by the execution of a computer program for configuring the robotized arm 1: this program is executed either directly by the control unit 4 or by a computer connected to the control unit 4.

(8) The programming of the robotized arm 1, in order to perform the task in question, comprises the phases of: programming the trajectory t of the working end corresponding to the task to be performed, programming the force F to be applied by the working end along at least a part of the trajectory t (along the trajectory or at passage points defining the trajectory), checking the programming of the trajectory t and of the force F.

(9) The working end can advantageously be equipped with the tool 5 during the two programming phases and the checking phase. Furthermore, the part P to be polished can advantageously be present.

(10) The phase for programming the trajectory t can advantageously be performed by the operator M causing the working end of the robotized arm 1 to move along the desired trajectory t, or on passage points, and by storing positions of the working end.

(11) The positions can be stored upon command by the operator M or continuously over the entire trajectory t.

(12) In the first case, the user stops the working end of the robotized arm 1 and commands the storing of the position by acting on an input interface, such as a remote control or a button on the robot, connected to the control unit 4 (or, as a variant, to an external control apparatus such as a computer).

(13) In the second case, the operator launches on the control unit 4 a session for programming the trajectory (for example, by pressing a predetermined button on a remote control) and the control unit 4 continuously records the successive positions of the working end until the operator announces the end of the session (for example, by pressing a predetermined button on a remote control).

(14) According to the invention, the phase for programming the force F is performed by the control unit 4 causing the working end of the robotized arm 1 to move along the programmed trajectory t, or on the uniquely learned passage points. During this phase, the motorization of the robotized arm 1 is controlled to maintain the working end in position on the trajectory t without a force setting.

(15) In at least one position during the movement, the operator M exerts on the working end a force f which is opposed to the force F to be applied during the task. The opposed force f is applied by the hand of the operator M which is in direct contact with the working end of the robotized arm 1.

(16) The opposed force f has an intensity proportional to the force F to be applied during the task (F=−α.f). In the present case, the force f is of an intensity equal to the force F.

(17) The force F is then determined from the resistant force exerted by the robotized arm 1 to maintain the working end on the trajectory t, or on the passage points.

(18) The resistant force is determined by the control unit 4 from the electrical supply current of the motorization of the robotized arm 1 needed to maintain the working end at the position. As a variant, the resistant force is determined by the control unit from a measurement by a force sensor arranged on the working end.

(19) The force F thus determined is stored in association with the position of the working end during the exertion of the opposed force f.

(20) The determination of the force to be applied and its storing can be carried out: either continuously along at least a part of the trajectory, or be activated by a command by the operator M (the operator M operates, for example, a button of a remote control when he/she arrives at the position in question and when he/she exerts the opposed force).

(21) The final step, which is recommended but optional, for checking the program consists here in commanding the robotized arm 1 to move the working end along the trajectory t while the operator M is in contact with the working end such that the operator feels the force applied by the robotized arm 1.

(22) In the variant of FIG. 3, the opposed force f is exerted by means of a mechanical link 6, such as a cable or a rod fitted on a ball joint, having one end connected to the working end and an opposite end held by the operator M. This method of exerting the opposed force f is advantageous since the direction of the tension of the mechanical link provides for visualizing the direction of the opposed force f.

(23) In another variant, the opposed force f is exerted by means of an elastic element connected to the working end. The elastic element can be a flexible elastic link or a rigid element connected to the working end by an elastic apparatus such as a dynamometer. This method of exerting the opposed force f is advantageous since, in addition to the direction of the tension of the link, it provides for visualizing the intensity of the opposed force f.

(24) Of course, the invention is not limited to the embodiments described but encompasses any variant entering the field of the invention as defined by the claims.

(25) In particular, although the invention is described in relation to a serial type robotized arm, the invention can be applied to all robot and machine types that can be force-controlled. The invention thus remains applicable to the case of parallel robots, i.e. in the case of more than two segments connected to one another.

(26) The operator can apply the opposed force by means of a handgrip fixed on the working end of the robotized arm 1. The resistant force is then preferably determined from a measurement by a force sensor arranged on the handgrip of the working end of the robotized arm 1.