Movatterモバイル変換


[0]ホーム

URL:


CN114012721A - Robot brake control method and device and related equipment - Google Patents

Robot brake control method and device and related equipment
Download PDF

Info

Publication number
CN114012721A
CN114012721ACN202111264155.2ACN202111264155ACN114012721ACN 114012721 ACN114012721 ACN 114012721ACN 202111264155 ACN202111264155 ACN 202111264155ACN 114012721 ACN114012721 ACN 114012721A
Authority
CN
China
Prior art keywords
robot
coordinate
target
area
brake control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202111264155.2A
Other languages
Chinese (zh)
Inventor
邵帅
冉启猛
卢达胜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Gree Electric Appliances Inc of Zhuhai
Original Assignee
Gree Electric Appliances Inc of Zhuhai
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Gree Electric Appliances Inc of ZhuhaifiledCriticalGree Electric Appliances Inc of Zhuhai
Priority to CN202111264155.2ApriorityCriticalpatent/CN114012721A/en
Publication of CN114012721ApublicationCriticalpatent/CN114012721A/en
Pendinglegal-statusCriticalCurrent

Links

Images

Classifications

Landscapes

Abstract

The invention relates to a robot brake control method, a device and related equipment, belonging to the technical field of brake control. In the judging process, the position is judged according to the coordinate value determined by the driving data of the driving device of the target part, and a sensor or a grating assembly does not need to be arranged outside, so that external equipment is reduced, the cost and the process are reduced, the control precision is improved, the probability of personal injury or robot damage is reduced, the method has high applicability, and can be applied to all-model robots.

Description

