Patent Application
20220379463
The present invention relates to a robot arm having a robot controller controlling a plurality of robot joints of the robot arm connecting a robot base and a robot tool flange, where the robot joints of the robot arm can be manually manipulated by a user in a so call free-drive mode.
Robot arms comprising a plurality of robot joints and links where motors or actuators can move part of the robot arm in relation to each other are known in the field of robotics. Typically, the robot arm comprises a robot base which serves as a mounting base for the robot arm; and a robot tool flange where to various tools can be attached. A robot controller is configured to control the robot joints in order to move the robot tool flange in relation to the base. For instance, in order to instruct the robot arm to carry out a number of working instructions. The robot joints may be rotational robot joints configured to rotate parts of the robot arm in relation to each other, prismatic joints configured to translate parts of the robot arm in relation to each other and/or any other kind of robot joints configured to move parts of the robot arm in relation to each other.
Typically, the robot controller is configured to control the robot joints based on a dynamic model of the robot arm, where the dynamic model defines a relationship between the forces acting on the robot arm and the resulting accelerations of the robot arm. Often, the dynamic model comprises a kinematic model of the robot arm, knowledge about inertia of the robot arm and other parameters influencing the movements of the robot arm. The kinematic model defines a relationship between the different parts of the robot arm and may comprise information of the robot arm such as, length, size of the joints and links and can for instance be described by Denavit-Hartenberg parameters or like. The dynamic model makes it possible for the controller to determine which torques and/or forces the joint motors or actuators shall provide in order to move the robot joints for instance at specified velocity, acceleration or in order to hold the robot arm in a static posture.
Robot arms need to be programmed by a user or a robot integrator which defines various instructions for the robot arm, such as predefined moving patterns and working instructions such as gripping, waiting, releasing, screwing instructions. The instruction can be based on various sensors or input signals which typically provide a triggering signal used to stop or start at a given instruction. The triggering signals can be provided by various indicators, such as safety curtains, vision systems, position indicators, etc.
Typically, it is possible to attach various end effectors to the robot tool flange or other parts of the robot arm, such as grippers, vacuum grippers, magnetic grippers, screwing machines, welding equipment, dispensing systems, visual systems, etc. When providing such end effector, it is necessary to provide an estimation of the payload information that such end effector provides to the robot arm. Typically, the user manually enters the payload information into the kinematic model where after the controller can take the payload information into account when controlling the robot. Typically, the payload information comprises information in relation to the weight and pose of the object, where pose of the object relates to the position and orientation of the object in relation to the robot arm e.g. the robot tool flange. The pose can for instance be indicated as the position of the center of mass of the object in relation to the robot tool flange. Many users have difficulties setting the correct payload information or ignore/forget to set it at all.
Many robot arms can be set into a so call free-drive or Zero G mode of operation, where a user manually can change the posture of the robot arm by pushing or pulling the robot arm and where the robot controller is configured to hold the robot arm in a posture when a user is not pushing or pulling the robot arm. In the free-drive mode of operation, the robot controller is configured to control the motor torque provided by the motor of the robot joints based on joint encoders and a dynamic model of the robot. Typically, the joint encoders provide a signal indicating the joint angle of each of the joints and the controller can based on the joint angles and a dynamic model of the robot calculate the force/torque needed to maintain the robot arm in a posture. When a user pushes or pulls the robot arm a change in joint angle can be registered and the robot controller is configured to allow movement of the robot. In some embodiment the controller can be configured to apply a motor torque to the joint motors when a change in joint angle is registered for instance in order to assist movement of the robot arm, apply some resistance that the user need to overcome in order to change the posture of the robot arm. Some robot arms comprise torque sensors configured to indicate the torque applied to each of the robot joints and the robot controller can be configured to control the motor torques applied to the robot joints based on the torques applied to the robot joint.
The known free-drive modes require manipulation of the individual robot joints in order for the robot arm to change posture which in some situations may be difficult, for instance at work stations where a part of the robot arm is put behind a shield preventing a user from rotating some of the robot joints.
U.S. Pat. No. 6,212,433B1 discloses a direct teaching apparatus which allows an operator to perform the direct teaching of a robot in safety. The apparatus includes a force detector and a teaching tool. The tool includes a working tool or handle fixed to the first detector and held by the operator to lead the robot. It also includes a device for computing the position or speed directive based on the force detector data and a motion model. It further includes a device for computing the generation torque of a motor for driving a robot depending on the position or speed directive and a controller to control the generated torque. The user needs to configure an provide the teaching apparatus to the robot system which complicates the usage of the teaching apparatus and further the user can only move the robot arm from the teaching apparatus.
U.S. 2012/130541 discloses a method and apparatus for the direct and safe teaching of a robot. The apparatus consists of a plurality of tactile sensors and electronic circuitry encapsulated in a compact enclosure, and a handle protruding from the enclosure. The handle provides an easy means for an operator to apply an external force and to act on the sensors that generate electronic signals to the robot controller. The user needs to configure an provide the handle apparatus to the robot system which complicates the usage of the handle apparatus as the axis of the handle apparatus need to be linked to specified joints and further the user can only move the robot arm using the handle apparatus.
Safe operation of the robot arm in free-drive mode requires correct specification of e.g. weight of the payload to the robot controller, to avoid hazardous situations upon activation of the free-drive mode. Further, it is a known problem that sensors used e.g. in determination of the weight of payload drifts over time leading to a wrong payload weight calculation made by the robot controller and potential hazardous situations. Hence hazardous situations may occur if e.g. the force needed to maintain the robot arm in a given posture is based on a wrong calculation of payload weight.
The object of the present invention is to address the above described limitations with the prior art or other problems of the prior art. This is achieved by a robot controller, a robot and a method according to a first aspect, a second and/or a third aspect of the present invention, where various embodiments of the first aspect, the second aspect and the third aspect of the invention the following paragraphs.
This is achieved by a robot controller, robot arm and method according to a first aspect of the present invention, where a robot controller for controlling a robot arm is switchable from a current mode of operation into a free-drive mode of operation where the robot controller in the free-drive mode of operation is configured to:
Defining an activation sequence period of time (also sometimes referred to as time window) within which defined joint sensor parameter value is compared to a threshold is advantageous in that it has the effect, that joint sensor parameters not intended to activate free-drive is sorted out. Hereby is ensured that a collision or random bump into the robot arm, its tool or payload does not activate the free-drive mode. Further, this is advantageous in that it has the effect that entering the free-drive mode is not possible if the measured value exceeded the related threshold value within the defined time period. By establishing this activation sequence period of time is established an intermediate free-drive mode test period of time which is advantageous in that it has the effect that unexpected movement of the robot arm due to e.g. wrong input of payload weight to the robot controller is prevented or at least reduced by the free-drive activation joint sensor parameter threshold values. The activation joint sensor parameter threshold value can be any kind of value suitable for defining a threshold, such as maximum values, minimum values, specific values, ranges of values, limits of values etc. That a joint sensor parameter does not exceeds the joint sensor parameter threshold value means that the value of the joint sensor parameter is within or does not violate an allowed value as defined by the threshold value. For instance, in case of a maximum threshold value the joint sensor parameter does not exceed the joint sensor parameter threshold value if the value of the joint sensor parameter is smaller than the joint sensor parameter threshold value. Also, in case of a minimum threshold value the joint sensor parameter does not exceed the joint sensor parameter threshold value if the value of the joint sensor parameter is larger than the joint sensor parameter threshold value. Also, in case of a range of threshold values the joint sensor parameter does not exceed the joint sensor parameter threshold value if the value of the joint sensor parameter is larger than a lower joint sensor parameter threshold value and smaller than an upper joint sensor parameter threshold value. Accordingly, when free-drive mode is activated by a user within range of the robot arm, wrong payload weight will not cause the robot arm to move in an unpredicted direction and thereby possibly create a hazardous situation for the user. Movement of the robot arm will be stopped if a monitored joint sensor parameter value exceeds a related threshold value.
After the activation sequence the controller can enter free drive mode of operation where less restrict safety requirements can be allowed, which results in a more user-friendly free drive mode of operation.
According to an embodiment of the invention, the robot controller is configured to stay in the current mode of operation if the value of the at least one joint sensor parameter does exceed the at least one free-drive activation joint sensor parameter threshold value within the predetermined activation sequence period of time. This result in the effect that the robot does not enter a safety stop in case the free drive mode of operation is not activated. This is time saving for the user, as the robot arm does not need to be restarted and/or reactivated due to safety stops. In an embodiment, the user is informed of which joint sensor parameter(s) preventing the entering of the robot arm into the free-drive mode of operation via a user interface. This has the effect, that the user fast and efficiently can remove the obstacle and then subsequently try activating the free-drive mode of operation again.
According to an embodiment of the invention, the predetermined activation sequence period of time is at least any one of the following periods of time: 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second and ¼ second. This is advantageous in that it has the effect, that the robot arm will enter the free-drive mode activation sequence period for at least a predetermined period of time of at least 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second or ¼ second and not enter free-drive mode directly risking hazardous situations due to e.g. a wrong payload weight. Further it can be ensured that the at least one joint sensor parameter does not exceed the at least one free-drive activation joint sensor parameter threshold value for at least a predefined period of time providing a safer activation of free drive mode of operation.
According to an embodiment of the invention, the predetermined activation sequence period of time is at most any one of the following periods of time: 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second and ¼ second. This is advantageous in that it has the effect, that the robot arm will only enter the free-drive mode activation sequence period for at most a predetermined period of time of at most 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second or ¼ second, hereby it is avoided that the robot arm stay in the activation sequence for an unknown period of time which can be annoying to a user. This can be avoided by configuring the robot controller to exit the activation sequence period when the maximum period of time has expired. For instance, if during the activation sequence period it has not been possible to determine if the at least one joint sensor parameter does not exceed the at least one free-drive activation joint sensor parameter threshold value, the robot controller can be configured not to the enter free drive mode of operation.
Consequently, the activation sequence period of time can be executed in any one of the following periods of time after the free drive activation signal have been received: 0¼ second; 0½ second; 0-1 second; 0-2 seconds; 0-3 seconds; 0-5 second; ¼-½ second; ¼-1 second; ¼-2 seconds; ¼-3 seconds; ¼-5 seconds; ½-1 second; ½-2 seconds; ½-3 seconds; ½-5 seconds; 1-2 seconds; 1-3 seconds; 1-5 seconds; 2-3 seconds; 2-5 seconds; 3-5 seconds; or any one of the following fixed period of time: ¼ second; ½ second; 1 second; 2 seconds, 3 seconds or 5 seconds. This makes it possible to provide an activation sequence period which ensures that proper verification that the robot arm can be switch into free-drive mode of operations and at the same time prevents annoying the user too much with waiting time.
According to an embodiment of the invention, the robot controller is configured for initiating the free-drive mode activation sequence upon receiving the free-drive activation signal for an activation period of time. This is advantageous in that it has the effect, that only intentional established free-drive signals are used to enter the activation sequence. For instance, the robot controller can be configured to enter the activation sequence upon continuously receiving the free-drive activation signal for the activation period of time. An alternative way of identifying an intentional free-drive activation signal is if the activation free-drive activation signal is received by the robot controller in a predetermined sequence or pattern e.g. of discrete signals.
According to an embodiment of the invention, the predetermined activation period of time is at least any one of the following periods of time: 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second and ¼ second. This is advantageous in that it has the effect, that the robot arm will enter the free-drive mode activation sequence when the robot controller has received the free-drive activation signal for at least a predetermined period of time of at least 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second or ¼ second. This makes it possible to provide a more robust registration of an actual user's intention to activate the free-drive mode activation sequence, as eventual free-drive activation signals generated unintentionally can be sorted out by ensuring the free-drive activation signal is received during the predetermined activation period of time.
According to an embodiment of the invention, the predetermined activation period of time is at most any one of the following periods of time: 5 seconds, 3 seconds, 2 seconds, 1 second, ½ second and ¼ second. This makes it possible to provide a user-friendly registration of an user's intention to activate the free-drive mode activation sequence, as the waiting time for the user generating the free-drive activation signal can be specified to a specific period of time and the user will thus know how long time is needed in order to enter free-drive mode of operation.
Consequently, the activation period of time can be executed in any one of the following periods of time after the initial receipt of the free drive activation: 0¼ second; 0½ second; 0-1 second; 0-2 seconds; 0-3 seconds; 0-5 seconds; ¼-½ second; ¼-1 second; ¼-2 seconds; ¼-3 seconds; ¼-5 seconds; ½-1 second; ½-2 seconds; ½-3 seconds; ½-5 seconds; 1-2 seconds; 1-3 seconds; 1-5 seconds; 2-3 seconds; 2-5 seconds; 3-5 seconds; or any one of the following fixed period of time: ¼ second; ½ second; 1 second; 2 seconds, 3 seconds or 5 seconds.
According to an embodiment of the invention, the robot controller is configured for maintaining the robot arm in the free-drive mode of operation for at least a predetermined free-drive period of time. The predetermined free-drive period of time is a period of time in which the robot controller maintains the robot arm in the free-drive mode of operation after the robot controller have switch to the free-drive mode of operation. This ensures that the user after activation of the free-drive mode of operation has some time to initiate movement of the robot arm.
According to an embodiment of the invention, the robot controller is furthermore configured for starting a predetermined restart free-drive period of time when the robot arm is in a static posture. The predetermined restart free-drive period of time is a period of time starting when the robot arm has been arranged in the static posture, for instance when a user has stopped moving the robot arm and thus does not apply a force or a torque to the robot arm. This ensures that the user after having move the robot arm in the free-drive mode of operation has some time to re-start movement of the robot arm, for instance in order to allow the user to change grip of the robot arm or in order to store a waypoint. Additionally, or alternatively the static posture can be initiated when an external force or torque impact on the robot arm terminates.
According to an embodiment of the invention, the robot controller is configured to leave the free-drive mode of operation when the robot arm has been kept in a static posture within the predetermined free-drive period of time or within the predetermined restart free-drive period of time. The predetermined free-drive period of time and the predetermined restart free-drive period of time can be the same and upon expiry hereof, the robot controller leaves the free-drive mode of operation.
Hence in practice, the period of time the robot arm is maintained in the free-drive mode is reset when the user starts moving the joints of the robot arm by applying force/torque. After a period of time (restart free-drive period) starting when the user stops applying a force/torque, the mode of operation will switch to another mode of operation such a teach mode, run mode, stop mode, etc. This is advantageous in that it has the effect, that the user can maintain the robot arm in free-drive mode of operation for as long time as needed by applying a force to the robot arm before expiry of the restart period of time. This allows the user to change his/her grip of the robot arm which in some situation can be desired by the user changing posture of the robot arm in free-drive mode of operation. Further, the user can make the robot controller leave the free-drive mode of operation simply by not applying a force/torque for a period of time defined by the restart period of time. Further, at least in relation to safety (person and mechanic), this is advantageous in that the robot is not maintained in the free-drive mode of operation where drifting of sensors over time otherwise could lead to change of posture of the robot. Such drifting could ultimately result in a collision of payload or robot tool with floor or other objects within range of the robot arm. Furthermore maintaining the robot arm in free-drive mode of operation after a user have left the robot arm may also lead to hazards situations in case another user approaches the robot arm unaware of the fact that the robot arm is in free-drive mode of operation, as an user expects a stationary robot arm to be in a stop/brake mode of operation where the robot arm cannot move.
According to an embodiment of the invention the predetermined free-drive period of time and/or the predetermined restart free-drive period of time is at least 2 seconds allowing a user to change her/his grip of the robot arm and initiate/re-initiate movement of the robot arm before the free-drive period of time and/or the predetermined restart free-drive period expires. However, it is to be understood that the predetermined free-drive period of time and/or the predetermined restart free-drive period of time alternatively can be at least any one of the following periods of time of 10 second, 5 seconds, 3 seconds. Periods of 5-10 seconds will allow the user to perform additional tasks such as registering of waypoints, moving external objects, adjusting tools mounted to the robot arm before the robot arm exits the free-drive mode of operation.
According to an embodiment of the invention the predetermined free-drive period of time and/or the predetermined restart free-drive period of time is at most 5 seconds preventing that a user unintentionally can move the robot arm after having left the robot arm alone for a period of 5 seconds. This reduces the risk of hazardous situations as describe above. However, it is to be understood that the predetermined free-drive period of time and/or the predetermined restart free-drive period of time alternatively can be at most any one of the following periods of time of 10 seconds, 15 seconds, 20 seconds, 30 seconds. Periods of 5-30 seconds will allow the user to perform additional tasks such as registering of waypoints, moving external objects, adjusting tools mounted to the robot arm before the robot arm exits the free-drive mode of operation, while the risk of unintentional movements of the robot arm are still kept at an acceptable level, as a user seldom forgets that the robot arm is in free-drive mode of operation within periods of these times. Further, the risk that another user unintentionally moves the robot arm within this period are also acceptable, as the probability that the robot arm is completely left alone in free-drive mode of operation within a period of 5-30 seconds are very low.
According to an embodiment of the invention, the robot controller is configured to leave the free-drive mode of operation when no external force has been indicated by the at least one joint sensor within the predetermined free-drive period of time or within the predetermined restart free-drive period of time.
According to an embodiment of the invention, the robot controller is configured for leaving the free-drive mode of operation upon receiving a free-drive deactivation signal. The free-drive deactivation signal can for instance be established by a user via a user interface. This is advantageous in that it has the effect, that the user at any time during operation of the robot arm is able to return to a different mode of operation than the free-drive mode of operation. Typically, the modes of operation are referred to as normal operation mode, run mode, remote mode and teach mode also referred to as Free-drive mode of operation. The robot is in normal operation mode e.g. when it is standing still e.g. to be programmed or is in a waiting position. The robot is in run mode e.g. when the robot controller is executing program code i.e. when the robot is in operation. The robot is in teach mode which is also referred to as free-drive mode when a user is able to change posture of the robot by applying a force to part of the robot. Typically, the robot controller enters free-drive mode from normal mode of operation and returns to normal mode of operation from free-drive mode of operation.
Additionally, or alternatively the free-drive deactivation signal can be established based on at least one joint sensor parameter for instance by comparing the value of the at least one joint sensor parameter to at least one free-drive operation joint sensor parameter threshold value. The at least one free-drive operation joint sensor parameter threshold value can be any value defining a limit of a corresponding joint sensor parameter while the robot controller is in free-drive mode of operation. This makes it possible to monitor some joint sensor parameters during the free-drive mode of operation and leave the free-drive mode of operation if these joint sensor parameters exceed certain threshold values. For instance, this makes it possible to monitor the same joint sensor parameters as monitored in the free-drive activation sequence but with different threshold values. In other words, a free-drive activation joint sensor parameter threshold value and free-drive operation joint sensor parameter threshold value may relate to the same joint sensor parameter but have different values. Consequently, it is possible to provide different safety settings when activating the free-drive mode of operation and when being in free-drive mode of operation.
According to an embodiment of the invention, the robot controller is configured for presenting on an interface device the remainder of at least one of the list comprising: activation period of time, activation sequence period of time, free-drive period of time and restart free-drive period of time. This is advantageous in that it has the effect that the user is able to visually see how long time there is left of the activation period of time, the activation sequence period of time, the free-drive period of time and/or the restart free-drive period of time. Such illustration could be provided to the user as any type of 2D or 3D diagram such as curve, column, circle, etc. Also, such diagram illustrated on the user interface could indicate the time passed of a given period of time. A further effect is that the user then is able to see when to apply a force to the robot to stay in Free-drive mode. Further, the robot controller may via the interface device present to the user root cause to events leading to involuntary leaving the free-drive mode as well as guidance on how to (e.g. which joints to move how) get the robot arm back in a starting position, posture or desired location/orientation in space.
According to an embodiment of the invention the at least one joint sensor parameters is selected from the list comprising speed, acceleration, torque, motor torque, force and position. Speed can for instance indicate speed of a part of the robot arm such as speed of the tool flange in relation to the robot base, angular speed of the robot joints. Acceleration can for instance indicate the acceleration of a part of the robot arm such as acceleration of the tool flange in relation to the robot base, angular acceleration of the robot joints. Position can for instance indicate the position of a part of the robot arm such as position of the tool flange in relation to the robot base, the angular position of the robot joints. Torque and/or force can indicate the torque and/or force applied to a part of the robot arm and/or the torque/force applied by a part of the robot arm for instance to an external object. Motor torque can for instance indicate the torque provided by the joint motors and can for instance be indicate as joint motor current.
According to an embodiment of the invention, a free-drive activation joint sensor parameter threshold relating to a first monitored joint sensor parameter is different from the free-drive activation joint sensor parameter threshold value relating to a second monitored joint sensor parameter. This is advantageous in that it has the effect that e.g. a threshold value related to moving the robot arm (e.g. meters per second) may have a value for acceleration and another for speed. Hence, the robot is allowed to increase speed for a given period of time defined by a first threshold value, whereas the robot arm is allowed to move with a constant speed for a period of time defined by a second threshold value different from the first threshold value. A more strict threshold value for acceleration compared to speed is advantageous in that it has the effect, that fast acceleration may lead to a collision between robot arm and user i.e. a user safety issue, whereas a slow movement of the payload e.g. towards the floor constituted a mechanical safety issue and which can be stopped by the user assisting the robot arm in lifting the payload.
According to an embodiment of the invention, the free-drive activation joint sensor parameter threshold value is defined as a virtual three-dimensional geometric shape surrounding a part of the robot arm. The virtual three-dimensional geometric shape can be any shape defining a boundary around a part of the robot arm, within which the part of the robot arm is allowed to move within a predefined period of time, such as the activation period of time and/or the activation sequence period of time. This is advantageous in that it has the effect, that the free-drive activation joint sensor parameter threshold is moving with the movement of a part of the robot arm and is initiated from the current position of the part of the robot arm. For instance, the virtual three-dimensional geometric shape can surround the tool flange and define a boundary wherein the tool flange is allowed to move during a predefined period of time. It is to be understood that the virtual three-dimensional geometric shape can have any shape for instance a sphere, an ellipsoid, a cube, a cuboid, a cylinder, a pyramid, a polyhedrons or any arbitrary three-dimensional shape. The part of the robot arm surrounded by the three-dimensional shape may in one embodiment be arranged at the center of the three-dimensional geometric shape as this allows the part of the robot arm to move symmetrical within the three-dimensional geometric shape; however, it is noted that the part of the robot arm can be arranged at any position within the three-dimensional shape. Note that the free-drive activation joint sensor parameter threshold value may be dynamic relative to other axis or positions moving with the movement of the robot arm.
According to an embodiment of the invention, the robot controller is configured for determining if the free-drive activation signal is established by a user by providing a robot feedback to the user upon determining the appearance of the free-drive activation signal and wherein the robot controller is configured to enter the free-drive mode of operation upon determining the appearance of a user confirmation signal in response to the robot feedback. The robot feedback can be provided as any signal perceptible by a user such as an audio signal, a visual signal, a haptic feedback, a predetermined posture of one or more joints, predetermined movements of one or more joints or combinations thereof. The visual feedback can e.g. be a light flashing or words or figures on the display of the graphic user interface. The audio signal can e.g. be a tone or voice speaking words such as what the user should do to activate the free-drive mode of operation. The user confirmation signal can be established by a user interacting with a user interface. This is advantageous in that it has the effect, that the robot controller only will enter free-drive mode in case the user has confirmed her/his intentions to do so. Consequently, the user will be aware that the robot arm is about to enter free-drive mode of operation. It is noted that the user confirmation signal can be provided in form of a physical signal, a logic signal, internally within the processor of the robot controller or combinations thereof.
According to an embodiment, the robot controller may be configured only to enter the free-drive mode of operation in case the user confirmation in response to the robot feedback is provided within at least one of the periods of time of: 10 seconds, 5 seconds, 3 seconds, 2 seconds and 1 second from the point in time where the robot feedback stops. This is advantageous in that it has the effect that the robot controller would not enter the free-drive mode of operation in lack of receiving the user confirmation signal within the predefined period of time. Thereby it can be avoided that the robot controller is continuously waiting for a user confirmation signal that will not be generated. Hence, the robot controller does not confuse a random generated free-drive signal upon expiry of this time period and thereby unexpectedly entering into freed-drive mode is avoided.
According to an embodiment, the robot controller can be configured to provide the robot feedback to the user and determining the appearance of the user confirmation in response to the robot feedback as a part of the activation sequence, and if the user confirmation is received within the predetermined activation sequence period of time the robot controller will enter the free-drive mode of operation.
According to an embodiment the user confirmation signal is established by a user activating at least one joint sensor of at least one of the robot joints. For instance, by the user performing at least one of the following: providing a force/torque to the robot arm or a series of forces/torques to a part of the robot arm, moving at least one of the robot joints, twisting a part of the robot arm, arranging the robot arm in posture or a series of postures. For instance, the robot controller can be configured to establish the confirmation signal upon determining the appearance of a predetermined force provided by a user in response to the robot feedback. The predetermined force (could also be referred to as a gesture) detected by the robot controller may be detected by a change in one or more motor joint parameter values. The robot controller can determine that a predetermined force is from a user if the force is applied in a predetermined direction, patter, sequence or the like. Thereby, if such predetermined force is following the robot feedback, the robot controller knows that the free-drive signal first received is not established unintentionally and therefore safely can enter free-drive mode. This is advantageous in that it has the effect, that no unexpected movement of the robot is initiated by the robot controller during the activation period of time of the free-drive mode even though the payload weight is not correctly registered by the robot controller. This makes it possible for the user to establish the confirmation signal directly at the robot arm and the user can thus enter free-drive mode of operation without the need to use a robot teach pendent. This is useful in situations where the user wants to use both hands for guiding the robot in free-drive mode of operation and in situations where the robot arm is remotely positioned from the robot teach pendent.
According to an embodiment the free-drive activation signal is established by a user activating at least one joint sensor of at least one of the robot joints. For instance, by the user performing at least one of the following: providing a force/torque to the robot arm or a series of forces/torques to a part of the robot arm, moving at least one of the robot joints, twisting a part of the robot arm, arranging the robot arm in posture or a series of postures. For instance, the robot controller can be configured to establish the free-drive activation signal upon determining the appearance of a predetermined force provided by a user to the robot arm. The predetermined force (could also be referred to as a gesture) detected by the robot controller may be detected by a change in one or more motor joint parameter values. The robot controller can determine that a predetermined force is from a user if the force is applied in a predetermined direction, patter, sequence or the like. This makes it possible for the user to establish the free-drive activation signal by interacting directly with the robot arm and thus enter free-drive mode of operation without the need to use a robot teach pendent. This is useful in situations where the user wants to use both hands for guiding the robot in free-drive mode of operation and in situations where the robot arm is remotely positioned from the robot teach pendent. It is noted that the user free-drive activation signal can be provided in form of a physical signal, a logic signal, internally within the processor of the robot controller or combinations thereof.
According to an embodiment of the invention, the free-drive activation signal is established by activating a force sensor of the robot arm, wherein the value of force measured upon the activation of the force sensor is above a predetermined force threshold value. Activating the free-drive mode by applying a force to the robot arm is advantageous in that it has the effect, that a user from any location relative to the robot arm can activate the free-drive mode. This includes also being apart from the teach pendent. Accordingly, as long as the user is in a position where she/he can apply a force to the robot arm, free-drive mode can be activated leading to increased flexibility in training of the robot arm. An additional advantage of being able to activate free-drive mode apart from the teach pendent, is that the user then has two hands free to move the robot arm. Two arms are advantages when a precision tool is to be positioned or joints is to be moved following a particular path in space.
In one embodiment, the force sensor is part of or mounted to the robot tool flange. Using the force sensor to establish the free-drive activation signal is advantageous in that it has the effect, that no additional hardware is needed beyond what is already used when the robot arm is in operation.
According to an embodiment of the invention, the predetermined force threshold value is a threshold value for a force in a predetermined orientation in space. This is advantageous in that it has the effect, that only a force above a predetermined magnitude applied in a predetermined orientation in space e.g. in a predetermined direction will have the potential to establish the free-drive activation signal. Hereby the risk of unintentionally activation of the free drive mode of operation is reduced.
According to an embodiment of the invention, the free-drive activation signal is established by activating a force and torque sensor of the robot arm, wherein the value of measured force is above a predetermined force value, and wherein the value of measured torque is below a predetermined torque threshold value. This is advantageous in that it has the effect, that force and torque are both measured leading to an improved sorting out of force signals not intended to activate the free-drive mode. Almost all forces applied to a force and torque sensor of a robot arm is accompanied by a torque. This is however not true if a person intentionally applies a force along one of the sensing axis of the force-torque sensor. In this situation, the force applied would be accompanied by only a very limited torque if any. Hence, a force applied by a person can be filtered from a force applied e.g. from a collision, random touch of the robot arm or tool, vibrations of the robot arm etc. by also evaluating the torque.
In one embodiment, the force sensor and torque sensor are provided as a combined force-torque sensor forming a part of or mounted to the robot tool flange. Using the force-torque sensor to establish the free-drive activation signal is advantageous in that it has the effect, that no additional hardware is needed beyond what is already used when the robot arm is in operation.
According to one embodiment, the joint sensor parameter is selected from the list comprising: speed, acceleration, torque, motor torque, motor current, force and position. This is advantageous in that it has the effect, that movement of the robot arm can be monitored and stopped if the value of one or more of these joint sensor parameters are outside a predetermined range defined by at least one upper or lower threshold value. It should be mentioned, that the joint sensor parameters may also include values derived from actual measured values i.e. values which cannot be measure directly by a sensor but can be established by measured values.
Moreover, the invention relates to a robot arm comprising a plurality of robot joints connecting a robot base and a robot tool flange; where each of the robot joints comprises:
The robot arm comprises at least one robot controller configured to control the robot joints by controlling the motor torque provided by the joint motors based on the sensor signal and the robot controller is further configured as described in any one of paragraphs [0010]-[0045] and or as illustrated in the figures and the corresponding description of the figures.
Moreover, the invention relates to a method of activating free-drive mode of operation of a robot arm, wherein the free-drive mode of operation comprises the steps of:
This provides the same effects and advantages as described previously (e.g. in paragraphs [0012]-[0013]) and makes it possible for the user of a robot arm independent of her/his location relative to the robot arm or interface device is able to activate the free-derive mode of operation in a safe way as the robot arm only are switched into free-drive mode of operation if during the activation sequence period are completed.
According to an embodiment the step of starting the free-drive activation sequence is initiated upon receiving the free-drive activation signal for a predetermined activation period of time. This provides the same effects and advantages as described previously (e.g. in paragraphs [0018]-[0021]) and makes it possible to ensure that the received free-drive activation signal is intentionally established by a user.
According to embodiments:
According to embodiments:
According to an embodiment the step of establishing the free-drive activation signal comprises a step of by a user applying a force at a part of the robot arm. Also, in an embodiment the step of applying a force at a part of the robot arm comprises applying the force in a predetermined orientation in space and at a predetermine position at the robot arm. Also, in an embodiment the step of applying a force at a part of the robot arm comprises applying the force to a force-torque sensor provided at the robot arm; and wherein the free-drive activation signal is established if a force obtained by the force-torque sensor is above a predetermined force value and a torque obtained by the force-torque sensor is below a predetermined torque value. This provides the same effects and advantages as described previously (e.g. in paragraphs [0039]-[0045]) and makes it possible for a user to enter the free-drive mode of operation by interacting (e.g. touching. pulling, pushing, lifting etc.) with a part of the robot arm and unintentional free-drive activation signals can be minimized. The predetermined period of time of receiving the free-drive activation signal is wither a continuous period or the sum of two or more discrete time periods of the signal has been received. The unintentional forces are sorted out and thereby are not establishing the free-drive activation signal. This is because a user can apply the force substantially in one direction without also applying a torque. Therefore, if the torque measured is low, while the force measured is higher the robot controller can be configured to interpret this force as a force intentionally applied by a user to activate free-drive mode of operation, as the low torque indicates that a user presses directly towards the force sensor.
The above described limitations with the prior art or other problems of the prior art are also address by a robot controller, robot arm and method according to a second aspect of the present invention.
According to the second aspect, the invention relates to a robot controller for controlling a robot arm is switchable from a current mode of operation into a free-drive mode of operation where the robot controller in the free-drive mode of operation is configured to:
According to an embodiment of the second aspect of the invention, the robot controller is configured to:
The predetermined restart free-drive period of time is a period of time which is started if the value of at least one joint sensor parameter exceeds at least one maintain free-drive joint sensor parameter threshold value. The restart free-drive period of time can be started when the joint sensor parameter exceeds the maintain free-drive parameter, consequently the restart free-drive period of time will be started when a user starts to manipulate the robot arm. In another embodiment the restart free-drive period of time can start when the value of at least one joint sensor parameter does not exceed the at least one maintain free-drive joint sensor parameter threshold value after the value of the at least one joint sensor parameter has exceeded the at least one maintain free-drive joint sensor parameter threshold value. Consequently, the restart free-drive period of time can be started when a user has stopped manipulating the robot arm for instance when the robot arm has been arranged in the static posture, for instance when a user has stopped moving the robot arm and thus does not apply a force or a torque to the robot arm. This ensures that the user after having move the robot arm in the free-drive mode of operation has some time to re-start movement of the robot arm, for instance in order to allow the user to change grip of the robot arm.
According to an embodiment of the second aspect of the invention, the robot controller is configured to leave the free-drive mode of operation when no external force has been indicated by the at least one joint sensor within the predetermined free-drive period of time or within the predetermined restart free-drive period of time.
According to an embodiment of the second aspect of the invention, the maintain free-drive period of time and/or the restart free-drive period of time is at least 2 seconds allowing a user to change her/his grip of the robot arm and initiate/re-initiate movement of the robot arm before the maintain free-drive period of time and/or the restart free-drive period expires. However, it is to be understood that the maintain free-drive period of time and/or the restart free-drive period of time alternatively can be at least any one of the following periods of time of 10 second, 5 seconds, 3 seconds. Periods of 5-10 seconds will allow the user to perform additional tasks such as registering of waypoints, moving external objects, adjusting tools mounted to the robot arm before the robot arm exits the free-drive mode of operation.
According to an embodiment of the second aspect of the invention, the maintain free-drive period of time and/or the restart free-drive period of time is at most 5 seconds preventing that a user unintentionally can move the robot arm after having left the robot arm alone for a period of 5 seconds. This reduces the risk of hazardous situations as describe above. However, it is to be understood that the maintain free-drive period of time and/or the restart free-drive period of time alternatively can be at most any one of the following periods of time of 10 seconds, 15 seconds, 20 seconds, 30 seconds. Periods of 5-30 seconds will allow the user to perform additional tasks such as registering of waypoints, moving external objects, adjusting tools mounted to the robot arm before the robot arm exits the free-drive mode of operation, while the risk of unintentional movements of the robot arm are still kept at an acceptable level, as a user seldom forgets that the robot arm is in free-drive mode of operation within periods of these times. Further, the risk that another user unintentionally moves the robot arm within this period are also acceptable, as the probability that the robot arm is completely left alone in free-drive mode of operation within a period of 5-30 seconds are very.
The maintain free-drive period of time and/or the restart free-drive period of time can be predetermined and provided as values stored in a memory of the robot controller, however in other embodiments a user can be allowed to modify the length of the free-drive period of time and/or the restart free-drive period of time for instance via a user interface. This allows a user to adjust the length of the maintain free-drive period of time and/or the restart free-drive period of time according to personal needs. In one embodiment a maximum time for the maintain free-drive period of time and/or the restart free-drive period of time can be predefined and the robot controller can be configured only to allow the user to adjust the length of the maintain free-drive period of time and/or the restart free-drive period of time to have the maximum defined length.
Hence in practice, the period of time the robot arm is maintained in the free-drive mode is reset when the user starts moving the joints of the robot arm by applying force/torque. After a period of time (restart free-drive period) starting when the user stops applying a force/torque, the mode of operation will switch to another mode of operation such a teach mode, run mode, stop mode, etc. This is advantageous in that it has the effect, that the user can maintain the robot arm in free-drive mode of operation for as long time as needed by applying a force to the robot arm before expiry of the restart period of time. This allows the user to change his/her grip of the robot arm which in some situation can be desired by the user changing posture of the robot arm in free-drive mode of operation Further, the user can make the robot controller leave the free-drive mode of operation simply by not applying a force/torque for a period of time defined by the restart free-drive period of time. Further, at least in relation to safety (person and mechanic), this is advantageous in that the robot is not maintained in the free-drive mode of operation where drifting of sensors over time otherwise could lead to change of posture of the robot. Such drifting could ultimately result in a collision of payload or robot tool with floor or other objects within range of the robot arm. Furthermore maintaining the robot arm in free-drive mode of operation after a user have left the robot arm may also lead to hazards situations in case another user approaches the robot arm unaware of the fact that the robot arm is in free-drive mode of operation, as an user expects a stationary robot arm to be in a stop/brake mode of operation where the robot arm cannot move.
According to an embodiment of the second aspect of the invention, the robot controller is configured to start at least one of the maintain free-drive period of time and the restart free-drive period of time upon expiry of the free-drive mode signal. This result in the fact that the robot arm can be kept in the free-drive mode of operation for the maintain free-drive period of time and/or the restart free-drive period of time after a user have stop establishing the free-drive mode signal. This is for instance useful in situations where the free-drive mode signal is established by a user pushing a free-drive bottom and the user it thus allowed to release the button while the robot arm is kept in free-drive mode of operation for a period of time after the button have been released.
According to an embodiment of the second aspect of the invention, the robot controller is configured to restart the maintain free-drive period of time or the restart free-drive period of time based on a restart free-drive mode signal established by a user. The free-drive restart signal can for instance be established by a user via a user interface. This is advantageous in that it has the effect, that the user at any time during the free-drive mode of operation manually can restart the maintain free-drive period of time or the restart free-drive period of time. This is for instance useful in situations where the user wants the robot arm to stay in free-drive mode of operation at a static posture for a longer/additional period of time e.g. in order to allow the user to perform other tasks.
According to an embodiment of the second aspect of the invention, the at least one joint sensor parameter is selected from the list comprising: acceleration of at least a part of the robot arm, speed of at least a part of the robot arm and position of at least a part of the robot arm and where the maintain free-drive joint sensor parameter threshold value is selected from the list comprising; a threshold acceleration of at least a part of the robot arm, a threshold speed of at least a part of the robot arm and a threshold position of at least a part of the robot arm. Acceleration, speed and position joint sensor parameter relates to the movements of the robot arm and can thus be used to register if a part of the robot arm have been moved and thus should be kept in free-drive mode of operation. For instance, the joint sensor parameter can indicate the acceleration of the robot arm and a corresponding joint sensor parameter threshold value can indicate a maximum acceleration and the robot controller can be configured to leave the free-drive mode of operation if the acceleration of the robot arm has not exceeded the maximum acceleration for the maintain free-drive period of time and/or the restart free-drive period of time. Also, the joint sensor parameter can indicate the speed of the robot arm and a corresponding joint sensor parameter threshold value can indicate a maximum speed and the robot controller can be configured to leave the free-drive mode of operation if the speed of the robot arm has not exceeded the maximum speed for the maintain free-drive period of time and/or the restart free-drive period of time. Also, the joint sensor parameter can indicate the position of the robot arm and a corresponding joint sensor parameter threshold value can indicate a position range and the robot controller can be configured to leave the free-drive mode of operation if the position of the robot arm has been inside the position range for the maintain free-drive period of time and/or the restart free-drive period of time.
According to an embodiment of the second aspect of the invention, the at least one joint sensor parameter is selected from the list comprising: force applied to at least a part of the robot arm and torque applied to at least part of the robot arm and where the maintain free-drive joint sensor parameter threshold value is selected from the list comprising; a threshold force applied to at least a part of the robot arm and a threshold torque applied to at least part of the robot arm. Force and/or torque applied to the robot arm can be used to register if a user in free-drive mode of operation tries to change the posture of the robot arm. Consequently if the force and/or torque applied to the robot arm exceeds a corresponding threshold force and/or a corresponding threshold torque for the maintain free-drive period of time and/or the restart free-drive period of time the robot controller can be configured to maintain the robot arm in free-drive mode of operation as this indicates that a user is changing the posture of the robot arm. The threshold force and/or the threshold torque can for instance be obtained based on gravity's influence of the robot arm.
According to an embodiment of the second aspect of the invention, the robot controller is configured for leaving the free-drive mode of operation upon receiving a free-drive deactivation signal. The free-drive deactivation signal can for instance be established by a user via a user interface. This is advantageous in that it has the effect that the user at any time during operation of the robot arm is able to return to a different mode of operation than the free-drive mode of operation.
According to an embodiment of the second aspect of the invention, the robot controller is configured to provide robot feedback to the user based on at least one of the remainders of the maintain free-drive period of time and the remainder of the restart free-drive period of time. This is advantageous in that it has the effect that the robot controller can inform the user how long time there is left of the maintain free-drive period of time and/or the restart free-drive period of time. Consequently, the user would be able to reset the maintain free-drive period of time and/or the restart free-drive period of time and thereby ensure the that robot arm is maintained in free-drive mode of operation. The robot feedback can be provided as any signal perceptible by a user such as an audio signal, a visual signal, a haptic feedback, a predetermined posture of one or more joints, predetermined movements of one or more joints or combinations thereof. The audio signal can e.g. be a tone, or a set of tones indicating a count down to the expiry of the maintain free-drive period of timer and/or the restart free-drive period of time, or voice speaking words such as what the user should do to reset the maintain free-drive period of timer and/or the restart free-drive period of time. The visual feedback can e.g. be a light flashing or illustrations on the display of the graphic user interface indicating the remainder of the maintain free-drive period and/or the restart free-drive period. Such illustration could be provided to the user as any type of 2D or 3D diagram such as curve, column, circle, etc. Also, such diagram illustrated on the user interface could indicate the time passed of a given period of time. A further effect is that the user then is able to see when to apply a force to the robot to stay in Free-drive mode. Further, the robot controller may via the interface device present to the user root cause to events leading to involuntary leaving the free-drive mode as well as guidance on how to (e.g. which joints to move how) get the robot arm back in a starting position, posture or desired location/orientation in space.
Moreover, according to the second aspect, the invention relates to a robot arm comprising a plurality of robot joints connecting a robot base and a robot tool flange; each of the robot joints comprises:
The robot arm comprises at least one robot controller configured to control the robot joints by controlling the motor torque provided by the joint motors based on the sensor signal and the robot controller is further configured as described in any one of paragraphs [0053][0055]-[0067] and or as illustrated in the figures and the corresponding description of the figures.
Moreover, according to the second aspect, the invention relates to a method of operating a robot arm in free-drive mode of operation, wherein the robot arm by a robot controller has been switched into the free-drive mode of operation upon the robot controller receiving a free-drive activating signal established by a user, wherein the free-drive mode of operation comprises the steps of:
In an embodiment of the method according to the second aspect of the invention, the method comprises the steps of:
In an embodiment of the method according to the second aspect of the invention, the method comprises the step of:
In an embodiment of the method according to the second aspect of the invention, the method comprises the steps of:
In an embodiment of the method according to the second aspect of the invention, the method comprises the step of:
In an embodiment of the method according to the second aspect of the invention, the method comprises the step of:
The above described limitations with the prior art or other problems of the prior art are also address by a robot controller, robot arm and method according to a third aspect of the present invention.
According to the third aspect, the invention relates to a robot controller for controlling a robot arm, the robot controller is switchable from a current mode of operation into a free-drive mode of operation, where the robot controller in the free-drive mode of operation is configured to:
The virtual three-dimensional geometric shape can be any shape defining a boundary around a part of the robot arm, within which the part of the robot arm is allowed to move within the free-drive safety period of time. This is advantageous in that it has the effect that apart of the robot arm in the free-drive mode of operation within the free-drive safety period only can move within the virtual three-dimensional geometric shape. Situations where the part of the robot arm moves in an unsafe manner can hereby be avoided as the part of the robot arm only can move within a limited space. Consequently, hazardous movements cause by wrongly entered payload to the robot controller can be avoided as the robot controller can be configured to leave the free-drive mode of operation if the part of the robot exceeds the virtual dimensional geometric shape within the free-drive safety period. However, a user will in a controlled manner be able to manually move the part of the robot arm within the virtual three-dimensional space. The free-drive safety period of time can be any time period within which the part of the robot arm is allowed to move within the virtual three-dimensional space without creating hazards situations. The free-drive safety period can be predefined and/or dynamically configured for instance based on the posture of the robot arm. The virtual three-dimensional geometric shape can surround the tool flange and define a boundary wherein the tool flange is allowed to move during a the free-drive safety period of time. It is to be understood that the virtual three-dimensional geometric shape can have any shape for instance a sphere, an ellipsoid, a cube, a cuboid, a cylinder, a pyramid, a polyhedron or any arbitrary three-dimensional shape. The virtual three-dimensional geometric shape can be predefined and/or dynamically configured for instance based on the posture of the robot arm. The part of the robot arm surrounded by the virtual three-dimensional shape may in one embodiment be arranged at the center of the virtual three-dimensional geometric shape as this allows the part of the robot arm to move symmetrical within the virtual three-dimensional geometric shape; however, it is noted that the part of the robot arm can be arranged at any position within the virtual three-dimensional shape. The user can thereby manipulate the robot arm in free-drive mode of operation with both hands in a safe manner and without the need of continuously establishing a free-drive signal e.g. by pushing a button.
According to an embodiment of the third aspect of the invention, the position of the virtual three-dimensional geometric shape is fixed in relation to a reference point upon the robot controller switching to said free-drive mode of operation. The virtual three-dimensional geometrical shape can hereby be fixed in relation to a reference point when the robot controller is switched into free-drive mode of operation and the part of the robot arm is then allowed to move within a three-dimensional space defined in relation to the reference point, where the three-dimensional space is defined by the virtual three-dimensional space. The reference point may be any point in relation to the robot arm and can for instance be defined in relation to a moving part of the robot arm, such as a tool flange, a wrist joint, an elbow joint, a shoulder joint, a robot link; a fixed part of the robot arm such as the base joint, which is fixed in relation to the surroundings of the robot arm or a fixed point in the surroundings of the robot arm, such as a table, a work station, pick up point, conveyer, etc.
According to an embodiment of the third aspect of the invention the robot controller is configured to define the position of the virtual three-dimensional geometric shape in relation to a reference point based on the position of a part of said robot arm in relation to a fixed point. This makes it possible to define the position of the virtual three-dimensional geometric shape in relation to a fixed point, based on the position of the part of the robot arm surrounded by the virtual three-dimensional geometric shape. For instance, the virtual three-dimensional space may surround the tool flange of the robot arm and the position of the three-dimensional geometric shape may be defined based on the tool flange's position in relation to the robot base, where the robot base constitutes the fixed point.
According to an embodiment of the third aspect of the invention, the position of the virtual three-dimensional geometric shape in relation to a reference point of the robot arm is redefined during said free-drive mode of operation. The position of the virtual three-dimensional geometrical shape in relation to a reference point can hereby be redefined during the free-drive mode of operation. Hereby it is possible to redefine the position of the three-dimensional space in relation to the reference point during free-drive mode of operation, which makes it possible to move the part of the robot arm stepwise or gradually around in the surroundings of the robot arm. The reference point may be any point in relation to the robot arm and can for instance at any time during the free-drive mode of operation be defined as the position of a part of the robot arm in relation to a fixed point. For instance, the virtual three-dimensional space may surround the tool flange of the robot arm and can at any time during the free-drive mode of operation be fixed in relation to the tool flange's position in relation to the robot base. The time at which the position of the virtual three-dimensional geometrical shape in relation to a reference point can for instance be defined by a redefine position period of time. The redefine position period of time can for instance define a time period starting when the robot controller is switch into free-drive mode of operation or starting when the position of the virtual three-dimensional geometrical shape in relation to a reference point have been redefined. The redefine position period of time can for instance have the same length as the free-drive safety period of time and the robot controller can thus be configured to redefine the position of the virtual three-dimensional geometric shape in relation to a reference point of the robot arm upon expiry of the free-drive safety period and if the value of the at least one joint sensor parameter has not exceeded the virtual three-dimensional geometric shape surrounding a part of the robot arm within the free-drive safety period. This makes it possible to step wise or gradually move the part of the robot arm into positions beyond the initial boundary defined by the virtual three-dimensional geometrical shape, as the position of the virtual three-dimensional space can be redefined if the part of the robot arm has not exceeded the boundary of the virtual three-dimensional space within the free-drive safety period of time. In other words, the position of the three-dimensional space within which the part of the robot arm is allowed to move can be stepwise or gradually moved in relation to a reference point.
According to an embodiment of the third aspect of the invention, the robot controller is configured to define the position of the virtual three-dimensional geometric shape in relation to a reference point based on a plurality of positions of the part of the robot arm in relation to a fixed point, where the plurality of positions of the part of the robot arm have been obtained at different points in time. This makes it possible to ensure that the position of the visual three-dimensional geometric shape stepwise or gradually can move during the free-drive mode of operation. Consequently, a user can stepwise or gradually move the part of the robot arm to positions which upon switching into free-drive mode of operation were outside the boundaries defined by the virtual three-dimensional space. For instance, the position of the virtual three-dimensional geometric can be defined as the average position of a part of the robot arm with in an average position period of time, where the average position of the part of the robot arm has been obtained based on a plurality of positions of the part of the robot arm obtained within the average position period of time.
According to an embodiment of the third aspect of the invention, the robot controller is configured to provide robot feedback to the user upon determining if the value of the at least one joint sensor parameter is within a feedback value relating to the virtual three-dimensional geometric shape. This makes it possible to provide robot feedback to the user when the user have move the part of the robot arm to a position near the boundary defined by the virtual three-dimensional space such that the value of the joint sensor parameter is about to exceed said virtual three-dimensional geometric shape. The robot feedback can be provided as any signal perceptible by a user such as an audio signal, a visual signal, a haptic feedback, a predetermined posture of one or more joints, predetermined movements of one or more joints or combinations thereof. Consequently, the user will be warned that the robot arm has been moved close to the boundaries and is close to a position where the robot controller will leave the free-drive mode of operation, and the user can then counter act that this happens by stop moving the robot arm in the direction towards the boundary. This can be achieved by comparing the value of the at least one joint sensor parameter to the feedback value relating to the virtual three-dimensional geometric shape, where the feedback value can be provided as a threshold value having a lower value than the free-drive operation joint sensor parameter threshold value.
According to an embodiment of the third aspect of the invention, the robot feedback is provided as a robot force provided by a part of the robot arm, where the robot force is provided in a direction away from the virtual three-dimensional geometric shape. The user can hereby sense that the part of the robot arm is approaching the boundary defined by the virtual three-dimensional shape as an increase in moving resistance of the robot arm. This can be achieved by configuring the robot are to control the motor torque provided to the joint motors. The robot controller can also be contributed to increase the size of the robot force as the value of the joint sensor parameter approaches the virtual-dimensional geometric shape. Consequently, the user will sense a larger resistance the closer the robot arm is the boundary defined by the virtual three-dimensional shape.
Moreover, according to the third aspect, the invention relates to a robot arm comprising a plurality of robot joints connecting a robot base and a robot tool flange; each of the robot joints comprises:
Moreover according to the third aspect, the invention relates to a method of operating a robot arm in free-drive mode of operation, where the robot arm by a robot controller has been switched into the free-drive mode of operation upon the robot controller receiving a free-drive activating signal established by a user, wherein the free-drive mode of operation comprises the steps of:
According to an embodiment of the third aspect of the invention, the method comprises a step of fixing the position of the virtual three-dimensional geometric shape in relation to a reference point upon receiving the free-drive mode signal. Also, the method may comprises a step of: during the free-drive mode of operation redefining the position of the virtual three-dimensional geometric shape in relation to a reference point. This provides the same effects and advantages as described previously (e.g. in paragraph [0078]-[0081]) and makes it possible for the user to step wise or gradually move the robot arm into positions beyond the initial boundary defined by the virtual three-dimensional geometrical shape.
According to an embodiment of the third aspect of the invention, the method comprises a step of by the robot controller providing robot feedback to the user upon determining if the value of the at least one joint sensor parameter is within a feedback value relating to the virtual three-dimensional geometric shape. The step of providing robot feedback to the user may comprise a step of providing a robot force by at least a part of the robot arm, where the robot force is provided in a direction away from the virtual-dimensional geometric shape. Also, the step of providing the robot force may comprise a step of increasing the robot force as the value of the joint sensor parameter approaches the virtual-dimensional geometric shape. This provides the same effects and advantages as described previously (e.g. in paragraph [0082]-[0083]) and makes it possible to provide feedback to the user that the robot arm is about to leave the free-drive mode of operation.
It is noted that the embodiments of the various aspects of the present invention as described previously may be combined in any order or combination. Hereby further advantages and effects can be provided. For instance, a combination of the embodiments of the first aspect of the invention and the second aspect of the invention results in the effect at a user can activate free drive mode of operation directly at the robot arm in order to manipulate the robot arm in free-drive mode of operation using both hands. The combinations of the embodiments of the first aspect of the invention and the third aspect of the invention results in the effect at a user can activate free drive mode of operation directly at the robot arm in order to manipulate the robot arm and in the free-drive mode of operation safely move the robot around without risk of hazardous movements for instance due to changing payload during the free-drive mode of operation. The combinations of the embodiments of the second aspect of the invention and the third aspect of the invention results in the effect that the user can move the robot arm in free-drive mode of operation using both hands without risk of hazardous movements for instance due to changing payload during the free-drive mode of operation. The combinations of the embodiments of the first, second and third aspect of the invention results in the fact that a robot arm can be provided with a safe and user-friendly free-drive mode of operation where the user safely activate the free-drive mode of operation and thereafter move the robot arm using both hands in a safe a reliable manner.
Further and additional advantages and benefits of the present invention may be described in the detailed description of the invention.
For a more complete understanding of this disclosure, reference is now made to the following brief description, taken in connection with the accompanying drawings and detailed description:
The present invention is described in view of exemplary embodiments only intended to illustrate the principles of the present invention. The skilled person will be able to provide several embodiments within the scope of the claims. Throughout the description, the reference numbers of similar elements providing similar effects have the same last two digits. Further it is to be understood that in the case that an embodiment comprises a plurality of the same features then only some of the features may be labeled by a reference number.
A robot tool flange reference point 107 also known as a TCP is indicated at the robot tool flange and defines the origin of a tool flange coordinate system defining three coordinate axis xflange, yflange, zflange. In the illustrated embodiment the origin of the robot tool flange coordinate system has been arrange on the tool flange axis 105f with one axis (zflange) parallel with the tool flange axis and with another axis xflange, yflange parallel with the outer surface of the robot tool flange 104. Further a base reference point 108 is coincident with the origin of a robot base coordinate system defining three coordinate axis xbase, ybase, zbase. In the illustrated embodiment the origin of the robot base coordinate system has been arrange on the base axis 105a with one axis (zbase) parallel with the base axis 105a axis and with another axis xbase, ybase parallel with at the bottom surface of the robot base. The direction of gravity 109 in relation to the robot arm is also indicated by an arrow and it is to be understood that the robot arm can be arrange at any position and orientation in relation to gravity only limited by the freedom of operation of the robot joints.
The robot arm comprises at least one robot controller 110 configured to control robot arm 101 and can be provided as a computer comprising in interface device 111 enabling a user to control and program the robot arm. The controller can be provided as an external device as illustrated in
The robot tool flange 104 comprises a force-torque sensor 114 (sometimes referred to simply as fore sensor) integrated into the robot tool flange 104. The force-torque sensor 114 provides a tool flange force signal indicating a force-torque provided at the robot tool flange. In the illustrated embodiment the force-torque sensor is integrated into the robot tool flange and is configured to indicate the forces and torques applied to the robot tool flange in relation to the robot tool flange reference point 107. The force-torque sensor 114 provides a force and torque signal indicating a force and torque provided at the tool flange. In the illustrated embodiment the force-torque sensor is integrated into the robot tool flange and is configured to indicate the forces-torque applied to the robot tool flange in relation to the reference point 107 and in the tool flange coordinate system. However, the force-torque sensor can indicate the force-torque applied to the robot tool flange in relation to any point which can be linked to the robot tool flange coordinate system. In one embodiment the force-torque sensor is provided as a six-axis force-torque sensor configured to indicate the forces along and the torques around three perpendicular axis. The force-torque sensor can for instance be provided as any force-torque sensor capable of indicating the forces and torques in relation to a reference point for instance any of the force torque sensors disclosed by WO2014/110682A1, U.S. Pat. No. 4,763,531, US2015204742. However, it is to be understood that the force sensor in relation to the present invention not necessarily need to be capable of sensing the torque applied to the tool flange. It is noted that the force-torque sensor may be provided as an external device arranged at the robot tool flange or omitted.
An acceleration sensor 115 is arranged at the robot tool joint 102f and is configured to sense the acceleration of the robot tool joint 102f and/or the acceleration of the robot tool flange 104. The acceleration sensor 115 provides an acceleration signal indicating the acceleration of the robot tool joint 102f and/or the acceleration of the robot tool flange 104. In the illustrated embodiment the acceleration sensor is integrated into the robot tool joint and is configured to indicate accelerations of the robot tool joint in the robot tool coordinate system. However, the acceleration sensor can indicate the acceleration of the robot tool joint in relation to any point which can be linked to the robot tool flange coordinate system. The acceleration sensor can be provided as any accelerometer capable of indicating the accelerations of an object. The acceleration sensor can for instance be provided as an IMU (Inertial Measurement Unit) capable of indicating both linear acceleration and rotational accelerations of an object. It is noted that the acceleration sensor may be provided as an external device arranged at the robot tool flange or omitted.
Each of the robot joints comprises a robot joint body and an output flange rotatable or translatable in relation to the robot joint body and the output flange is connected to a neighbor robot joint either directly or via an arm section as known in the art. The robot joint comprises a joint motor configured to rotate or translate the output flange in relation to the robot joint body, for instance via a gearing or directly connected to the motor shaft. The robot joint body can for instance be formed as a joint housing and the joint motor can be arranged inside the joint housing and the output flange can extend out of the joint housing. Additionally, the robot joint comprises at least one joint sensor providing a sensor signal indicative of at least one of the following parameters: an angular and/or linear position of the output flange, an angular and/or linear position of the motor shaft of the joint motor, a motor current of the joint motor or an external force and/or torque trying to rotate the output flange or motor shaft. For instance, the angular position of the output flange can be indicated by an output encoder such as optical encoders, magnetic encoders which can indicate the angular position of the output flange in relation to the robot joint. Similarly, the angular position of the joint motor shaft can be provided by an input encoder such as optical encoders, magnetic encoders which can indicate the angular position of the motor shaft in relation to the robot joint. It is noted that both output encoders indicating the angular position of the output flange and input encoders indicating the angular position of the motor shaft can be provided, which in embodiments where a gearing have been provided makes it possible to determine a relationship between the input and output side of the gearing. The joint sensor can also be provided as a current sensor indicating the current through the joint motor and thus be used to obtain the torque provided by the motor. For instance, in connection with a multiphase motor, a plurality of current sensors can be provided in order to obtain the current through each of the phases of the multiphase motor. It is also noted that some of the robot joints may comprise a plurality of output flanges rotatable and/or translatable by joint actuators, for instance one of the robot joints may comprise a first output flange rotating/translating a first part of the robot arm in relation to the robot joint and a second output flange rotating/translating a second part of the robot arm in relation to the robot joint. As indicated above, the joint sensor can also be provided as a force and/or torque sensor or acceleration sensor. Such force and/or torque and acceleration sensor may be part of the outmost joint as indicated on
The robot controller is configured to control the motions of the robot arm by controlling the motor torque provided to the joint motors based on a dynamic model of the robot arm, the direction of gravity acting 109 and the sensor signal.
The robot controller 110 comprises a processer 221 and memory 222 and is configured to control the joint motors of the robot joints by providing motor control signals 223a, 223b, 223f to the joint motors. The motor control signals 223a, 223b, 223f are indicative of the motor torque Tmotor,a, Tmotor,b, and Tmotor,f that each joint motor shall provide to the output flanges and the robot controller is configured to determine the motor torque based on a dynamic model of the robot arm as known in the prior art. The dynamic model makes it possible for the controller to calculate which torque the joint motors shall provide to each of the joint motors to make the robot arm perform a desired movement. The dynamic model of the robot arm can be stored in the memory 222 and be adjusted based on the joint sensor parameters Jsensor,a, Jsensor,b Jsensor,f For instance, the joint motors can be provided as multiphase electromotors and the robot controller can be configured to adjust the motor torque provided by the joint motors by regulating the current through the phases of the multiphase motors as known in the art of motor regulation.
Robot tool joint 102f comprises the force-torque sensor 114 providing a tool flange force-torque signal 224 indicating a force-torque FTflange provided to the tool flange. For instance, the force signal-torque FTflange can be indicated as a force vector {right arrow over (Fsensorflange )} and a torque vector {right arrow over (Tsensorflange )} in the robot tool flange coordinate system:
where Fx,sensorflange is the indicated force along the xflange axis, Fy,sensorflange is the indicated force along the yflange axis and Fz,sensorflange is the indicated force along the zflange axis. The torque can be indicated as a torque vector in the robot tool flange coordinate system:
where Tx,sensorflange is the indicated torque around the xflange axis, Ty,sensorflange is the indicated torque around the yflange axis and Tz,sensorflange is the indicated torque around the zflange axis. It is noted that the force vector and torque vector can be provided as separate signals and that a separate force sensor and/or torque sensor can be provided.
Robot tool joint 102f may comprise the acceleration sensor 115 providing an acceleration signal 225 indicating the acceleration of the robot tool flange where the acceleration may be indicated in relation to the tool flange coordinate system
where Ax,sensorflange or is the sensed acceleration along the xflange axis, Ay,sensorflange or is the sensed acceleration along the yflange axis and Az,sensorflange is the sensed acceleration along the zflange axis.
In an embodiment where the acceleration sensor is provided as a combined accelerometer/gyrometer (e.g. an IMU) the acceleration sensor can additionally provide an angular acceleration signal indicating the angular acceleration of the output flange in relation to the robot tool flange coordinate system, for instance as a separate signal (not illustrated) or as a part of the acceleration signal. The angular acceleration signal can indicate an angular acceleration vector {right arrow over (αsensorflange )} in the robot tool flange coordinate system
where ax,sensorflange is the angular acceleration around the xflange axis, αy,sensorflange is the angular acceleration around the yflange axis and αz,sensorflange is the angular acceleration around the zflange axis.
The force-torque sensor and acceleration sensor of the illustrated embodiment are arranged at the robot tool joint 102f; however, it is to be understood that the force-torque sensor and acceleration sensor can be arrange at any part of the robot arm and in some embodiments be omitted.
The robot controller is switchable into a free-drive mode of operation, where the robot controller in the free-drive mode of operation is configured to:
When only gravity is acting on the robot arm, the robot controller can be configured to maintain the robot arm in a static posture by driving the joint motors at a state where they provide sufficient motor torque to overcome gravity without moving parts of the robot arm. The robot controller can be configured to determine the sufficient motor torque based on the dynamic model of the robot arm at the static posture. The static posture can for instance be indicated by joint sensors provided as output encoders indicating the angular position of the output flange and/or input encoders indicating the angular position of the motor shaft. The static posture can also be stored as a posture in the control software for instance by defining the joint angles of the robot joints at the static posture. In case the static posture of the robot arm is stored, the stored posture may be referred to as a way point posture to which the robot arm returns or moves to/through when operating in a robot program.
When an external force different from gravity is applied to the robot arm, the robot controller can allow change in posture by driving the joint motors with a motor torque that allows a user to rotate the output flanges of the robot joint. For instance, the robot controller can be configured to drive the motor with a motor torque sufficient for maintaining the robot arm in the static posture, and an additional force and/or torque applied to the robot arm will thus overcome the sufficient motor torque, whereby the output flange of the joints will rotate due to the additional force and/or torque. During change of the robot arm posture the robot controller can be configured to adjust the sufficient motor torque based on the changes in posture resulting in the effect that the robot arm will be maintained in the new static posture when the additional external force is reduced.
In the free-drive mode of operation, the robot controller can in one embodiment be configured to control the motor torque of the joint motors based on the force signal 224 from the force-torque sensor 114. This makes it possible for the user to move the tool flange without manipulating each of the robot joints, for instance by pushing, pulling or rotating the robot tool flange. Additionally, in the free-drive mode of operation according to the present invention the user can also choose to manipulate the individual robot joints to change the posture of the robot arm. Consequently, the user is provided with a larger flexibility and options when changing the posture of the robot arm in free-drive mode of operation.
The robot controller 110 for controlling the robot arm 101 can be configured to perform the methods illustrated in
Step 340 is a step of evaluating user inputs to determine if the robot controller should change the current mode of operation to free-drive mode of operation. Step 341 is an optional step of changing the robot controller's current mode of operation to teach mode, if not already in teach mode, as in some embodiments the robot control can be configured only to enter free-drive mode of operation when in teach-mode of operation. However, it should be noted that free-drive mode of operation could be entered from other current modes of operation such as run/operation mode, however it would typically be entered from teach mode. In step 342 a user of the robot arm establishes a so-called free-drive activation signal for instance based on user inputs UI, and in step 345 it is determined if the process of activating the free-drive mode of operation of the robot arm should start (see step 350). Typically, the free-drive mode of operation is activated during programming of the robot arm for instance in order to allow a user to manually change the posture of the robot arm, e.g. in order to define waypoints/postures of the robot arm during a robot program.
The free-drive mode of operation can be activated based on a user input instructing the robot controller to activate the free-drive mode of operation. Thus step 340 can receive a user input, UI activating the free-drive mode of operation and enters the free-drive mode of operation, as indicated by a thumb up icon, if such user input is received and validated. If no user instructions to enter the free-drive mode of operation is received, the robot controller will, as indicated by a thumb down icon, not enter to free-drive mode of operation. The user input can be received through any input device capable of receiving user inputs for instance buttons, joysticks, touch screens, gesture recognition devices, sliders, sensors on the robot arm, etc. In one embodiment the free-drive mode of operation is activated based on a force-torque signal resulting in the fact that the user can activate the free-drive mode of operation directly at the robot arm simply by applying a force and/or torque to the robot arm. For instance, the force-torque signal can be provided as the force-torque signal 224 provided by the force-torque sensor 114 attached to the robot tool flange of the robot arm illustrated in
As mentioned, in step 342 a user of the robot arm establishes a so-called free-drive activation signal. The free-drive activation signal is provided from the user to the robot controller by the user applying a force to the robot arm or user interface. The force can be applied to a button or touch screen of the user interface or to a joint or sensor of the robot arm. No matter how and where the force is applied to the robot arm or user interface, it establishes an input to the robot controller referred to as the free-drive activation signal.
In an embodiment, to activate free-drive mode of operation, the free-drive activation signal has to be received continuously by the robot controller in a so-called activation period of time. The activation period of time is typically more than zero seconds and typical less than 10-15 seconds, suitable duration depends on e.g. the user, but would in many situations be between 0.25 second and 5 seconds such as 0.25 second, 0.5 second, 1 second or 2 seconds. With this the time period could be set to zero (or between zero and 0.25 second) if e.g. a simple comparison is made between two stored values of a parameter. Alternatively, the free-drive activation signal can be received by the robot controller as discrete signals in a predetermined pattern. This is mainly to ensure that the free-drive activation signal is not established by mistake. Therefore, the period of time should be long enough to identify non-user activation as such and only register activation from a user.
In an embodiment the free-drive activation signal is a logic “1” or “0” provided by pushing a button of the user interface. In an alternative embodiment the free-drive activation signal is a measured value of a joint sensor parameter or a derivable hereof such as a force, torque, temperature, electric potential, etc. Accordingly, the type of joint sensor parameter needed to establish the free-drive activation signal may be predetermined for the robot controller to be able to identify a free-drive activation signal. Alternatively, a specific input address of an I/O module connected to the robot controller can be used to identify a free-drive activation signal.
In an embodiment, in step 342, the user applies a force to a robot joint or to a force sensor to establish the free-drive activation signal. In this embodiment the force may be applied by pushing the force sensor in a predetermined orientation in space. The predetermined orientation may e.g. be an orientation perpendicular or parallel to a joint axis 105f. In case the predetermined orientation is perpendicular to the joint axis, an angle of the perpendicular force applied may also be established. Establishing an angle for the applied force facilitates the possibility for the robot controller to identify forces applied in a predetermined direction as potential free-drive activation signal. As indicated, any movement in space could in principle be used however, the mentioned perpendicular or parallel movements with respect to joint axis 105f is considered advantageous in that they are easier to remember and apply by a user.
Hence, it is possible not only to limit the free-drive activation signal to a specific type of joint sensor parameters, such as a force measured by the force sensor, but also to a specific direction of such force maintained in a predetermined activation period of time. Establishing the free-drive activation signal based on a force applied in the specified direction in a predetermined activation period of time i.e. e.g. in an angle which may be defined relative to the robot base or another part of the robot arm reduces the risk of the robot controller confuses forces not intended to establish the free-drive activation signal from forces that is intended to establish the free-drive activation signal.
An alternative method of establishing the free-drive activation signal is to apply a force in a direction which is not natural for the particular robot arm. An example hereof could be if a force change is measured (increased or decreased) without any change of e.g. motor current is applied by the robot controller and/or if no change is registered in relation to the payload.
Yet another alternative method of establishing the free-drive activation signal is to apply a torque to the torque sensor. Typically, a torque would also be a none natural force e.g. if the robot arm is in a static posture and where a static motor current applied to the motor. Such torque could be applied by a user using one or both hands to twist the torque sensor.
In step 345, the measured value (magnitude/size) of the force or torque applied to the robot arm is compared to a predefined threshold value. If the measured value is above the threshold value for the predetermined activation period of time, the robot controller is instructed to conclude, that a user is about to activate free-drive mode of operation. An additional test that may be performed in step 345 is if the direction of the measured force is as expected and/or if a value of a further joint sensor parameter is below a further predetermined threshold value.
This further threshold may be lower than the first threshold in that it is expected that a user applying a force in many situations also will apply a small torque. Hence, if a relatively high force is applied at the same time as a relatively small torque (or vice versa) it is an indication of an impact from a user. This can be evaluated by comparing the measured values of both the force (joint sensor parameter) and the torque (further joint sensor parameter) to respective threshold values. Thereby is established a further filter for ensuring that only a user's intentional force applied are interpreted by the robot controller as a the free-drive activation signal.
Alternatively, if the first joint sensor parameter is a force in a first direction, then the further joint sensor parameter may be a force applied in a second direction which is different from the first direction.
The first and further thresholds are typically defined by an upper or lower value for e.g. the magnitude/size of the force/torque but could also be defined as ranges between to endpoints. An appropriate force to be applied by a user to establish the free-drive activation signal could be below 50 N such as e.g. 5 N, 10 N, 15 N or 20 N. The force has to be large enough not to be confused by a bump caused e.g. by a user and small enough for a user to be able to apply the force to the robot arm.
In step 350, the free-drive mode of operation is activated. In step 351, a so-called activation sequence period of time starts, in step 352, one or more joint sensor parameters are measured and in step 355, changes of the values of the one or more joint sensor parameters are compared to allowable changes. Hence, if changes are within an allowable range for the whole activation sequence period of time, the weight of the payload is assumed to be correct and the free-drive mode of operation is activated as indicated by thumb up and if not the robot controller switch to e.g. a non-freed-drive mode of operation such as protective stop mode or stays in the current mode of operation as indicated by thumb down.
As mentioned, in step 351, the activation sequence period of time starts. In an embodiment, this time period is between 0.25 second and 5 seconds such as 0.25 second, 0.5 second, 1 second or 2 seconds. With this the the time period could be set to zero (or between zero and 0.25 second) if e.g. a simple comparison is made between two stored values of a parameter half a second and 10-15 (or even more) seconds. If one or more joint sensor parameters does not within this period of time change more than allowed, free-drive mode of operation is entered.
The allowed changes may be defined by free-drive activation joint sensor parameter threshold values defining maximum speed, acceleration, displacement, position, force, torque, current, etc. These threshold values may be predetermined fixed values. However, they may also be dynamic in the sense that if e.g. acceleration of the robot arm in the activation sequence period of time is high, a threshold value for e.g. displacement of the robot arm or the time such acceleration is allowed is low whereas if the acceleration is low, the threshold value for the displacement or time is higher.
The free-drive activation joint sensor parameter threshold values may define a so-called virtual wall or virtual window defining a range around the center of the tool flange within which the tool flange is allowed to move; for instance, a plane in an orientation in space, a cube, sphere or other 3d shape. In case of e.g. a payload weight error, the robot tool flange (or payload) may move downward until it “hits” the virtual wall where it will stop and e.g. enter normal mode operation. The virtual wall can be reset so to speak by a user e.g. moving (lifting, lowering, displacing) the tool flange a predetermined distance. The user can for instance move the robot tool flange a predetermined distance away from the virtual window. By this, the virtual wall is reestablished now relative to the new position of the center of the tool flange. By applying an external force e.g. by moving (lifting, lowering, displacing) the tool flange the robot controller knows that it is a user applied force and therefore it is allowed to reestablish the virtual wall. In this way the tool flange can be moved down to the floor of the robot cell in subsequent steps. If the virtual wall was reached e.g. because the payload falls off a gripper tool, the gripper would hit the upper part of the virtual wall and stay there, as the robot arm in free-drive mode of operation tries to compensate for gravity's influence on the “missing payload”, and the virtual wall would not be reestablished. In the latter example, if there were no virtual wall, the gripper would risk stopping first, when it hits its upper position e.g. standing upwardly in a straight pose. The user can then move the tool flange down to the floor of the robot cell in subsequent steps by lowering the tool flange whereby the controller establishes a new virtual wall. Opposite if the payload weighs more than known by the robot controller, the robot tool flange would move downward in the direction of gravity until it hits its lower position or the floor of the robot cell. This can be prevented by the virtual window, as the gripper would hit the lower part of the virtual wall and stay there, and the virtual wall would not be reestablished. The user can then move the tool flange to a desired position in subsequent steps by lifting the tool flange away from the lower part of the virtual window, whereby the controller establishes a new virtual wall.
The joint sensor parameter thresholds could be dynamic depending on different aspects of movement of the robot arm. Hence, maximum speed could be depending on time since movement started. I.e. if the robot arm has moved in substantially the same direction for more than x seconds, then maximum speed threshold is reduced to avoid drifting of the robot arm.
Further, the payload could define threshold value for speed and acceleration. I.e. if the user has registered a large payload (size or weight) the maximum speed and/or acceleration threshold is reduced to prevent the user in getting hazardous situations or to help maneuver a heavy robot.
Speed and acceleration could be limited by the force applied to the robot by the user (or payload). I.e. if the user pulls hard in the robot or the payload change weight, the robot could be limited to slow movements to protect user and/or payload. The same is true for torque, hence if the robot experiences large torque, the maximum angular speed could be reduced to prevent an off-axis payload facilitates unexpected fast rotation/acceleration of the tool flange.
Therefore, in step 352 values of one or more predetermined joint sensor parameters are obtained or established. Joint sensor parameters may as mentioned include speed, acceleration, torque, motor torque, force, etc. but also derivable hereof such as position and displacement of the robot arm in space. In an embodiment, the force and torque are measured at the tool flange. Further output from accelerometers received over time from a plurality of joints are used to calculate or derive angular speed, angular acceleration, speed and/or acceleration of the tool flange. Further current and/or voltage is measured in a plurality of joints e.g. the power supply to the joint motors.
Despite the intension of the free-drive mode of operation, the value of these joint sensor parameters and derivables hereof may change without additional force (additional motor torque Tadditional) is applied to the robot arm by a user if e.g. the weight of the payload is not correct, sensors are not calibrated correct or sensors are drifting over time. Hence, one problem solved by the present invention is that measurements from sensors such as force torque sensors are drifting over time or as consequence of temperature changes and can therefore not be trusted. Instead, unexpected (from the robot controllers' point of view) measurements from torque/force sensors are more trustworthy.
As an example, could be mentioned that if the weight of the payload is lower than the weight provided to the robot controller (e.g. by a user), the static motor torque (Tstatic) calculated by the robot controller to maintain a static posture is too high leading to an upward movement of the robot arm. To avoid such movement to cause damage on material or persons, the robot controller in this situation stops the movement of the robot arm. Stop can be initiated e.g. by changing mode of operation to a protective or hard stop mode. In step 350, the stop is made within the activation sequence period of time and hence, free-drive mode of operation is not entered.
Alternatively, it can be done by compensating for the movement by reducing motor current to one or more joint motors until static posture of the robot arm is registered e.g. via joint sensor parameters.
It should be mentioned, that in some embodiments the joint/force sensors may only indicate the force applied by a user intending to enter free-drive mode and not register that force directly. For instance, a difference in encoder positions between input encoder and out encoder may be used to indicate than an external force is applied to the robot arm.
The evaluation of the measured joint sensor parameters is made in step 355. As mentioned, the evaluation may be implemented as a comparison of measured values of the joint sensor parameters to free-drive activation joint sensor parameter threshold values defining allowable changes of the measured values. As mentioned, these free-drive activation joint sensor parameter threshold values may be predetermined fixed values, however they may also be implemented as dynamic values and changed in response to e.g. speed of change of the values of the measured joint sensor parameters. By this evaluation, it is ensured that the free-drive mode of operation is only entered if this will not cause the robot arm to move with values of joint sensor parameters or derivables hereof outside the free-drive activation joint sensor parameter threshold values which could lead to hazardous situations for the user, the robot arm and its surroundings. A positive evaluation leading to change of mode of operation to free-drive mode of operation is indicated by the thumb up and a negative evaluation leading to e.g. staying in the current mode of operation (typically teach mode) or protective stop is indicated by thumb down.
In step 360, the robot arm is operated in the free-drive mode of operation and it is therefore possible for the user to manipulate the posture of the robot arm by applying a force to one or more parts of the robot arm.
In step 361, upon the positive evaluation described above leading to change of mode of operation into free-drive mode of operation, a free-drive period of time is started by the robot controller. In step 362, it is tested if the user manipulates the robot arm. If the user does not manipulate the robot arm, then after expiry of the free-drive mode period of time, the robot controller changes mode of operation to a non-free-drive mode of operation. In an embodiment, the mode of operation changes back to teach mode.
If, however the user does some manipulation of the robot arm, in step 363, the robot controller resets the free-drive mode period of time or if a different period of time is desired starts a restart free-drive mode period of time. Manipulation here includes registering a position such as a way point. Note that
The free-drive period of time and the restart free-drive period of time may be equal in length i.e. they may both be e.g. 3 seconds. Typically, these time periods are in the range of 0.5 second to 15 seconds, often in the range of 1 second to 5 seconds and often 2, 3 or 4 seconds. With this, as mentioned, these periods do not have to be equal in length.
After a change of mode of operation e.g. to stop or teach mode, then if the user desires to enter free-drive mode of operation again, he is to jump to step 342 again and establish the free-drive activation signal. It should be mentioned that it may require a reset or restart of the robot arm, if the robot arm has been in a stop mode of operation.
The static motor torque Tstatic obtained in step 466 can be obtained based on the actual posture of the robot arm Probot and the dynamic model of the robot arm Drobot, where the dynamic model of the robot arm defines a relationship between the posture of the robot arm and the motor torque needed to maintain the robot arm in a static posture under influence of gravity. The static motor torque indicates the motor torque that the joint motors need to provide in order to keep the robot arm in a static posture under influence of gravity. The actual posture of the robot arm Probot can be obtained based on joint output encoders indicating the angular position of each of the output flanges of the robot joints and the static motor torque Tstatic can be provided as a vector or array where the static motor torque Tstatic,n for each of the joint motors are provided, where n indicate the number of the robot joint with the robot motor that shall provide the obtained nth static motor torque. Driving the motor joint with currents generating the static motor torque results in the effect that the robot arm is kept in a static posture when it is only influenced by gravity. A user may move parts of the robot arm by manipulating the robot joints for instance by pushing, pulling and/or rotating parts of the robot arm whereby an external force/torque is applied to the robot arm. If such external force/torque exceeds the static motor torque of the robot joints, the joint motors will not be able to prevent modification of the robot arm posture and the user can thereby change to posture of the robot arm.
The additional motor torque Tadditional obtained in step 467 is obtained based on the force-torque FTflange provided to the tool flange and indicated by the force-torque sensor 114, the dynamic model of the robot arm Drobot and the actual posture of the robot arm Probot. The force-torque FTflange is provided by the force-torque sensor at the robot tool flange. The additional motor torque indicates the motor torque that the joint motors need to provide to move and/or rotate the robot tool flange in response to the force/torques provided to the robot tool flange and obtained by the force-torque sensor. For instance, a force provided in a given direction to the robot tool flange may result in a movement of the robot tool flange in that direction and the size of the force may indicate the desired acceleration of the movement. Similar, a torque provided in a given direction to the robot tool flange may result in a rotation of the robot tool flange in the direction of the torque and the size of the torque may indicate the desired angular acceleration of the rotation. The additional motor torque Tadditional can be provided as a vector where the additional motor torque Tadditional,n for each the joint motors is provided, where n indicate the joint number of the robot motor that shall provide the obtained static motor torque. Driving the motor joint with currents generating the additional motor torque results in the effect that the robot tool flange can be moved and/or rotated in the direction of the force and/or torque provided to the robot tool flange. In the illustrated embodiment the additional motor torque indicates the motor torques that in addition to the static torques needs to be provided in order to move the robot arm.
The combined motor torque Tcombined obtained in step 468 is obtained by combining the static motor torque Tstatic and the additional motor torque Taddition into a combined motor torque Tcombined. In this embodiment this is achieved by adding the static motor torque and the additional motor torque:
T
combined
=T
static
+T
additional eq. 4
Consequently, the combined motor torque Tcombined indicate the total motor torques that need to be provide by the joint motors to both overcome gravity and move/rotate the robot tool flange based on the force-torques provided to the robot tool flange.
The step of controlling the joint motor based on the combined motor torque comprises providing a number of control signals to each of the joint motors indicating the motor torque of each joint motor Tmotor,n, where n indicate the joint number of the robot motor that shall provide the motor torque. The motor torque of the joint motor may be regulated by varying the current through the joint motor as known in the art of motor regulation.
As described above in step 361, the free-drive period of time is started when the user stops manipulating the robot arm and in step 362, it is evaluated if the user manipulates the robot arm. If the user does not manipulate the robot art before expiry of this time period, the robot controller changes mode of operation indicated by thumb down. If on the other hand, the user manipulates the robot arm, the robot controller jumps to step 466 for changing posture of the robot in response to force applied by the user.
Further, as long as the robot arm is operated in the free-drive mode, the robot controller evaluates joint sensor parameters or derivables hereof. This evaluation is not illustrated in
The speed of movement of the robot arm in the free-drive mode of operation is limited in vertical orientations to ensure that in case a payload is dropped, the robot arm speed does not accelerate. However, in horizontal orientations a dropped payload will not influence the speed of the robot arm, which is therefore less restrictive compared to speed in vertical orientations.
Deactivation of the free-drive mode of operation can be made either simply by letting the free-drive period of time expire, by pushing a button, exceeding a joint parameter threshold such as speed or acceleration, etc.
The joint sensor parameters are used as an indicator of movement of the robot arm. Accordingly, any sensor value or values derived based on input to the robot controller can be seen as a joint sensor parameter. Joint sensor parameters therefore include information of at least speed, acceleration, torque, motor torque, force and position. In an embodiment of the invention, movement of the tool flange and thereby the robot arm is checked based on the joint encoders. The joint encoders include both an input encoder indicating the angular position of the joint motor shaft and an output encoder indicating the angular position of the output flange (thus after the gear). As indicated, movement of the tool flange and thereby the robot arm can also be indicated or derived from input from one or more joints such as from an accelerometer 115, current sensor and the like.
The robot arm may be controlled in different modes of operation. When programmed, the robot arm may be operated in teach mode, when programming is completed, the robot arm may be operated in run mode and when violating safety functions, the robot arm may enter a stop mode. The user may activate free-drive mode from any of these modes of operation, however with this the current mode of operation of the robot arm before entering the free-drive mode of operation is typically the teach mode of operation.
In an embodiment, predefined areas of allowed operation in the free-drive mode of operation may be defined. Such areas may be used to protect the robot arm from collision with physical objects, define working space, etc. Operated in the free-drive mode of operation, the robot controller may communicate to the user that the robot arm is getting close to a border of such area. Such information may be communicated visually to the user via the user interface. Alternatively, it may be communicated to the user by increasing the motor current and thereby the motor torque provided by the joint motor so that the user will experience a resistance from the robot arm when continuing applying the manipulating force resulting in a movement of the robot arm towards the border.
An alternative way of communicating from the robot controller to the user is by so-called haptic feedback. Haptic feedback may be used by the robot controller e.g. to inform the user that the free-drive mode of operation is entered, that a border is getting close, etc. The haptic feed-back may be presented as different sequences or patterns for the user to be able to distinguish the meaning of the haptic feedback signals from each other. If the haptic feedback is used, it is preferred to not “vibrate” (change position) of joints between the same two positions for a longer period. The duration of the period should not cause lubricant between balls of a ball bearing to not lubricate the balls. Hence, if haptic feedback is required for a period of time longer than the this can be prevented, it would be preferred to move the robot arm a bit first in one direction and later back in the other direction so that at the end the robot arm is in its starting position to ensure lubrication of the balls.
The graphic user interface is in an embodiment implemented as a screen of the teach pendant. Via this interface, the user is able to communicate with the robot controller and the robot controller is able to communicate with the user. One piece of information which the robot controller may communicate to the user is time left of the different periods of time described above. Hence from an area of the screen, the robot controller may count down or up the activation period of time, the activation sequence period of time, the free-drive period of time, the restart free-drive period of time, etc. Because of this, the user is always from a look at the screen informed of time left of a period of time. The screen or display may be divided into segments intended for communication of different aspects of e.g. movement of the robot arm. A visualization of posture of the joints, location of robot tool e.g. relative to a virtual wall and how to move the robot tool back on the correct side of such wall just to mention some of the functions of the graphic user interface.
Further, the robot controller may via the interface device present to the user root cause to events leading to involuntary leaving the free-drive mode as well as guidance on how to (e.g. which joints to move how) get the robot arm back in a starting position, posture or desired location/orientation in space.
Further, an unintentional event occurs that would satisfy requirements to activate free-drive mode of operation and bring the robot controller in free-drive mode could occur. To avoid that such event does not repeatably makes the robot controller enter free-drive mode, a time period may be introduced that needs to expire before the robot controller can enter free-drive mode again.
From the above it is hereby clear that the change of mode of operation from a current mode of operation to the free-drive mode of operation is made in a safe manner ensuring that e.g. errors in payload weight information comprised by the robot controller does not result hazardous situations. This problem is solved by a user establishing a free-drive activation signal such as a force above a corresponding threshold value. In an embodiment continuously for an activation period of time. By this test, it is ensured, that the user's intension is to enter free-drive mode.
Subsequently, the robot controller switches mode of operation typically from normal mode of operation to free-drive mode. Initially upon entering the free-drive mode of operation, one or more joint sensor parameter values are monitored for an activation period of time and compared to corresponding threshold values. By this test, it is ensured, that the weight of the payload is correct. If not correct, one or more of the monitored joint sensor parameter values will exceed the corresponding threshold values. In case this happens, the robot controller will change mode of operation e.g. to a stop mode or non-free-drive mode of operation. If correct, the user is then able to move/manipulate the robot arm as desired in the free-drive mode of operation.
If the user does not apply a force to the robot arm in a given free-drive period of time/restart free-drive period of time, the robot controller interprets this as a wish from the user to switch back to teach mode (or another mode).
A further problem solved by the present invention is that it is possible to use both hands when changing posture (sometimes referred to as manipulating, moving or applying a force) of the robot arm. This is advantageous e.g. in the situation where a robot tool has to be positioned very precise e.g. a screwing tool above a screw or where the robot arm is physically to large and heavy to manipulate with only one hand.
A further problem solved by the present invention is that if the force and torque sensor has drifted and therefore is providing wrong information to the robot controller related to the weight of the payload, no unexpected hazardous movements of the robot arm will happen outside the defined threshold values.
In an embodiment of the invention a time period is started when a force above a force threshold is registered by the torque/force sensor (joint sensor), wherein the force is categorized as an intentional impact force if the registered force maintains above the force threshold for a determined force period of time and the torque registered by the torque/force sensor remains below a torque threshold for a determined torque period of time.
This is advantageous in that it has the effect, that unintentional impact forces can be sorted out. This is because intentional impact forces provided by e.g. a human is provided without an accompanying or limited torque. This is in contrary to a unintentional impact force e.g. from a collision or holding operation, where the force/torque sensor will register a twist and thereby a torque. Hence, no matter in which mode of operation the robot arm is operating, it is able to register an intentional impact force and based hereon e.g. change mode of operation, state of software program, be prepared to receive certain input, etc.
In an embodiment, the robot controller and the user communicate via applied force and robot feedback and based here on the robot controller enter the free-drive. First, the user applies an external force to the robot arm. The external force applied can be any type of force applied in any orientation in space. Hence, when the robot controller operates the robot arm e.g. in normal mode of operation and the user applies a force e.g. in a predetermined orientation in space such as perpendicular to the joint axis 105f. The direction or strength of the force provided by the user does not need to be know by the robot controller. Upon registering the external force, the robot controller will provide a robot feedback as a response. The robot feedback can be haptic feedback and when the user observes such haptic feedback, the user applies a predetermined force in a predetermined pattern or strength to the robot arm. This predetermined force is known by the robot controller and if a match exists between the applied predetermined force detected by the robot controller and the expected predetermined force the robot controller determines that a user intentionally wishes to enter free-drive mode and is therefore changing mode of operation to free-drive mode.
The predetermined force applied by the user may be a simple force in a certain direction for a certain period of time. It just has to be known by the robot controller and thereby be predetermined. Predetermined force in this embodiment should be understood as a pattern, sequence of moves of robot joints, etc.
The robot feedback may be provided immediately after the external force is registered but could also be provided within 0.5 second to 5 seconds such as e.g. 1, 1.5, 2 or 2.5 seconds from when the external force is registered. Similarly, the predetermined force may be provided immediately after the robot feedback is provided but could also be provided within 0.5 second to 5 seconds such as e.g. 1, 1.5, 2 or 2.5 seconds from when the robot feedback is provided. These time periods are determined based on what is convenient for the user and to ensure that an unintentional external force similar to the predetermined force, applied e.g. 1 minute after the robot feedback is stopped would not initiate a change to free-drive mode of operation. In this embodiment of the invention, where robot and user “communicate”, the activation sequence period of time is preferably set to zero or close to zero seconds i.e. below 1 second. This has the effect that uncontrolled movement of the robot arm during the activation sequence period of time e.g. due to wrong registration of payload weight in the robot controller is reduce or completely eliminated.
Finally, it should be noted that the applied force, could be a force applied to one or more different input devices on the interface device. Such input devices could be buttons, microphones, touch screen, accelerometers/gyros, etc.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2019 01237 | Oct 2019 | DK | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/DK2020/050283 | 10/9/2020 | WO |