Robot brake control method and device and related equipment
Technical Field
The invention belongs to the technical field of brake control, and particularly relates to a robot brake control method, a robot brake control device and related equipment.
Background
Due to the rapid development of an automatic control technology, the robot is widely applied to various industries, such as the automobile industry, the medical industry, the education industry and the like. When the robot is taught or worked, the robot body is likely to be impacted due to system errors or misoperation of users, so that the personnel are injured or the robot is damaged.
In the related art, active braking is generally employed to prevent a machine from being hit. The mode of controlling the robot to actively brake in the market is mainly to brake by setting external equipment such as a distance sensor or a grating and controlling the robot through a PLC signal. However, different external devices need to be set in such a control mode, and the external devices are likely to be interfered by uncertain factors, which is likely to cause a problem of untimely control.
Therefore, how to reduce external devices, reduce implementation cost, and improve control accuracy becomes a technical problem to be solved urgently in the prior art.
Disclosure of Invention
The invention provides a robot brake control method, a robot brake control device and related equipment, and aims to solve the technical problems that in the prior art, external equipment needs to be arranged, the external equipment is likely to be interfered by uncertain factors more greatly, and control is likely to be out of time.
The technical scheme provided by the invention is as follows:
in one aspect, a robot brake control method includes:
acquiring coordinate values of the tail end position of the robot target part based on the driving data of the driving device of the robot target part;
judging whether the coordinate value is in a preset coordinate area or not;
and if the coordinate value exceeds the preset coordinate area, triggering the robot to brake.
Optionally, the target portion includes a target axis, and the driving device of the target portion of the robot includes a control motor; the acquiring of the coordinate value of the end position of the robot target part based on the driving data of the driving device of the robot target part includes:
acquiring a rotation angle of a control motor of the target shaft;
and determining the coordinate value of the tail end position of the robot target shaft according to the rotation angle.
Optionally, the coordinate values include cartesian coordinate values in a world coordinate system.
Optionally, the obtaining of the coordinate value of the end position of the target portion of the robot includes:
acquiring Cartesian coordinates of the tail end position of a target part of the robot;
acquiring a plane coordinate according to the Cartesian coordinate;
and respectively extracting coordinate values of the plane coordinates.
Optionally, the method further includes:
determining the activity area condition of the workstation;
and determining the preset coordinate area according to the condition of the activity area.
In still another aspect, a robot brake control apparatus includes: the device comprises an acquisition module, a judgment module and a trigger module;
the acquisition module is used for acquiring coordinate values of the tail end position of the target part of the robot based on the driving data of the driving device of the target part of the robot;
the judging module is used for judging whether the coordinate value is in a preset coordinate area;
and the triggering module is used for triggering the robot to brake when the coordinate value exceeds the preset coordinate area.
Optionally, the target portion includes a target axis, and the driving device of the target portion of the robot includes a control motor; the acquisition module is used for acquiring the rotation angle of the control motor of the target shaft; and determining the coordinate value of the tail end position of the robot target shaft according to the rotation angle.
In still another aspect, a robot brake control apparatus includes: a processor, and a memory coupled to the processor;
the memory is used for storing a computer program, and the computer program is at least used for executing the robot brake control method;
the processor is used for calling and executing the computer program in the memory.
In yet another aspect, a robot includes: the shell and the robot brake control equipment are arranged on the shell; the robot brake control device is arranged in the shell.
In yet another aspect, a workstation includes: a protected area and a robot; the robot operates in the protection area according to any one of the brake control methods.
Optionally, the method further includes: a manual operation area; the manual operation area is arranged outside the protection area.
The invention has the beneficial effects that:
according to the robot brake control method, the robot brake control device and the related equipment provided by the embodiment of the invention, the coordinate value of the position of the target part is obtained in real time through the driving data of the driving device of the target part, and when the coordinate value exceeds the preset coordinate area, the robot brake is triggered. In the judging process, the position is judged according to the coordinate value determined by the driving data of the driving device of the target part, and a sensor or a grating assembly does not need to be arranged outside, so that external equipment is reduced, the cost and the process are reduced, the control precision is improved, the probability of personal injury or robot damage is reduced, the method has high applicability, and can be applied to all-model robots.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the drawings without creative efforts.
Fig. 1 is a schematic flow chart of a robot brake control method according to an embodiment of the present invention;
fig. 2 is a schematic diagram of a robot movement area in a workstation according to an embodiment of the present invention;
fig. 3 is a schematic structural diagram of a brake control device of a robot according to an embodiment of the present invention;
fig. 4 is a schematic structural diagram of a brake control device of a robot according to an embodiment of the present invention;
fig. 5 is a schematic front view of a robot according to an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the technical solutions of the present invention will be described in detail below. It is to be understood that the described embodiments are merely exemplary of the invention, and not restrictive of the full scope of the invention. All other embodiments, which can be derived by a person skilled in the art from the examples given herein without any inventive step, are within the scope of the present invention.
In the related art, active braking is generally employed to prevent a machine from being hit. The mode of controlling the robot to actively brake in the market is mainly to brake by setting external equipment such as a distance sensor or a grating and controlling the robot through a PLC signal. However, different external devices need to be set in such a control mode, and the external devices are likely to be interfered by uncertain factors, which is likely to cause a problem of untimely control.
Therefore, how to reduce external devices, reduce implementation cost, and improve control accuracy becomes a technical problem to be solved urgently in the prior art.
Based on the above, the embodiment of the invention provides a robot brake control method, a robot brake control device and related equipment.
The first embodiment is as follows:
the embodiment of the invention provides a robot brake control method.
Fig. 1 is a schematic flow chart of a robot brake control method according to an embodiment of the present invention, and referring to fig. 1, the method according to the embodiment of the present invention may include the following steps:
s1, acquiring coordinate values of the tail end position of the robot target part based on the driving data of the driving device of the robot target part;
s2, judging whether the coordinate value is in a preset coordinate area;
and S3, if the coordinate value exceeds the preset coordinate area, triggering the robot to brake.
The robot brake control method can be applied to any robot to control the robot to brake.
Fig. 2 is a schematic diagram of a robot movement area in a workstation according to an embodiment of the present invention, and referring to fig. 2, a robot 1 may work in the workstation, and aprotective area 2 is provided in the workstation, so that the robot 1 operates in theprotective area 2. In the working operation of the robot, a processing assembly can be arranged, and a program of the robot brake control method is embedded in the processing assembly, so that the robot brake is controlled in real time.
The coordinate value of the tail end position of the target position of the robot can be obtained in real time during operation of the robot, and the robot brake is triggered by judging whether the coordinate value is in the preset coordinate area or not so that the coordinate value exceeds the preset coordinate area, the brake set price of the robot is locked, and active braking is performed.
According to the robot brake control method provided by the embodiment of the invention, the coordinate value of the position of the target part is obtained in real time through the driving data of the driving device of the target part, and when the coordinate value exceeds the preset coordinate area, the robot brake is triggered. In the judgment process, the position is judged according to the coordinate value determined by the driving data of the driving device of the target part, and a sensor or a grating assembly is not required to be arranged outside, so that external equipment is reduced, the cost and the working procedure are reduced, and the control precision is improved.
In some embodiments, optionally, the target site comprises a target axis; the driving device of the robot target part comprises a control motor; based on the drive data of the drive device of the robot target part, coordinate values of the terminal position of the robot target part are acquired, including: acquiring a rotation angle of a control motor of a target shaft; and determining the coordinate value of the tail end position of the robot target shaft according to the rotation angle.
The target part of the robot may be a target axis, wherein the target axis may be set according to the respective form and specific of each robot. For example, when the robot is a four-axis robot, each axis is set as a target axis, and coordinate values of the end position of each target axis are acquired. In the prior art, a target shaft of a robot acts by means of rotation of a control motor, and referring to the prior art, in the embodiment of the present invention, a coordinate value of a position of a tail end of the target shaft may be determined by controlling a rotation angle of the motor. For example, the coordinate value corresponding to each rotation angle of the control motor may be pre-stored in advance, so that the coordinate value corresponding to the end position of each target axis is determined by acquiring the rotation angle of each control motor during the operation of the robot.
In some embodiments, optionally, the coordinate values comprise cartesian coordinate values in a world coordinate system.
In some embodiments, optionally, obtaining coordinate values of the end position of the robot target portion includes: acquiring Cartesian coordinates of the tail end position of a target part of the robot; acquiring a plane coordinate according to the Cartesian coordinate; and respectively extracting coordinate values of the plane coordinates.
In this embodiment, cartesian coordinates may be adopted to obtain the coordinate value. The process of obtaining the coordinate values is described by taking a four-axis robot as an example. During the working and running process of the robot, the Cartesian coordinates (x, y) of the tail end position of the target part of the robot can be acquired in real time, wherein the tail end position can be a tail end endpoint. After the cartesian coordinates (x, y) are acquired, coordinate values of the end position of each target axis are extracted, that is, when the robot is a four-axis robot, plane coordinates (x, y) of the respective ends of the four axes are acquired1,y1),(x2,y2),(x3,y3),(x4,y4) After the plane coordinates are obtained, coordinate values x of the plane coordinates are respectively extracted1,x2,x3,x4,y1,y2,y3,y4After the coordinate value of the plane coordinate is obtained, it is determined whether the coordinate value is in a preset coordinate region, where, referring to fig. 2, the preset coordinate range may be [ x [ ]a,xb]And [ ya,yb]Judging whether the coordinate value of the acquired plane coordinate satisfies xa<X<xb,ya<Y<ybWherein X comprises1,x2,x3,x4Y includes Y1,y2,y3,y4,When the coordinate value meets the range, the robot always runs normally; when the coordinate value does not meet the range, the robot system is indicated to operate incorrectly, or people teach incorrectly, the coordinate value does not meet the preset coordinate area in the set workstation, the robot feeds back a brake signal to the controller, and the controller controls the driver to lock the motor, so that the robot is actively braked, the robot is stopped in a protection area in the workstation, and the robot is prevented from exceeding the protection area.
In some embodiments, optionally, the method further includes: determining the activity area condition of the workstation; and determining a preset coordinate area according to the condition of the active area.
For example, the size of the protective zone and thus the preset coordinate zone may be determined according to the workstation situation.
Referring to fig. 2, in the workstation, the robot can operate in thearea 3 at the maximum, but in actual work, the working range usually does not reach themaximum operating area 3, and even some robots set a smaller working range as required. In fig. 2, the robot 1 is a robot body, which is connected to arobot arm 5.
According to the robot brake control method provided by the embodiment of the invention, the coordinate value of the position of the target part is obtained in real time through the driving data of the driving device of the target part, and when the coordinate value exceeds the preset coordinate area, the robot brake is triggered. In the judging process, the position is judged according to the coordinate value determined by the driving data of the driving device of the target part, and a sensor or a grating assembly does not need to be arranged outside, so that external equipment is reduced, the cost and the process are reduced, the control precision is improved, the probability of personal injury or robot damage is reduced, the method has high applicability, and can be applied to all-model robots.
Example two:
based on a general inventive concept, the embodiment of the invention also provides a robot brake control device.
Fig. 3 is a schematic structural diagram of a brake control device for a robot according to an embodiment of the present invention, and referring to fig. 3, the brake control device for a robot according to an embodiment of the present invention may include the following structures: anacquisition module 31, ajudgment module 32 and atrigger module 33. The acquiringmodule 31 is configured to acquire coordinate values of a terminal position of a target part of the robot based on driving data of a driving device of the target part of the robot; the judgingmodule 32 is used for judging whether the coordinate values are in a preset coordinate area; and the triggeringmodule 33 is used for triggering the robot to brake when the coordinate value exceeds the preset coordinate area.
Optionally, the target part comprises a target shaft, and the driving device of the target part of the robot comprises a control motor; an obtainingmodule 31, configured to obtain a rotation angle of a control motor of the target shaft; and determining the coordinate value of the tail end position of the robot target shaft according to the rotation angle.
Optionally, the coordinate values include cartesian coordinate values in a world coordinate system.
Optionally, the obtainingmodule 31 is configured to obtain cartesian coordinates of the end position of the target portion of the robot;
acquiring a plane coordinate according to the Cartesian coordinate;
and respectively extracting coordinate values of the plane coordinates.
Optionally, the method further includes: the setting module is used for determining the activity area condition of the workstation; and determining a preset coordinate area according to the condition of the active area.
With regard to the apparatus in the above-described embodiment, the specific manner in which each module performs the operation has been described in detail in the embodiment related to the method, and will not be elaborated here.
According to the robot brake control device provided by the embodiment of the invention, the coordinate value of the position of the target part is obtained in real time through the driving data of the driving device of the target part, and when the coordinate value exceeds the preset coordinate area, the robot brake is triggered. In the judging process, the position is judged according to the coordinate value determined by the driving data of the driving device of the target part, and a sensor or a grating assembly does not need to be arranged outside, so that external equipment is reduced, the cost and the process are reduced, the control precision is improved, the probability of personal injury or robot damage is reduced, the method has high applicability, and can be applied to all-model robots.
Example three:
based on a general inventive concept, embodiments of the present invention also provide a robot brake control apparatus.
Fig. 4 is a schematic structural diagram of a robot brake control device according to an embodiment of the present invention, referring to fig. 4, the robot brake control device according to the embodiment of the present invention includes: aprocessor 41, and amemory 42 coupled to the processor.
Thememory 42 is used for storing a computer program, and the computer program is at least used for the robot brake control method described in any one of the above embodiments;
theprocessor 41 is used to invoke and execute computer programs in memory.
Example five:
based on one general inventive concept, embodiments of the present invention also provide a robot.
The robot provided by the embodiment of the invention comprises: the robot brake control device comprises a shell and any one of the robot brake control devices; the robot brake control device is arranged in the shell.
Fig. 5 is a schematic front view of a robot according to an embodiment of the present invention, and referring to fig. 5, fig. 5 is a front view of a four-axis robot, in which a robot brake control device is disposed in a housing of the four-axis robot.
Example six:
based on one general inventive concept, embodiments of the present invention also provide a workstation.
The workstation provided by the embodiment of the invention comprises: a protected area and a robot; the robot operates in a protection area according to the brake control method described in any of the above embodiments.
In some embodiments, optionally, the method further includes: a manual operation area; the manual operation area is arranged outside the protection area.
It should be noted that in this embodiment, other specific partitions of the workstation may also refer to the schematic diagram of the robot motion area in the workstation in fig. 2 in the above embodiment, which is not described in detail in this embodiment.
The above description is only for the specific embodiments of the present invention, but the scope of the present invention is not limited thereto, and any person skilled in the art can easily conceive of the changes or substitutions within the technical scope of the present invention, and all the changes or substitutions should be covered within the scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the appended claims.
It is understood that the same or similar parts in the above embodiments may be mutually referred to, and the same or similar parts in other embodiments may be referred to for the content which is not described in detail in some embodiments.
It should be noted that the terms "first," "second," and the like in the description of the present invention are used for descriptive purposes only and are not to be construed as indicating or implying relative importance. Further, in the description of the present invention, the meaning of "a plurality" means at least two unless otherwise specified.
Any process or method descriptions in flow charts or otherwise described herein may be understood as representing modules, segments, or portions of code which include one or more executable instructions for implementing specific logical functions or steps of the process, and alternate implementations are included within the scope of the preferred embodiment of the present invention in which functions may be executed out of order from that shown or discussed, including substantially concurrently or in reverse order, depending on the functionality involved, as would be understood by those reasonably skilled in the art of the present invention.
It should be understood that portions of the present invention may be implemented in hardware, software, firmware, or a combination thereof. In the above embodiments, the various steps or methods may be implemented in software or firmware stored in memory and executed by a suitable instruction execution system. For example, if implemented in hardware, as in another embodiment, any one or combination of the following techniques, which are known in the art, may be used: a discrete logic circuit having a logic gate circuit for implementing a logic function on a data signal, an application specific integrated circuit having an appropriate combinational logic gate circuit, a Programmable Gate Array (PGA), a Field Programmable Gate Array (FPGA), or the like.
It will be understood by those skilled in the art that all or part of the steps carried by the method for implementing the above embodiments may be implemented by hardware related to instructions of a program, which may be stored in a computer readable storage medium, and when the program is executed, the program includes one or a combination of the steps of the method embodiments.
In addition, functional units in the embodiments of the present invention may be integrated into one processing module, or each unit may exist alone physically, or two or more units are integrated into one module. The integrated module can be realized in a hardware mode, and can also be realized in a software functional module mode. The integrated module, if implemented in the form of a software functional module and sold or used as a stand-alone product, may also be stored in a computer readable storage medium.
The storage medium mentioned above may be a read-only memory, a magnetic or optical disk, etc.
In the description herein, references to the description of the term "one embodiment," "some embodiments," "an example," "a specific example," or "some examples," etc., mean that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the invention. In this specification, the schematic representations of the terms used above do not necessarily refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
Although embodiments of the present invention have been shown and described above, it is understood that the above embodiments are exemplary and should not be construed as limiting the present invention, and that variations, modifications, substitutions and alterations can be made to the above embodiments by those of ordinary skill in the art within the scope of the present invention.

Claims (11)

CN202111264155.2A2021-10-282021-10-28Robot brake control method and device and related equipmentPendingCN114012721A (en)

Priority Applications (1)

Application NumberPriority DateFiling DateTitle
CN202111264155.2ACN114012721A (en)2021-10-282021-10-28Robot brake control method and device and related equipment

Applications Claiming Priority (1)

Application NumberPriority DateFiling DateTitle
CN202111264155.2ACN114012721A (en)2021-10-282021-10-28Robot brake control method and device and related equipment

Publications (1)

Publication NumberPublication Date
CN114012721Atrue CN114012721A (en)2022-02-08

Family

ID=80058428

Family Applications (1)

Application NumberTitlePriority DateFiling Date
CN202111264155.2APendingCN114012721A (en)2021-10-282021-10-28Robot brake control method and device and related equipment

Country Status (1)

CountryLink
CN (1)CN114012721A (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
JP2007283450A (en)*2006-04-182007-11-01National Institute Of Advanced Industrial & Technology Safety device for human robot coexistence work
CN101888920A (en)*2007-12-072010-11-17株式会社安川电机 Robot motion limiting method, robot system and robot motion limiting device
CN102011932A (en)*2009-09-042011-04-13库卡罗伯特有限公司Method and device for bringing a manipulator to a standstill
CN107186711A (en)*2017-05-122017-09-22广州视源电子科技股份有限公司Limiting protection method and device for mechanical arm and robot
CN108568815A (en)*2017-03-132018-09-25发那科株式会社Robot system and robot control method
CN108656103A (en)*2017-03-282018-10-16广明光电股份有限公司 Design method of robot working area
CN111660314A (en)*2020-05-092020-09-15北京配天技术有限公司Robot stop buffer division method, device and storage device

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
JP2007283450A (en)*2006-04-182007-11-01National Institute Of Advanced Industrial & Technology Safety device for human robot coexistence work
CN101888920A (en)*2007-12-072010-11-17株式会社安川电机 Robot motion limiting method, robot system and robot motion limiting device
CN102011932A (en)*2009-09-042011-04-13库卡罗伯特有限公司Method and device for bringing a manipulator to a standstill
CN108568815A (en)*2017-03-132018-09-25发那科株式会社Robot system and robot control method
CN108656103A (en)*2017-03-282018-10-16广明光电股份有限公司 Design method of robot working area
CN107186711A (en)*2017-05-122017-09-22广州视源电子科技股份有限公司Limiting protection method and device for mechanical arm and robot
CN111660314A (en)*2020-05-092020-09-15北京配天技术有限公司Robot stop buffer division method, device and storage device

Similar Documents

PublicationPublication DateTitle
CN109620410B (en)Method and system for preventing collision of mechanical arm and medical robot
EP0087198B1 (en)A method for preventing collision for two mutually movable bodies and an apparatus including an arrangement for preventing collision
JP7539742B2 (en) Safety system and method for use in robotic operation - Patents.com
US8855812B2 (en)System and method for robot safety and collision avoidance
US20220161433A1 (en)Extendable safety system for robot system
CN111479660A (en)Robot including safety system for ensuring stop time and distance
US10259115B2 (en)Work device
KR102418451B1 (en)Robot control system
CN105459120A (en)Human-collaborative robot system
CN117297791A (en)Control method of mechanical arm, medical system and computer equipment
CN120326614A (en) Robotic arm plugging and unplugging control method, device, test equipment and storage medium
CN114012721A (en)Robot brake control method and device and related equipment
JP2017159427A (en)Control device, robot, and robot system
JPH0248400B2 (en)
CN213259495U (en)Industrial robot capable of ensuring limit of speed and momentum boundary
JP3355902B2 (en) Movable range limiting device for articulated robots
CN113134832A (en)Method for setting safe area of truss robot
CN114074323B (en)Safety system for ensuring speed and momentum boundary limitation of robot
CN116749196A (en)Multi-axis mechanical arm collision detection system and method and mechanical arm
CN212653448U (en)Industrial robot capable of ensuring limit of speed and momentum boundary
EP3581348A1 (en)Robot control method and robot
US12186908B2 (en)Force-limited movement of at least one element of a production machine in manual operation
CN114274132B (en)Multi-joint robot power-on joint precision management method
CN114074325A (en)Safety system for ensuring robot power boundary limitation
CN115562166B (en)Recognition method, recognition device, processor and computer readable storage medium for realizing motor-driven gantry machine tool beam collision

Legal Events

DateCodeTitleDescription
PB01Publication
PB01Publication
SE01Entry into force of request for substantive examination
SE01Entry into force of request for substantive examination
RJ01Rejection of invention patent application after publication
RJ01Rejection of invention patent application after publication

Application publication date:20220208


[8]ページ先頭

©2009-2025 Movatter.jp