WO2019148333A1 - Method and device for controlling robot to stop, storage medium, and robot system - Google Patents

Method and device for controlling robot to stop, storage medium, and robot system Download PDF

Info

Publication number
WO2019148333A1
WO2019148333A1 PCT/CN2018/074610 CN2018074610W WO2019148333A1 WO 2019148333 A1 WO2019148333 A1 WO 2019148333A1 CN 2018074610 W CN2018074610 W CN 2018074610W WO 2019148333 A1 WO2019148333 A1 WO 2019148333A1
Authority
WO
WIPO (PCT)
Prior art keywords
circuit
robot
control
semiconductor
signal
Prior art date
Application number
PCT/CN2018/074610
Other languages
French (fr)
Chinese (zh)
Inventor
张鹏飞
Original Assignee
深圳配天智能技术研究院有限公司
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 深圳配天智能技术研究院有限公司 filed Critical 深圳配天智能技术研究院有限公司
Priority to CN201880002366.9A priority Critical patent/CN109414818B/en
Priority to PCT/CN2018/074610 priority patent/WO2019148333A1/en
Publication of WO2019148333A1 publication Critical patent/WO2019148333A1/en

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors

Definitions

  • the present invention relates to the field of industrial robots, and in particular to a method, device, storage medium and robot system for controlling robot stop.
  • the industrial robot is divided into a robot body and a control system.
  • the robot body and the control system are connected by a power line and a signal line, and the control system outputs a motion track signal for controlling the motion of the robot through the power line output, so that the robot moves according to a certain motion track.
  • the prior art stops the movement of the robot by breaking the contactor. Due to the limited life of the contactor, frequent movements cause it to age rapidly, which brings inconvenience to the later maintenance, and the action noise of the contactor is large, and the user experience is poor.
  • the present invention provides a method, device, storage medium and robot system for controlling robot stop, which prolongs the life of the robot control device, reduces noise, and improves user experience.
  • the first technical solution adopted by the present invention is to provide a control device for a robot, the control device comprising: a logic control circuit, a driving circuit, and a semiconductor gating circuit; the logic control circuit respectively
  • the driving circuit is connected to a control end of the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is used for connecting with an external power source, and the second connection end of the semiconductor gating circuit and the driving circuit
  • the driving circuit is configured to be connected to the robot;
  • the logic control circuit is configured to output a first control signal to the semiconductor gating circuit after receiving the first triggering instruction, and control the semiconductor gating circuit Disconnecting to control the power supply of the drive circuit to turn off the power signal of the robot.
  • the second technical solution adopted by the present invention is to provide a method for controlling the stop of the robot, and the method for controlling the stop of the robot includes: the control device of the robot receives the first trigger command at its logic control circuit And outputting a first control signal to the semiconductor gate circuit thereof; controlling the disconnection of the semiconductor gate circuit according to the first control signal to disconnect the power of the driving circuit of the control device of the robot to cut off a power signal of the robot; wherein the logic control circuit is connected to the control terminal of the driving circuit and the semiconductor gating circuit, respectively, to a first connection end of the semiconductor gating circuit for connection with an external power source, A second connection end of the semiconductor gating circuit is coupled to the driving circuit; the driving circuit is for connecting to the robot.
  • the third technical solution adopted by the present invention is to provide a storage medium on which a computer program is stored, which can be executed to implement the control robot of any of the present invention.
  • the fourth technical solution adopted by the present invention is to provide a robot system including a robot control device, a robot, and an external power source;
  • the robot control device includes a logic control circuit and a drive a circuit and a semiconductor gating circuit;
  • the logic control circuit is respectively connected to the control circuit and the control terminal of the semiconductor gating circuit, and the first connection end of the semiconductor gating circuit is connected to the external power source, a second connection end of the semiconductor gating circuit is connected to the driving circuit;
  • the driving circuit is connected to the robot;
  • the logic control circuit is configured to output to the semiconductor gating circuit after receiving the first triggering instruction
  • a control signal is provided to control the opening of the semiconductor gating circuit to control the power supply of the driving circuit to be turned off to cut off the power signal of the robot.
  • the control device of the robot of the present embodiment includes a semiconductor gating circuit, and the control device of the robot outputs a control signal to the semiconductor gating circuit after receiving the trigger command to control the disconnection of the semiconductor gating circuit.
  • the power supply that controls the drive circuit is disconnected, thereby cutting off the power signal of the robot.
  • the semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
  • FIG. 1 is a schematic structural view of an embodiment of a robot system of the present invention
  • FIG. 2 is a schematic structural view of an embodiment of a control device for a robot in the robot system of FIG. 1;
  • FIG. 3 is a schematic structural view of an embodiment of a control device for a robot according to the present invention.
  • FIG. 4 is a schematic structural view of an embodiment of a method for controlling a robot to stop according to the present invention
  • FIG. 5 is a schematic structural view of an embodiment of a storage medium of the present invention.
  • the present invention provides a method, a device, a storage medium, and a robot system for controlling the stopping of a robot.
  • FIG. 1 is a schematic structural view of an embodiment of a robot system according to the present invention.
  • the robot system 10 includes an external power source 11, a robot control device 12, and a robot 13.
  • the control device 12 of the robot includes a logic control circuit, a driving circuit and a semiconductor gating circuit; the logic control circuit is respectively connected with the driving end of the driving circuit and the semiconductor gating circuit, and the first connection end of the semiconductor gating circuit and the external power source 11
  • the second connection end of the semiconductor gating circuit is connected to the driving circuit; the driving circuit is connected to the robot 13.
  • the logic control circuit is configured to output a first control signal to the semiconductor gate circuit after receiving the first trigger command, and control the disconnection of the semiconductor gate circuit to control the power supply disconnection of the driving circuit to cut off the power of the robot 13 signal.
  • FIG. 2 is a schematic structural view of an embodiment of a control device for a robot in the robot system of FIG.
  • the robot control device 12 of the present embodiment includes a logic control circuit 121, a drive circuit 123, and a semiconductor gate circuit 122.
  • the semiconductor gating circuit 122 includes a thyristor, which is a four-layer high-power semiconductor device having three PN junctions, which can be used for controlled rectification, inverter, frequency conversion, voltage regulation, and no touch. Point switch, etc.
  • the thyristor is used as a switch to control the on and off of the semiconductor gate circuit 122.
  • the thyristor is an electronic device, which not only occupies less hardware resources, but also has no obvious sound when power is off, has low noise, and can effectively reduce the switching current.
  • the logic control circuit 121 is respectively connected to the control terminals of the driving circuit 123 and the semiconductor strobe circuit 122.
  • the first connection end of the semiconductor strobe circuit 122 is connected to the external power source 11, and the second connection end of the semiconductor strobe circuit 122.
  • the drive circuit 123 is connected to the drive circuit 123 for connection to the robot 13.
  • the external power source 11 may be a device that provides a 220V three-phase power supply, and the first connection end of the semiconductor gating circuit 122 is connected to the power line to obtain power.
  • the robot 13 acquires a power signal through the drive circuit 123.
  • the semiconductor gate circuit 122 is turned off, the drive circuit 123 is disconnected from the external power source 11, thereby cutting off the power signal of the robot 13.
  • the signal line of the robot 13 and the power and the brake line are respectively connected to the drive circuit 123.
  • the drive circuit 123 supplies the power source to the robot 13 through the power and the brake line, and the drive circuit 123 outputs the control device 12 of the robot through the signal line.
  • the motion path command is issued to cause the robot 13 to operate according to the motion track command, and the drive circuit 123 can also receive the feedback signal of the robot 13 through the signal line to adjust the motion accuracy of the robot 13 according to the feedback signal in real time.
  • the robot 13 is mainly used in the industrial field, and is a multi-joint robot or a multi-degree-of-freedom machine device, which can automatically perform work to realize a machine of various functions.
  • the robot 13 can be operated according to instructions issued by the user or in accordance with a pre-programmed program.
  • the robot 13 is a point type robot, for example, a robot arm, which can perform operations such as loading and unloading, spot welding, general handling, loading and unloading of the machine tool.
  • the robot 13 is a continuous trajectory robot capable of performing continuous welding and painting operations.
  • the contactor is mainly used to isolate the main circuit of the control system of the robot to the power supply of the drive circuit thereof, thereby stopping the robot.
  • the drive circuit of the robot control system is rapidly deteriorated, which brings inconvenience to the later maintenance.
  • the power of the circuit is switched by the contactor, which is accompanied by a large switching current, which may cause interference to the circuit, thereby affecting the performance of the robot and the control system.
  • the control device 12 of the robot of the present embodiment employs the semiconductor gate circuit 122.
  • the drive circuit 123 cannot receive the power supply signal, thereby failing to the robot 13 Output power signal.
  • the logic control circuit 121 is configured to output a first control signal to the semiconductor gating circuit 122 after receiving the first triggering command, and control the opening of the semiconductor gating circuit 122 to control the power-off of the driving circuit 123 to cut off The power signal of the robot 13.
  • the robot control device 12 outputs a first control signal to its semiconductor gate circuit 122 after its logic control circuit 121 receives the trigger command of the robot 13 in an abnormal state or an emergency state.
  • the triggering command of the robot 13 in an abnormal state or an emergency state may be triggered manually, or may be triggered after the trajectory detector detects that the robot 13 is in an abnormal state or an emergency state.
  • the first stop command is preset in the logic control circuit 101.
  • the logic control circuit 121 issues a first stop command to the drive circuit 123, and the drive circuit 123 follows the preset.
  • the command outputs a corresponding stop signal to cause the robot 13 to stop at the fastest speed.
  • the robot 13 stops at a position deviating from the original trajectory. After a preset time after the robot 13 stops, for example, after the robot 13 stops for 200 ms, the logic control circuit 121 outputs a first control signal to the semiconductor selection.
  • the circuit 122 is configured to disconnect the first connection end of the semiconductor gating circuit 122 from the gating branch where the second connection end is located to isolate the high voltage.
  • the foregoing first triggering command is triggered when the robot 13 is in an abnormal condition or an emergency situation, that is, the stopping operation of the above embodiment is mainly when the robot 13 is in an abnormal state or an emergency state. Being triggered, the robot 13 can be stopped at the fastest speed to cope with an emergency. However, this stop operation not only causes a certain degree of damage to the robot 13, but also the robot 13 cannot stop on the original trajectory.
  • FIG. 3 is a schematic structural diagram of an embodiment of a control device for a robot according to the present invention.
  • the robot control device 201 includes a logic control circuit 2011, a drive circuit 2013, and a semiconductor gate circuit 2012.
  • the logic control circuit 2011 is respectively connected to the control terminals of the driving circuit 2013 and the semiconductor strobe circuit 2012, the first connection end of the semiconductor strobe circuit 2012 is connected to the external power source 203, and the second connection end of the semiconductor strobe circuit 2012 is driven.
  • the circuit 2013 is connected; the drive circuit 2013 is also connected to the robot 202.
  • the robot control device 201 further includes a controller 2014 that is connected to the drive circuit 2013.
  • the controller 2014 is configured to send a second control signal to the driving circuit 2013 when receiving the second triggering instruction, and the driving circuit 2013 controls the robot 202 to stop working according to the preset program according to the second control signal.
  • the driving circuit 2013 includes a driving control circuit 20131 and a driving power circuit 20132, wherein the driving control circuit 20131 is connected to the controller 2014 and the logic control circuit 2011; and the driving power circuit 20132 and the semiconductor strobe circuit 2012 The second connection is connected to receive a power signal; the drive power circuit 20132 is also used to connect with the robot 202.
  • the driving control circuit 20131 is configured to determine a control algorithm matching the control signal according to the control signal of the controller 2014; the driving power circuit 20132 is configured to output a corresponding driving power signal according to the control algorithm, so that the robot 202 stops working according to the driving power signal. .
  • the second triggering command may be triggered by an operator, such as a triggering command that the operator triggers the robot 202 to stop, and the controller 2014 sends the driving command to the driving circuit according to the second triggering instruction.
  • 2013 transmits a second control signal
  • the drive control circuit 20131 in the drive circuit 2013 determines a control algorithm matching the control signal according to the control signal of the controller 2014 and outputs it to the drive power circuit 20132, and the drive power circuit 20132 outputs the corresponding according to the control algorithm.
  • the power signal is driven to cause the robot 202 to stop operating in accordance with the drive power signal.
  • the driving power signal is a PWM pulse width modulation signal.
  • the stop operation of the present embodiment can cause the robot 202 to stop on the original trajectory without causing damage to the robot 202.
  • the controller 2014 sends a first trigger command to the logic control circuit 2011, and the control device 201 of the robot is in its logic control circuit 2011.
  • the first control signal is output to the semiconductor strobe circuit 2012 to enable the logic control semiconductor strobe circuit 2012 to be turned off to control the power supply of the drive circuit 2013 to be disconnected. Thereby, the power signal of the robot 202 is cut off to isolate the high voltage.
  • the first trigger command of the present embodiment is sent by the controller 2014. After the robot 202 stops according to the second control signal, the controller 2014 further issues a first trigger command to isolate the strong power. In order to disconnect the semiconductor gate circuit 2012, the power signal of the robot 202 is turned off.
  • the source of the first trigger command of the present embodiment is different from the source of the first trigger command in the embodiment shown in FIG. 2.
  • the purpose to be achieved by both is the same, which is to disconnect the semiconductor gating circuit 2012, thereby cutting off the power signal of the robot 202.
  • the control device of the robot of the present embodiment includes a semiconductor gating circuit, and after the control device of the robot receives the trigger command, outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control the driving.
  • the power to the circuit is broken, thereby cutting off the power signal of the robot.
  • the semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
  • FIG. 4 is a schematic structural diagram of an embodiment of a method for controlling a robot to stop in accordance with the present invention.
  • the method of controlling the robot to stop in the present embodiment is applied to the control device of the robot according to any of the above embodiments.
  • the method for controlling the stopping of the robot of the embodiment includes:
  • the control device of the robot outputs a first control signal to its semiconductor gating circuit after its logic control circuit receives the first trigger command.
  • the control device for the robot of the present embodiment includes a logic control circuit, a drive circuit, and a semiconductor gate circuit.
  • the semiconductor gating circuit comprises a thyristor, which is a four-layer high-power semiconductor device with three PN junctions, which can be used for controlled rectification, inverter, frequency conversion, voltage regulation, and no contact. Switch, etc.
  • a thyristor is used as a switch to control the on and off of the semiconductor strobe circuit.
  • the thyristor is an electronic device, which not only occupies less hardware resources, but also has no obvious sound when power is off, has low noise, and can effectively reduce the switching current.
  • the logic control circuit is respectively connected to the control terminal of the driving circuit and the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is connected to the external power source, the second connection end of the semiconductor gating circuit is connected to the driving circuit, and the driving circuit is further Connected to the robot.
  • the external power source may be a device that provides a 220V three-phase power supply, and the first connection end of the semiconductor strobe circuit is connected to the power line to obtain power.
  • the signal line of the robot and the power and the brake line are respectively connected to the driving circuit, and the driving circuit supplies the power source to the robot through the power and the brake line, and the driving circuit outputs the motion track command issued by the control device of the robot through the signal line.
  • the robot is caused to operate according to the motion trajectory, and the driving circuit can also receive the feedback signal of the robot through the signal line to adjust the motion precision of the robot according to the feedback signal in real time.
  • the main application and industrial field of robots are multi-joint robots or multi-degree-of-freedom machine devices, which can automatically perform work to realize a machine of various functions.
  • the robot can be run according to the instructions issued by the user, or it can be run according to a pre-programmed program.
  • the robot is a point-type robot, for example, a robot arm, which can perform operations such as loading and unloading, spot welding, general handling, loading and unloading of the machine tool.
  • the robot is a continuous trajectory robot capable of performing continuous welding and painting operations.
  • the contactor is mainly used to isolate the main circuit of the control system of the robot to the power supply of the drive circuit thereof, thereby stopping the robot.
  • the drive circuit of the robot control system is rapidly aging, which brings inconvenience to the later maintenance; on the other hand, the contactor is a physical button, which not only has a large motion noise, but also affects the user experience, and There are security risks.
  • the power of the circuit is switched by the contactor, which is accompanied by a large switching current, which may cause interference to the circuit, thereby affecting the performance of the robot and the control system.
  • the control device for the robot of the present embodiment employs a semiconductor gate circuit.
  • the gate branch of the semiconductor gate circuit is turned off, the drive circuit cannot receive the power supply signal, and thus the power signal cannot be output to the robot.
  • the logic control circuit After the logic control circuit receives the first trigger command, the logic control circuit sends a stop command to the drive circuit to stop the robot; after the robot stops, the logic control circuit goes to the control device of the robot.
  • the semiconductor gating circuit outputs a first control signal.
  • the first triggering command is an instruction that is triggered when the robot is in an abnormal state or an emergency state, and the abnormal state or emergency state may be artificially triggered, or the trajectory detector may detect that the robot is in the Triggered after an abnormal state or emergency.
  • the control device of the robot controls the disconnection of the semiconductor gate circuit in accordance with the first control signal to turn off the power of the drive circuit of the control device of the robot to cut off the power signal of the robot.
  • the first control signal is an enable signal for controlling the on and off of the semiconductor gating circuit, such as a high level or a low level.
  • the first stop instruction is preset in the logic control circuit, and when the robot is in an abnormal state or an emergency state, for example, when the track detector detects that the robot encounters an unexpected situation, such as when the actual track deviates from the preset track, the logic control The circuit issues a first stop command to the drive circuit, and the drive circuit outputs a corresponding stop signal according to a preset command to stop the robot at the fastest speed.
  • the robot stops at a position deviating from the original trajectory.
  • the logic control circuit outputs a first control signal to the semiconductor strobe circuit to The first connection end of the semiconductor gating circuit is disconnected from the gating branch where the second connection end is located to isolate the high voltage.
  • the foregoing first triggering command is triggered when the robot 13 is in an abnormal condition or an emergency situation, that is, the stopping operation of the above embodiment is mainly when the robot 13 is in an abnormal state or an emergency state. Triggered to stop the robot at the fastest speed in response to an emergency. However, this stop operation not only causes a certain degree of damage to the robot, but also the robot cannot stop on the original trajectory.
  • control device of the robot further includes a controller, and the controller is connected to the drive circuit.
  • the controller is configured to send a second control signal to the driving circuit when receiving the second triggering instruction, and the driving circuit controls the robot to stop working according to the preset program according to the second control signal.
  • the driving circuit includes a driving control circuit and a driving power circuit, wherein the driving control circuit is connected to the controller; the driving power circuit is connected to the second connection end of the semiconductor gating circuit to receive the power signal; The power circuit is also connected to the robot.
  • the driving control circuit determines a control algorithm matching the control signal according to the control signal of the controller; the driving power circuit outputs a corresponding driving power signal according to the control algorithm, so that the robot stops working according to the driving power signal.
  • the second triggering command may be triggered by an operator, for example, the operator triggering is a triggering instruction of the robot stopping, and the controller sends the driving command to the driving circuit according to the second triggering instruction.
  • the drive control circuit in the drive circuit determines a control algorithm matching the control signal according to the control signal of the controller and outputs the control algorithm to the drive power circuit, and the drive power circuit outputs a corresponding drive power signal according to the control algorithm to make the robot Stop working according to the drive power signal.
  • the driving power signal is a PWM pulse width modulation signal.
  • the stop operation of the present embodiment can stop the robot on the original trajectory without causing damage to the robot.
  • the controller sends a first trigger command to the logic control circuit, and the control device of the robot receives the controller at its logic control circuit. After transmitting the first triggering instruction, outputting a first control signal to the semiconductor strobe circuit, so that the logic control circuit outputs a corresponding control signal to the semiconductor strobe circuit to control the opening of the semiconductor strobe circuit to control the driving circuit. The power is turned off, thereby cutting off the power signal of the robot to isolate the strong electricity.
  • the first trigger command of the embodiment is sent by the controller. After the robot stops according to the second control signal, in order to isolate the strong power, the controller further issues a first trigger command to break.
  • the semiconductor gate circuit is turned on, thereby cutting off the power signal of the robot.
  • the source of the first trigger command of the present embodiment is different from the source of the first trigger command triggered by the robot being in an abnormal condition or an emergency. But the purpose of the two is the same, both disconnect the semiconductor gating circuit, and thus cut off the power signal of the robot.
  • the control device of the robot of the present embodiment includes a semiconductor gating circuit. After receiving the trigger command, the control device of the robot outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control The power of the drive circuit is disconnected, thereby cutting off the power signal of the robot.
  • the semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
  • FIG. 5 is a schematic structural diagram of an embodiment of a storage medium according to the present invention.
  • at least one computer program 501 is stored in the storage medium 50.
  • the program 501 is for executing a method of controlling the stopping of the robot in any of the above embodiments.
  • the storage medium 50 may be a storage chip, a hard disk, or a portable hard disk or other readable and writable storage tools such as a USB flash drive or an optical disk, and may be a server or the like, which is not specifically limited herein.
  • the control device of the robot of the present embodiment includes a semiconductor gating circuit. After receiving the trigger command, the control device of the robot outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control The power of the drive circuit is disconnected, thereby cutting off the power signal of the robot.
  • the semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
  • the disclosed methods and apparatus may be implemented in other manners.
  • the device implementations described above are merely illustrative.
  • the division of modules or units is only a logical function division.
  • multiple units or components may be combined or integrated. Go to another system, or some features can be ignored or not executed.
  • the mutual coupling or direct coupling or communication connection shown or discussed may be an indirect coupling or communication connection through some interface, device or unit, and may be in an electrical, mechanical or other form.
  • the units described as separate components may or may not be physically separate, and the components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of the present embodiment.
  • each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
  • the above integrated unit can be implemented in the form of hardware or in the form of a software functional unit.
  • An integrated unit, if implemented in the form of a software functional unit and sold or used as a standalone product, can be stored in a computer readable storage medium.
  • the technical solution of the present application in essence or the contribution to the prior art, or all or part of the technical solution may be embodied in the form of a software product stored in a storage medium.
  • a number of instructions are included to cause a computer device (which may be a personal computer, server, or network device, etc.) or a processor to perform all or part of the steps of the various embodiments of the present application.
  • the foregoing storage medium includes: a U disk, a mobile hard disk, a read only memory (ROM, Read-Only) Memory, random access memory (RAM), disk or optical disk, and other media that can store program code.

Abstract

Disclosed are a method and device for controlling a robot to stop, a storage medium, and a robot system. The robot control device comprises a logic control circuit, a driving circuit, and a semiconductor gating circuit. The logic control circuit is connected to control terminals of the driving circuit and the semiconductor gating circuit. A first connection end of the semiconductor gating circuit is connected to an external power source. A second connection end of the semiconductor gating circuit is connected to the driving circuit. The driving circuit is also connected to a robot. The logic control circuit is used to output a first control signal to the semiconductor gating circuit after receiving a first trigger instruction, and controls a disconnection of the semiconductor gating circuit, so as to control the driving circuit to disconnect from a power source, thereby cutting off a power signal of the robot. The robot control device of the present invention has an extended service life and reduced noise, thereby improving the user experience.

Description

控制机器人停止的方法、装置、存储介质及机器人系统 Method, device, storage medium and robot system for controlling robot stop
【技术领域】[Technical Field]
本发明涉及工业机器人领域,特别是涉及一种控制机器人停止的方法、装置、存储介质及机器人系统。The present invention relates to the field of industrial robots, and in particular to a method, device, storage medium and robot system for controlling robot stop.
【背景技术】 【Background technique】
目前,机器人已应用到各个领域,比如工业领域。工业机器人分为机器人本体和控制系统,机器人本体与控制系统通过动力线与信号线连接,控制系统通过动力线输出控制机器人运动的运动轨迹信号,以使机器人按照一定的运动轨迹运动。At present, robots have been applied to various fields, such as the industrial field. The industrial robot is divided into a robot body and a control system. The robot body and the control system are connected by a power line and a signal line, and the control system outputs a motion track signal for controlling the motion of the robot through the power line output, so that the robot moves according to a certain motion track.
为了保证机器人能够安全停止,现有技术是通过断开接触器,从而使机器人停止运动。由于接触器寿命有限,频繁的动作会使其迅速老化,给后期维护带来不便,且接触器的动作噪音较大,用户体验差。In order to ensure that the robot can be safely stopped, the prior art stops the movement of the robot by breaking the contactor. Due to the limited life of the contactor, frequent movements cause it to age rapidly, which brings inconvenience to the later maintenance, and the action noise of the contactor is large, and the user experience is poor.
【发明内容】 [Summary of the Invention]
为解决上述问题,本发明提供了一种控制机器人停止的方法、装置、存储介质及机器人系统,延长了机器人的控制装置的寿命,减小噪声,提高了用户体验。In order to solve the above problems, the present invention provides a method, device, storage medium and robot system for controlling robot stop, which prolongs the life of the robot control device, reduces noise, and improves user experience.
为解决上述技术问题,本发明采用的第一个技术方案是:提供一种机器人的控制装置,所述控制装置包括:逻辑控制电路、驱动电路以及半导体选通电路;所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接,所述半导体选通电路的第一连接端用于与外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路用于与所述机器人连接;所述逻辑控制电路用于在接收到第一触发指令后向所述半导体选通电路输出第一控制信号,控制所述半导体选通电路的断开以控制所述驱动电路的电源断开,以切断所述机器人的动力信号。In order to solve the above technical problem, the first technical solution adopted by the present invention is to provide a control device for a robot, the control device comprising: a logic control circuit, a driving circuit, and a semiconductor gating circuit; the logic control circuit respectively The driving circuit is connected to a control end of the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is used for connecting with an external power source, and the second connection end of the semiconductor gating circuit and the driving circuit The driving circuit is configured to be connected to the robot; the logic control circuit is configured to output a first control signal to the semiconductor gating circuit after receiving the first triggering instruction, and control the semiconductor gating circuit Disconnecting to control the power supply of the drive circuit to turn off the power signal of the robot.
为解决上述技术问题,本发明采用的第二个技术方案是:提供一种控制机器人停止的方法,所述控制机器人停止的方法包括:机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号;根据所述第一控制信号控制所述半导体选通电路的断开,以使所述机器人的控制装置的驱动电路的电源断开,以切断所述机器人的动力信号;其中,所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接所述半导体选通电路的第一连接端用于与外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路用于与所述机器人连接。In order to solve the above technical problem, the second technical solution adopted by the present invention is to provide a method for controlling the stop of the robot, and the method for controlling the stop of the robot includes: the control device of the robot receives the first trigger command at its logic control circuit And outputting a first control signal to the semiconductor gate circuit thereof; controlling the disconnection of the semiconductor gate circuit according to the first control signal to disconnect the power of the driving circuit of the control device of the robot to cut off a power signal of the robot; wherein the logic control circuit is connected to the control terminal of the driving circuit and the semiconductor gating circuit, respectively, to a first connection end of the semiconductor gating circuit for connection with an external power source, A second connection end of the semiconductor gating circuit is coupled to the driving circuit; the driving circuit is for connecting to the robot.
为解决上述技术问题,本发明采用的第三个技术方案是:提供一种存储介质,所述存储介质上存储有计算机程序,所述程序能够被执行实现本发明任一所述的控制机器人停止的方法。In order to solve the above technical problem, the third technical solution adopted by the present invention is to provide a storage medium on which a computer program is stored, which can be executed to implement the control robot of any of the present invention. Methods.
为解决上述技术问题,本发明采用的第四个技术方案是:提供一种机器人系统,所述机器人系统包括机器人的控制装置、机器人以及外部电源;所述机器人的控制装置包括逻辑控制电路、驱动电路以及半导体选通电路;所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接,所述半导体选通电路的第一连接端与所述外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路与所述机器人连接;所述逻辑控制电路用于在接收到第一触发指令后向所述半导体选通电路输出第一控制信号,控制所述半导体选通电路的断开以控制所述驱动电路的电源断开,以切断所述机器人的动力信号。In order to solve the above technical problem, the fourth technical solution adopted by the present invention is to provide a robot system including a robot control device, a robot, and an external power source; the robot control device includes a logic control circuit and a drive a circuit and a semiconductor gating circuit; the logic control circuit is respectively connected to the control circuit and the control terminal of the semiconductor gating circuit, and the first connection end of the semiconductor gating circuit is connected to the external power source, a second connection end of the semiconductor gating circuit is connected to the driving circuit; the driving circuit is connected to the robot; the logic control circuit is configured to output to the semiconductor gating circuit after receiving the first triggering instruction A control signal is provided to control the opening of the semiconductor gating circuit to control the power supply of the driving circuit to be turned off to cut off the power signal of the robot.
本发明的有益效果是:本实施方式的机器人的控制装置包括半导体选通电路,在机器人的控制装置在接收到触发指令后向半导体选通电路输出控制信号,控制半导体选通电路的断开以控制驱动电路的电源断开,从而切断机器人的动力信号。半导体选通电路根据控制信号断开选通支路,从而断开电源,可避免由于人员操作而带来的安全隐患,同时,可延长机器人的控制装置的寿命,另一方面减小电源切换过程中的噪声,提高用户体验。The beneficial effects of the present invention are that the control device of the robot of the present embodiment includes a semiconductor gating circuit, and the control device of the robot outputs a control signal to the semiconductor gating circuit after receiving the trigger command to control the disconnection of the semiconductor gating circuit. The power supply that controls the drive circuit is disconnected, thereby cutting off the power signal of the robot. The semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
【附图说明】 [Description of the Drawings]
图1是本发明机器人系统一实施方式的结构示意图;1 is a schematic structural view of an embodiment of a robot system of the present invention;
图2是图1机器人系统中机器人的控制装置一实施方式的结构示意图;2 is a schematic structural view of an embodiment of a control device for a robot in the robot system of FIG. 1;
图3是本发明机器人的控制装置一实施方式的结构示意图;3 is a schematic structural view of an embodiment of a control device for a robot according to the present invention;
图4是本发明控制机器人停止的方法一实施方式的结构示意图;4 is a schematic structural view of an embodiment of a method for controlling a robot to stop according to the present invention;
图5是本发明存储介质一实施方式的结构示意图。FIG. 5 is a schematic structural view of an embodiment of a storage medium of the present invention.
【具体实施方式】【Detailed ways】
本发明提供一种控制机器人停止的方法、装置、存储介质及机器人系统,为使本发明的目的、技术方案和技术效果更加明确、清楚,以下对本发明进一步详细说明,应当理解此处所描述的具体实施条例仅用于解释本发明,并不用于限定本发明。The present invention provides a method, a device, a storage medium, and a robot system for controlling the stopping of a robot. To clarify and clarify the objects, technical solutions, and technical effects of the present invention, the present invention will be further described in detail below, and the specific embodiments described herein should be understood. The implementation of the invention is intended to be illustrative only and not to limit the invention.
参阅图1,图1是本发明机器人系统一实施方式的结构示意图,该机器人系统10包括外部电源11、机器人的控制装置12以及机器人13。Referring to FIG. 1, FIG. 1 is a schematic structural view of an embodiment of a robot system according to the present invention. The robot system 10 includes an external power source 11, a robot control device 12, and a robot 13.
其中,机器人的控制装置12包括逻辑控制电路、驱动电路以及半导体选通电路;逻辑控制电路分别与驱动电路和半导体选通电路的控制端连接,半导体选通电路的第一连接端与外部电源11连接,半导体选通电路的第二连接端与驱动电路连接;驱动电路与机器人13连接。The control device 12 of the robot includes a logic control circuit, a driving circuit and a semiconductor gating circuit; the logic control circuit is respectively connected with the driving end of the driving circuit and the semiconductor gating circuit, and the first connection end of the semiconductor gating circuit and the external power source 11 The second connection end of the semiconductor gating circuit is connected to the driving circuit; the driving circuit is connected to the robot 13.
具体地,逻辑控制电路用于在接收到第一触发指令后向半导体选通电路输出第一控制信号,控制半导体选通电路的断开以控制驱动电路的电源断开,以切断机器人13的动力信号。Specifically, the logic control circuit is configured to output a first control signal to the semiconductor gate circuit after receiving the first trigger command, and control the disconnection of the semiconductor gate circuit to control the power supply disconnection of the driving circuit to cut off the power of the robot 13 signal.
为了清楚的说明上述实施方式的机器人的控制装置12的具体结构,请参阅图2,图2是图1机器人系统中机器人的控制装置一实施方式的结构示意图。In order to clearly explain the specific structure of the control device 12 of the robot of the above embodiment, please refer to FIG. 2, which is a schematic structural view of an embodiment of a control device for a robot in the robot system of FIG.
如图2所示,本实施方式的机器人的控制装置12包括:逻辑控制电路121、驱动电路123以及半导体选通电路122。As shown in FIG. 2, the robot control device 12 of the present embodiment includes a logic control circuit 121, a drive circuit 123, and a semiconductor gate circuit 122.
其中,半导体选通电路122包括可控硅,可控硅是一种具有三个PN结的四层结构的大功率半导体器件,可用来作可控整流、逆变、变频、调压、无触点开关等。在本实施方式中,利用可控硅作为开关,以控制半导体选通电路122的通断。可控硅为电子器件,不仅体积小所占用的硬件资源较少,而且在断电时无明显声响,噪音较小,且能够有效降低开关电流。The semiconductor gating circuit 122 includes a thyristor, which is a four-layer high-power semiconductor device having three PN junctions, which can be used for controlled rectification, inverter, frequency conversion, voltage regulation, and no touch. Point switch, etc. In the present embodiment, the thyristor is used as a switch to control the on and off of the semiconductor gate circuit 122. The thyristor is an electronic device, which not only occupies less hardware resources, but also has no obvious sound when power is off, has low noise, and can effectively reduce the switching current.
其中,逻辑控制电路121分别与驱动电路123和半导体选通电路122的控制端连接,半导体选通电路122的第一连接端用于与外部电源11连接,半导体选通电路122的第二连接端与驱动电路123连接,驱动电路123用于与机器人13连接。The logic control circuit 121 is respectively connected to the control terminals of the driving circuit 123 and the semiconductor strobe circuit 122. The first connection end of the semiconductor strobe circuit 122 is connected to the external power source 11, and the second connection end of the semiconductor strobe circuit 122. The drive circuit 123 is connected to the drive circuit 123 for connection to the robot 13.
其中,外部电源11可以为提供220V三相电源的设备,半导体选通电路122的第一连接端与电源线连接,以获取电源。当半导体选通电路122的选通支路连通时,即半导体选通电路122的第一连接端与第二连接端连通时,机器人13通过驱动电路123获取动力信号。而当半导体选通电路122断开时,驱动电路123与外部电源11断开,进而切断了机器人13的动力信号。The external power source 11 may be a device that provides a 220V three-phase power supply, and the first connection end of the semiconductor gating circuit 122 is connected to the power line to obtain power. When the strobe branch of the semiconductor strobe circuit 122 is in communication, that is, when the first connection end of the semiconductor strobe circuit 122 is in communication with the second connection terminal, the robot 13 acquires a power signal through the drive circuit 123. When the semiconductor gate circuit 122 is turned off, the drive circuit 123 is disconnected from the external power source 11, thereby cutting off the power signal of the robot 13.
具体地,机器人13的信号线以及动力与抱闸线分别与驱动电路123连接,驱动电路123通过动力与抱闸线向机器人13提供动力源,驱动电路123通过信号线输出机器人的控制装置12所发出的运动轨迹指令以使机器人13按照该运动轨迹指令运行,同时驱动电路123也可通过信号线接收机器人13的反馈信号,以实时根据该反馈信号调节机器人13的运动精度。Specifically, the signal line of the robot 13 and the power and the brake line are respectively connected to the drive circuit 123. The drive circuit 123 supplies the power source to the robot 13 through the power and the brake line, and the drive circuit 123 outputs the control device 12 of the robot through the signal line. The motion path command is issued to cause the robot 13 to operate according to the motion track command, and the drive circuit 123 can also receive the feedback signal of the robot 13 through the signal line to adjust the motion accuracy of the robot 13 according to the feedback signal in real time.
目前,机器人13主要应用于工业领域,是多关节机械手或多自由度的机器装置,它能自动执行工作,来实现各种功能的一种机器。机器人13可以根据用户所发出的指令运行,也可以按照预先编排的程序运行。At present, the robot 13 is mainly used in the industrial field, and is a multi-joint robot or a multi-degree-of-freedom machine device, which can automatically perform work to realize a machine of various functions. The robot 13 can be operated according to instructions issued by the user or in accordance with a pre-programmed program.
在一个具体地应用场景中,机器人13为点位型机器人,比如,机器人手臂,能够完成机床上下料、点焊和一般搬运、装卸等作业。在另一个应用场景中,机器人13为连续轨迹型机器人,能够完成连续焊接和涂装等作业。In a specific application scenario, the robot 13 is a point type robot, for example, a robot arm, which can perform operations such as loading and unloading, spot welding, general handling, loading and unloading of the machine tool. In another application scenario, the robot 13 is a continuous trajectory robot capable of performing continuous welding and painting operations.
目前,为了满足机器人的安全停止的需求,主要是采用接触器,以隔离机器人的控制系统的主电路向其驱动电路的动力电源输出,从而使机器人停止。但是由于接触器的寿命有限且频繁的动作会使机器人控制系统的驱动电路迅速老化,给后期的维护带来不便。同时通过接触器切换电路的电源时会伴随较大的开关电流,会对电路造成干扰,进而影响机器人和控制系统的性能。At present, in order to meet the needs of the safe stop of the robot, the contactor is mainly used to isolate the main circuit of the control system of the robot to the power supply of the drive circuit thereof, thereby stopping the robot. However, due to the limited life of the contactor and frequent movements, the drive circuit of the robot control system is rapidly deteriorated, which brings inconvenience to the later maintenance. At the same time, the power of the circuit is switched by the contactor, which is accompanied by a large switching current, which may cause interference to the circuit, thereby affecting the performance of the robot and the control system.
为了解决上述问题,本实施方式的机器人的控制装置12采用半导体选通电路122,当半导体选通电路122的选通支路断开时,驱动电路123无法接收到电源信号,从而无法向机器人13输出动力信号。In order to solve the above problem, the control device 12 of the robot of the present embodiment employs the semiconductor gate circuit 122. When the gate branch of the semiconductor gate circuit 122 is turned off, the drive circuit 123 cannot receive the power supply signal, thereby failing to the robot 13 Output power signal.
具体地,逻辑控制电路121用于在接收到第一触发指令后向半导体选通电路122输出第一控制信号,控制半导体选通电路122的断开以控制驱动电路123的电源断开,以切断机器人13的动力信号。Specifically, the logic control circuit 121 is configured to output a first control signal to the semiconductor gating circuit 122 after receiving the first triggering command, and control the opening of the semiconductor gating circuit 122 to control the power-off of the driving circuit 123 to cut off The power signal of the robot 13.
在其中的一个实施方式中,机器人的控制装置12在其逻辑控制电路121接收到机器人13处于异常状态或紧急状态的触发指令后,向其半导体选通电路122输出第一控制信号。在一个实际的应用场景中,机器人13处于异常状态或紧急状态的触发指令可以是人为触发的,也可以是由轨迹检测器检测到机器人13处于异常状态或紧急状态后而触发的。In one of the embodiments, the robot control device 12 outputs a first control signal to its semiconductor gate circuit 122 after its logic control circuit 121 receives the trigger command of the robot 13 in an abnormal state or an emergency state. In a practical application scenario, the triggering command of the robot 13 in an abnormal state or an emergency state may be triggered manually, or may be triggered after the trajectory detector detects that the robot 13 is in an abnormal state or an emergency state.
具体地,逻辑控制电路101中预设有第一停止指令,当机器人13遭遇突发异常情况,比如故障时,逻辑控制电路121发出第一停止指令给驱动电路123,驱动电路123按照预设的指令输出对应的停止信号,以使机器人13按照最快的速度停止。Specifically, the first stop command is preset in the logic control circuit 101. When the robot 13 encounters a sudden abnormal condition, such as a fault, the logic control circuit 121 issues a first stop command to the drive circuit 123, and the drive circuit 123 follows the preset. The command outputs a corresponding stop signal to cause the robot 13 to stop at the fastest speed.
在本实施方式中,机器人13会停止在偏离原轨迹的位置上,当机器人13停止后的预设时间内,比如,在机器人13停止200ms后,逻辑控制电路121输出第一控制信号给半导体选通电路122,以使该半导体选通电路122的第一连接端与第二连接端所在的选通支路断开,以隔离强电。In the present embodiment, the robot 13 stops at a position deviating from the original trajectory. After a preset time after the robot 13 stops, for example, after the robot 13 stops for 200 ms, the logic control circuit 121 outputs a first control signal to the semiconductor selection. The circuit 122 is configured to disconnect the first connection end of the semiconductor gating circuit 122 from the gating branch where the second connection end is located to isolate the high voltage.
在此,需要说明的是,前述的第一触发指令是当机器人13处于异常状况或紧急状况时才被触发,即,上述实施方式的停止操作主要是当机器人13处于异常状况或紧急状况时才被触发,能够使机器人13按照最快的速度停止,以应对紧急情况。但是这种停止操作不仅会对机器人13造成一定程度的损害,而且机器人13无法停止在原轨迹上。Here, it should be noted that the foregoing first triggering command is triggered when the robot 13 is in an abnormal condition or an emergency situation, that is, the stopping operation of the above embodiment is mainly when the robot 13 is in an abnormal state or an emergency state. Being triggered, the robot 13 can be stopped at the fastest speed to cope with an emergency. However, this stop operation not only causes a certain degree of damage to the robot 13, but also the robot 13 cannot stop on the original trajectory.
进一步地,参阅图3,图3是本发明机器人的控制装置一实施方式的结构示意图。在本实施方式中,机器人的控制装置201包括逻辑控制电路2011、驱动电路2013以及半导体选通电路2012。Further, referring to FIG. 3, FIG. 3 is a schematic structural diagram of an embodiment of a control device for a robot according to the present invention. In the present embodiment, the robot control device 201 includes a logic control circuit 2011, a drive circuit 2013, and a semiconductor gate circuit 2012.
其中,逻辑控制电路2011分别与驱动电路2013和半导体选通电路2012的控制端连接,半导体选通电路2012的第一连接端与外部电源203连接,半导体选通电路2012的第二连接端与驱动电路2013连接;驱动电路2013还与机器人202连接。The logic control circuit 2011 is respectively connected to the control terminals of the driving circuit 2013 and the semiconductor strobe circuit 2012, the first connection end of the semiconductor strobe circuit 2012 is connected to the external power source 203, and the second connection end of the semiconductor strobe circuit 2012 is driven. The circuit 2013 is connected; the drive circuit 2013 is also connected to the robot 202.
在本实施方式中,机器人的控制装置201还包括控制器2014,控制器2014与驱动电路2013连接。In the present embodiment, the robot control device 201 further includes a controller 2014 that is connected to the drive circuit 2013.
具体地,控制器2014用于在接收到第二触发指令时,向驱动电路2013发送第二控制信号,驱动电路2013控制机器人202根据第二控制信号按照预设程序停止工作。Specifically, the controller 2014 is configured to send a second control signal to the driving circuit 2013 when receiving the second triggering instruction, and the driving circuit 2013 controls the robot 202 to stop working according to the preset program according to the second control signal.
在其中的一个实施方式中,驱动电路2013包括驱动控制电路20131以及驱动功率电路20132,其中,驱动控制电路20131与控制器2014和逻辑控制电路2011连接;驱动功率电路20132与半导体选通电路2012的第二连接端连接,以接收电源信号;驱动功率电路20132还用于与机器人202连接。In one embodiment, the driving circuit 2013 includes a driving control circuit 20131 and a driving power circuit 20132, wherein the driving control circuit 20131 is connected to the controller 2014 and the logic control circuit 2011; and the driving power circuit 20132 and the semiconductor strobe circuit 2012 The second connection is connected to receive a power signal; the drive power circuit 20132 is also used to connect with the robot 202.
驱动控制电路20131用于根据控制器2014的控制信号确定与该控制信号相匹配的控制算法;驱动功率电路20132用于按照控制算法输出对应的驱动功率信号,以使机器人202按照驱动功率信号停止工作。The driving control circuit 20131 is configured to determine a control algorithm matching the control signal according to the control signal of the controller 2014; the driving power circuit 20132 is configured to output a corresponding driving power signal according to the control algorithm, so that the robot 202 stops working according to the driving power signal. .
具体地,控制器2014在接收第二触发指令后,其中,第二触发指令可以是操作人员触发的,比如操作人员触发机器人202停止的触发指令,控制器2014根据该第二触发指令向驱动电路2013发送第二控制信号,驱动电路2013中的驱动控制电路20131根据控制器2014的控制信号确定与控制信号相匹配的控制算法并输出给驱动功率电路20132,驱动功率电路20132按照控制算法输出对应的驱动功率信号,以使机器人202按照驱动功率信号停止工作。其中,驱动功率信号为PWM脉冲宽度调制信号。Specifically, after receiving the second triggering instruction, the second triggering command may be triggered by an operator, such as a triggering command that the operator triggers the robot 202 to stop, and the controller 2014 sends the driving command to the driving circuit according to the second triggering instruction. 2013 transmits a second control signal, and the drive control circuit 20131 in the drive circuit 2013 determines a control algorithm matching the control signal according to the control signal of the controller 2014 and outputs it to the drive power circuit 20132, and the drive power circuit 20132 outputs the corresponding according to the control algorithm. The power signal is driven to cause the robot 202 to stop operating in accordance with the drive power signal. The driving power signal is a PWM pulse width modulation signal.
本实施方式的停止操作可以使机器人202停止在原轨迹上,且不会对机器人202造成损害。The stop operation of the present embodiment can cause the robot 202 to stop on the original trajectory without causing damage to the robot 202.
在另一个实施方式中,为了隔离强电,区别于上述实施方式,在机器人202停止之后,控制器2014会向逻辑控制电路2011发出第一触发指令,机器人的控制装置201在其逻辑控制电路2011接收到控制器2014所发送的第一触发指令后,向其半导体选通电路2012输出第一控制信号,以使逻控制半导体选通电路2012的断开,以控制驱动电路2013的电源断开,从而切断机器人202的动力信号,以隔离强电。In another embodiment, in order to isolate the high voltage, different from the above embodiment, after the robot 202 stops, the controller 2014 sends a first trigger command to the logic control circuit 2011, and the control device 201 of the robot is in its logic control circuit 2011. After receiving the first trigger command sent by the controller 2014, the first control signal is output to the semiconductor strobe circuit 2012 to enable the logic control semiconductor strobe circuit 2012 to be turned off to control the power supply of the drive circuit 2013 to be disconnected. Thereby, the power signal of the robot 202 is cut off to isolate the high voltage.
在此,需要说明的是,本实施方式的第一触发指令是由控制器2014发出的,在机器人202按照第二控制信号停止后,为了隔离强电,控制器2014会进一步发出第一触发指令,以断开半导体选通电路2012,进而切断机器人202的动力信号。Here, it should be noted that the first trigger command of the present embodiment is sent by the controller 2014. After the robot 202 stops according to the second control signal, the controller 2014 further issues a first trigger command to isolate the strong power. In order to disconnect the semiconductor gate circuit 2012, the power signal of the robot 202 is turned off.
即,本实施方式的第一触发指令的来源与图2所示的实施方式中的第一触发指令的来源是不相同的。但两者所要达到的目的是一样的,均是断开半导体选通电路2012,进而切断机器人202的动力信号。That is, the source of the first trigger command of the present embodiment is different from the source of the first trigger command in the embodiment shown in FIG. 2. However, the purpose to be achieved by both is the same, which is to disconnect the semiconductor gating circuit 2012, thereby cutting off the power signal of the robot 202.
区别于现有技术,本实施方式的机器人的控制装置包括半导体选通电路,在机器人的控制装置接收到触发指令后向半导体选通电路输出控制信号,控制半导体选通电路的断开以控制驱动电路的电源断开,从而切断机器人的动力信号。半导体选通电路根据控制信号断开选通支路,从而断开电源,可避免由于人员操作而带来的安全隐患,同时,可延长机器人的控制装置的寿命,另一方面减小电源切换过程中的噪声,提高用户体验。Different from the prior art, the control device of the robot of the present embodiment includes a semiconductor gating circuit, and after the control device of the robot receives the trigger command, outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control the driving. The power to the circuit is broken, thereby cutting off the power signal of the robot. The semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
参阅图4,图4是本发明控制机器人停止的方法一实施方式的结构示意图。本实施方式的控制机器人停止的方法适用于上述任一实施方式的机器人的控制装置。本实施方式的控制机器人停止的方法包括:Referring to FIG. 4, FIG. 4 is a schematic structural diagram of an embodiment of a method for controlling a robot to stop in accordance with the present invention. The method of controlling the robot to stop in the present embodiment is applied to the control device of the robot according to any of the above embodiments. The method for controlling the stopping of the robot of the embodiment includes:
401:机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号。401: The control device of the robot outputs a first control signal to its semiconductor gating circuit after its logic control circuit receives the first trigger command.
本实施方式的机器人的控制装置包括:逻辑控制电路、驱动电路以及半导体选通电路。The control device for the robot of the present embodiment includes a logic control circuit, a drive circuit, and a semiconductor gate circuit.
其中,半导体选通电路包括可控硅,可控硅是一种具有三个PN结的四层结构的大功率半导体器件,可用来作可控整流、逆变、变频、调压、无触点开关等。在本实施方式中,利用可控硅作为开关,以控制半导体选通电路的通断。可控硅为电子器件,不仅体积小所占用的硬件资源较小,而且在断电时无明显声响,噪音较小,且能够有效降低开关电流。The semiconductor gating circuit comprises a thyristor, which is a four-layer high-power semiconductor device with three PN junctions, which can be used for controlled rectification, inverter, frequency conversion, voltage regulation, and no contact. Switch, etc. In the present embodiment, a thyristor is used as a switch to control the on and off of the semiconductor strobe circuit. The thyristor is an electronic device, which not only occupies less hardware resources, but also has no obvious sound when power is off, has low noise, and can effectively reduce the switching current.
其中,逻辑控制电路分别与驱动电路和半导体选通电路的控制端连接,半导体选通电路的第一连接端与外部电源连接,半导体选通电路的第二连接端与驱动电路连接,驱动电路还与机器人连接。Wherein, the logic control circuit is respectively connected to the control terminal of the driving circuit and the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is connected to the external power source, the second connection end of the semiconductor gating circuit is connected to the driving circuit, and the driving circuit is further Connected to the robot.
其中,外部电源可以为提供220V三相电源的设备,半导体选通电路的第一连接端与电源线连接,以获取电源。The external power source may be a device that provides a 220V three-phase power supply, and the first connection end of the semiconductor strobe circuit is connected to the power line to obtain power.
具体地,机器人的信号线以及动力与抱闸线分别与驱动电路连接,驱动电路通过动力与抱闸线向机器人提供动力源,驱动电路通过信号线输出机器人的控制装置所发出的运动轨迹指令以使机器人按照该运动轨迹指令运行,同时驱动电路也可通过信号线接收机器人的反馈信号,以实时根据该反馈信号调节机器人的运动精度。Specifically, the signal line of the robot and the power and the brake line are respectively connected to the driving circuit, and the driving circuit supplies the power source to the robot through the power and the brake line, and the driving circuit outputs the motion track command issued by the control device of the robot through the signal line. The robot is caused to operate according to the motion trajectory, and the driving circuit can also receive the feedback signal of the robot through the signal line to adjust the motion precision of the robot according to the feedback signal in real time.
目前,机器人主要应用与工业领域,是多关节机械手或多自由度的机器装置,它能自动执行工作,来实现各种功能的一种机器。机器人可以根据用户所发出的指令运行,也可以按照预先编排的程序运行。At present, the main application and industrial field of robots are multi-joint robots or multi-degree-of-freedom machine devices, which can automatically perform work to realize a machine of various functions. The robot can be run according to the instructions issued by the user, or it can be run according to a pre-programmed program.
在一个具体地应用场景中,机器人为点位型机器人,比如,机器人手臂,能够完成机床上下料、点焊和一般搬运、装卸等作业。在另一个应用场景中,机器人为连续轨迹型机器人,能够完成连续焊接和涂装等作业。In a specific application scenario, the robot is a point-type robot, for example, a robot arm, which can perform operations such as loading and unloading, spot welding, general handling, loading and unloading of the machine tool. In another application scenario, the robot is a continuous trajectory robot capable of performing continuous welding and painting operations.
目前,为了满足机器人的安全停止的需求,主要是采用接触器,以隔离机器人的控制系统的主电路向其驱动电路的动力电源输出,从而使机器人停止。但是由于接触器的寿命有限且频繁的动作会使机器人控制系统的驱动电路迅速老化,给后期的维护带来不便;另一方面接触器是物理按键,不仅动作噪声较大,影响用户体验,而且存在安全隐患。同时通过接触器切换电路的电源时会伴随较大的开关电流,会对电路造成干扰,进而影响机器人和控制系统的性能。At present, in order to meet the needs of the safe stop of the robot, the contactor is mainly used to isolate the main circuit of the control system of the robot to the power supply of the drive circuit thereof, thereby stopping the robot. However, due to the limited life of the contactor and frequent movements, the drive circuit of the robot control system is rapidly aging, which brings inconvenience to the later maintenance; on the other hand, the contactor is a physical button, which not only has a large motion noise, but also affects the user experience, and There are security risks. At the same time, the power of the circuit is switched by the contactor, which is accompanied by a large switching current, which may cause interference to the circuit, thereby affecting the performance of the robot and the control system.
为了解决上述问题,本实施方式的机器人的控制装置采用半导体选通电路,当半导体选通电路的选通支路断开时,驱动电路无法接收到电源信号,从而无法向机器人输出动力信号。In order to solve the above problem, the control device for the robot of the present embodiment employs a semiconductor gate circuit. When the gate branch of the semiconductor gate circuit is turned off, the drive circuit cannot receive the power supply signal, and thus the power signal cannot be output to the robot.
具体地,机器人的控制装置在其逻辑控制电路接收到第一触发指令后,该逻辑控制电路向驱动电路发送停止指令,以使机器人停止;在机器人停止后,逻辑控制电路向机器人的控制装置的半导体选通电路输出第一控制信号。在其中的一个实施方式中,第一触发指令为当机器人处于异常状态或紧急状态时而被触发的指令,该异常状态或紧急状态可以是人为触发的,也可以是由轨迹检测器检测到机器人处于异常状态或紧急状态后而触发的。402:根据第一控制信号控制半导体选通电路的断开,以使机器人的控制装置的驱动电路的电源断开,以切断机器人的动力信号;其中,逻辑控制电路分别与驱动电路和半导体选通电路的控制端连接,半导体选通电路的第一连接端与外部电源连接,半导体选通电路的第二连接端与驱动电路连接;驱动电路还与机器人连接。Specifically, after the logic control circuit receives the first trigger command, the logic control circuit sends a stop command to the drive circuit to stop the robot; after the robot stops, the logic control circuit goes to the control device of the robot. The semiconductor gating circuit outputs a first control signal. In one embodiment, the first triggering command is an instruction that is triggered when the robot is in an abnormal state or an emergency state, and the abnormal state or emergency state may be artificially triggered, or the trajectory detector may detect that the robot is in the Triggered after an abnormal state or emergency. 402: Control opening of the semiconductor gating circuit according to the first control signal, so that the power of the driving circuit of the control device of the robot is turned off to cut off the power signal of the robot; wherein the logic control circuit and the driving circuit and the semiconductor gating respectively The control terminal of the circuit is connected, the first connection end of the semiconductor gating circuit is connected to the external power source, the second connection end of the semiconductor gating circuit is connected to the driving circuit, and the driving circuit is also connected to the robot.
在本实施方式中,机器人的控制装置根据第一控制信号控制半导体选通电路的断开,以使机器人的控制装置的驱动电路的电源断开,以切断机器人的动力信号。其中,第一控制信号为控制半导体选通电路通断的使能信号,比如高电平或低电平。In the present embodiment, the control device of the robot controls the disconnection of the semiconductor gate circuit in accordance with the first control signal to turn off the power of the drive circuit of the control device of the robot to cut off the power signal of the robot. The first control signal is an enable signal for controlling the on and off of the semiconductor gating circuit, such as a high level or a low level.
具体地,逻辑控制电路中预设有第一停止指令,当机器人处于异常状态或紧急状态时,例如,当轨迹检测器检测到机器人遭遇突发情况,比如实际轨迹偏离预设轨迹时,逻辑控制电路发出第一停止指令给驱动电路,驱动电路按照预设的指令输出对应的停止信号,以使机器人按照最快的速度停止。Specifically, the first stop instruction is preset in the logic control circuit, and when the robot is in an abnormal state or an emergency state, for example, when the track detector detects that the robot encounters an unexpected situation, such as when the actual track deviates from the preset track, the logic control The circuit issues a first stop command to the drive circuit, and the drive circuit outputs a corresponding stop signal according to a preset command to stop the robot at the fastest speed.
在本实施方式中,机器人会停止在偏离原轨迹的位置上,当机器人停止后的预设时间内,比如,在机器人停止200ms后,逻辑控制电路输出第一控制信号给半导体选通电路,以使该半导体选通电路的第一连接端与第二连接端所在的选通支路断开,以隔离强电。In this embodiment, the robot stops at a position deviating from the original trajectory. When the robot stops for a preset time, for example, after the robot stops for 200 ms, the logic control circuit outputs a first control signal to the semiconductor strobe circuit to The first connection end of the semiconductor gating circuit is disconnected from the gating branch where the second connection end is located to isolate the high voltage.
在此,需要说明的是,前述的第一触发指令是当机器人13处于异常状况或紧急状况时才被触发,即,上述实施方式的停止操作主要是当机器人13处于异常状况或紧急状况时才被触发,能够使机器人按照最快的速度停止,以应对紧急情况。但是这种停止操作不仅会对机器人造成一定程度的损害,而且机器人无法停止在原轨迹上。Here, it should be noted that the foregoing first triggering command is triggered when the robot 13 is in an abnormal condition or an emergency situation, that is, the stopping operation of the above embodiment is mainly when the robot 13 is in an abnormal state or an emergency state. Triggered to stop the robot at the fastest speed in response to an emergency. However, this stop operation not only causes a certain degree of damage to the robot, but also the robot cannot stop on the original trajectory.
在本实施方式中,机器人的控制装置还包括控制器,控制器与驱动电路连接。In the present embodiment, the control device of the robot further includes a controller, and the controller is connected to the drive circuit.
具体地,控制器用于在接收到第二触发指令时,向驱动电路发送第二控制信号,驱动电路控制机器人根据第二控制信号按照预设程序停止工作。Specifically, the controller is configured to send a second control signal to the driving circuit when receiving the second triggering instruction, and the driving circuit controls the robot to stop working according to the preset program according to the second control signal.
在其中的一个实施方式中,驱动电路包括驱动控制电路以及驱动功率电路,其中,驱动控制电路与控制器连接;驱动功率电路与半导体选通电路的第二连接端连接,以接收电源信号;驱动功率电路还与机器人连接。In one embodiment, the driving circuit includes a driving control circuit and a driving power circuit, wherein the driving control circuit is connected to the controller; the driving power circuit is connected to the second connection end of the semiconductor gating circuit to receive the power signal; The power circuit is also connected to the robot.
驱动控制电路根据控制器的控制信号确定与该控制信号相匹配的控制算法;驱动功率电路按照该控制算法输出对应的驱动功率信号,以使机器人按照驱动功率信号停止工作。The driving control circuit determines a control algorithm matching the control signal according to the control signal of the controller; the driving power circuit outputs a corresponding driving power signal according to the control algorithm, so that the robot stops working according to the driving power signal.
具体地,控制器在接收第二触发指令后,其中,第二触发指令可以是操作人员发触发的,比如操作人员触发是机器人停止的触发指令,控制器根据该第二触发指令向驱动电路发送第二控制信号,驱动电路中的驱动控制电路根据控制器的控制信号确定与控制信号相匹配的控制算法并输出给驱动功率电路,驱动功率电路按照控制算法输出对应的驱动功率信号,以使机器人按照驱动功率信号停止工作。其中,驱动功率信号为PWM脉冲宽度调制信号。Specifically, after receiving the second triggering instruction, the second triggering command may be triggered by an operator, for example, the operator triggering is a triggering instruction of the robot stopping, and the controller sends the driving command to the driving circuit according to the second triggering instruction. a second control signal, the drive control circuit in the drive circuit determines a control algorithm matching the control signal according to the control signal of the controller and outputs the control algorithm to the drive power circuit, and the drive power circuit outputs a corresponding drive power signal according to the control algorithm to make the robot Stop working according to the drive power signal. The driving power signal is a PWM pulse width modulation signal.
本实施方式的停止操作可以使机器人停止在原轨迹上,且不会对机器人造成损害。The stop operation of the present embodiment can stop the robot on the original trajectory without causing damage to the robot.
在另一个实施方式中,为了隔离强电,区别于上述实施方式,在机器人停止之后,控制器会向逻辑控制电路发出第一触发指令,机器人的控制装置在其逻辑控制电路接收到控制器所发送的第一触发指令后,向其半导体选通电路输出第一控制信号,以使逻辑控制电路向半导体选通电路输出对应的控制信号,控制半导体选通电路的断开,以控制驱动电路的电源断开,从而切断机器人的动力信号,以隔离强电。In another embodiment, in order to isolate the high voltage, different from the above embodiment, after the robot stops, the controller sends a first trigger command to the logic control circuit, and the control device of the robot receives the controller at its logic control circuit. After transmitting the first triggering instruction, outputting a first control signal to the semiconductor strobe circuit, so that the logic control circuit outputs a corresponding control signal to the semiconductor strobe circuit to control the opening of the semiconductor strobe circuit to control the driving circuit. The power is turned off, thereby cutting off the power signal of the robot to isolate the strong electricity.
在此,需要说明的是,本实施方式的第一触发指令是由控制器发出的,在机器人按照第二控制信号停止后,为了隔离强电,控制器会进一步发出第一触发指令,以断开半导体选通电路,进而切断机器人的动力信号。Here, it should be noted that the first trigger command of the embodiment is sent by the controller. After the robot stops according to the second control signal, in order to isolate the strong power, the controller further issues a first trigger command to break. The semiconductor gate circuit is turned on, thereby cutting off the power signal of the robot.
即,本实施方式的第一触发指令的来源与由于机器人处于异常状况或紧急状况而触发的第一触发指令的来源是不相同的。但两者所要达到的目的是一样的,均是断开半导体选通电路,进而切断机器人的动力信号。That is, the source of the first trigger command of the present embodiment is different from the source of the first trigger command triggered by the robot being in an abnormal condition or an emergency. But the purpose of the two is the same, both disconnect the semiconductor gating circuit, and thus cut off the power signal of the robot.
区别于现有技术,本实施方式的机器人的控制装置包括半导体选通电路,在机器人的控制装置在接收到触发指令后向半导体选通电路输出控制信号,控制半导体选通电路的断开以控制驱动电路的电源断开,从而切断机器人的动力信号。半导体选通电路根据控制信号断开选通支路,从而断开电源,可避免由于人员操作而带来的安全隐患,同时,可延长机器人的控制装置的寿命,另一方面减小电源切换过程中的噪声,提高用户体验。Different from the prior art, the control device of the robot of the present embodiment includes a semiconductor gating circuit. After receiving the trigger command, the control device of the robot outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control The power of the drive circuit is disconnected, thereby cutting off the power signal of the robot. The semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
参阅图5,图5是本发明存储介质一实施方式的结构示意图。在本实施方式中,存储介质50中存储有至少一个计算机程序501。程序501用于执行上述任一实施方式中的控制机器人停止的方法。Referring to FIG. 5, FIG. 5 is a schematic structural diagram of an embodiment of a storage medium according to the present invention. In the present embodiment, at least one computer program 501 is stored in the storage medium 50. The program 501 is for executing a method of controlling the stopping of the robot in any of the above embodiments.
其中,存储介质50可以是存储芯片、硬盘或者是移动硬盘或者优盘、光盘等其他可读写存储的工具,还可以是服务器等,在此不做具体限定。The storage medium 50 may be a storage chip, a hard disk, or a portable hard disk or other readable and writable storage tools such as a USB flash drive or an optical disk, and may be a server or the like, which is not specifically limited herein.
基于控制机器人停止的方法前述已详尽描述,在此不再赘谈。The method based on controlling the stopping of the robot has been described in detail above and will not be discussed here.
区别于现有技术,本实施方式的机器人的控制装置包括半导体选通电路,在机器人的控制装置在接收到触发指令后向半导体选通电路输出控制信号,控制半导体选通电路的断开以控制驱动电路的电源断开,从而切断机器人的动力信号。半导体选通电路根据控制信号断开选通支路,从而断开电源,可避免由于人员操作而带来的安全隐患,同时,可延长机器人的控制装置的寿命,另一方面减小电源切换过程中的噪声,提高用户体验。Different from the prior art, the control device of the robot of the present embodiment includes a semiconductor gating circuit. After receiving the trigger command, the control device of the robot outputs a control signal to the semiconductor gating circuit to control the disconnection of the semiconductor gating circuit to control The power of the drive circuit is disconnected, thereby cutting off the power signal of the robot. The semiconductor strobe circuit disconnects the strobe branch according to the control signal, thereby disconnecting the power supply, thereby avoiding safety hazards caused by personnel operation, and at the same time, prolonging the life of the robot control device, and reducing the power switching process Noise in the room to improve the user experience.
在本申请所提供的几个实施例中,应该理解到,所揭露的方法和装置,可以通过其它的方式实现。以上所描述的装置实施方式仅仅是示意性的,例如,模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided by the present application, it should be understood that the disclosed methods and apparatus may be implemented in other manners. The device implementations described above are merely illustrative. For example, the division of modules or units is only a logical function division. In actual implementation, there may be another division manner. For example, multiple units or components may be combined or integrated. Go to another system, or some features can be ignored or not executed. In addition, the mutual coupling or direct coupling or communication connection shown or discussed may be an indirect coupling or communication connection through some interface, device or unit, and may be in an electrical, mechanical or other form.
作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施方式方案的目的。The units described as separate components may or may not be physically separate, and the components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of the present embodiment.
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above integrated unit can be implemented in the form of hardware or in the form of a software functional unit. An integrated unit, if implemented in the form of a software functional unit and sold or used as a standalone product, can be stored in a computer readable storage medium.
基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)或处理器(processor)执行本申请各个实施方式方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。Based on such understanding, the technical solution of the present application, in essence or the contribution to the prior art, or all or part of the technical solution may be embodied in the form of a software product stored in a storage medium. A number of instructions are included to cause a computer device (which may be a personal computer, server, or network device, etc.) or a processor to perform all or part of the steps of the various embodiments of the present application. The foregoing storage medium includes: a U disk, a mobile hard disk, a read only memory (ROM, Read-Only) Memory, random access memory (RAM), disk or optical disk, and other media that can store program code.
以上所述仅为本发明的实施方式,并非因此限制本发明的专利保护范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。The above is only the embodiment of the present invention, and thus does not limit the scope of the patent protection of the present invention, and the equivalent structure or equivalent process transformation made by using the description of the present invention and the contents of the drawings, or directly or indirectly applied to other related The technical field is equally included in the scope of patent protection of the present invention.

Claims (16)

  1. 一种机器人的控制装置,其特征在于,所述控制装置包括:逻辑控制电路、驱动电路以及半导体选通电路;A control device for a robot, characterized in that the control device comprises: a logic control circuit, a drive circuit and a semiconductor gating circuit;
    所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接,所述半导体选通电路的第一连接端用于与外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路用于与所述机器人连接;The logic control circuit is respectively connected to the driving circuit and the control end of the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is used for connecting with an external power source, and the second of the semiconductor gating circuit a connection end connected to the driving circuit; the driving circuit is configured to be connected to the robot;
    所述逻辑控制电路用于在接收到第一触发指令后向所述半导体选通电路输出第一控制信号,控制所述半导体选通电路的断开以控制所述驱动电路的电源断开,以切断所述机器人的动力信号。The logic control circuit is configured to output a first control signal to the semiconductor gating circuit after receiving the first triggering instruction, and control disconnection of the semiconductor gating circuit to control power-off of the driving circuit to The power signal of the robot is cut off.
  2. 根据权利要求1所述的控制装置,其特征在于,所述半导体选通电路包括可控硅。The control device of claim 1 wherein said semiconductor gating circuit comprises a thyristor.
  3. 根据权利要求1所述的控制装置,其特征在于,所述驱动电路包括驱动控制电路以及与所述驱动控制电路连接的驱动功率电路。The control device according to claim 1, wherein said drive circuit comprises a drive control circuit and a drive power circuit connected to said drive control circuit.
  4. 根据权利要求3所述的控制装置,所述驱动控制电路与所述逻辑控制电路连接,所述驱动功率电路分别用于与所述半导体选通电路的第二连接端和所述机器人连接。The control device according to claim 3, wherein said drive control circuit is coupled to said logic control circuit, said drive power circuit being operative to be coupled to said second connection end of said semiconductor gating circuit and said robot.
  5. 根据权利要求1所述的控制装置,其特征在于,所述控制装置还包括控制器,所述控制器与所述驱动电路连接;The control device according to claim 1, wherein said control device further comprises a controller, said controller being coupled to said drive circuit;
    所述控制器用于在接收到第二触发指令时,向所述驱动电路发送第二控制信号,所述驱动电路控制所述机器人根据所述第二控制信号按照预设程序停止工作。The controller is configured to send a second control signal to the driving circuit when receiving the second triggering instruction, and the driving circuit controls the robot to stop working according to the preset program according to the second control signal.
  6. 根据权利要求5所述的控制装置,其特征在于,所述控制器还与所述逻辑控制电路连接,用于在所述机器人根据所述第二控制信号按照预设程序停止工作后,向所述逻辑控制电路发出指令以断开所述半导体选通电路。The control device according to claim 5, wherein the controller is further connected to the logic control circuit, and after the robot stops working according to the preset program according to the second control signal, The logic control circuit issues an instruction to open the semiconductor gating circuit.
  7. 根据权利要求5或6所述的控制装置,其特征在于,所述驱动电路包括驱动控制电路以及与所述驱动控制电路连接的驱动功率电路;The control device according to claim 5 or 6, wherein the drive circuit comprises a drive control circuit and a drive power circuit connected to the drive control circuit;
    所述驱动控制电路与所述控制器连接;所述驱动功率电路与所述半导体选通电路的第二连接端连接,以接收电源信号;所述驱动功率电路还用于与所述机器人连接;The driving control circuit is connected to the controller; the driving power circuit is connected to the second connection end of the semiconductor gating circuit to receive a power signal; the driving power circuit is further configured to be connected to the robot;
    所述驱动控制电路用于根据所述控制器的控制信号确定与所述控制信号相匹配的控制算法;所述驱动功率电路用于按照所述控制算法输出对应的驱动功率信号,以使所述机器人按照所述驱动功率信号停止工作。The driving control circuit is configured to determine, according to a control signal of the controller, a control algorithm that matches the control signal; the driving power circuit is configured to output a corresponding driving power signal according to the control algorithm, so that the The robot stops working in accordance with the drive power signal.
  8. 根据权利要求7所述的控制装置,其特征在于,所述驱动功率信号为脉冲宽度调制信号。The control device according to claim 7, wherein said drive power signal is a pulse width modulated signal.
  9. 一种控制机器人停止的方法,其特征在于,所述控制机器人停止的方法包括:A method for controlling stopping of a robot, characterized in that the method for controlling the stopping of the robot comprises:
    机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号;The control device of the robot outputs a first control signal to its semiconductor gating circuit after its logic control circuit receives the first trigger command;
    根据所述第一控制信号控制所述半导体选通电路的断开,以使所述机器人的控制装置的驱动电路的电源断开,以切断所述机器人的动力信号;其中,所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接,所述半导体选通电路的第一连接端用于与外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路还用于与所述机器人连接。Controlling the disconnection of the semiconductor gating circuit according to the first control signal to turn off the power of the driving circuit of the control device of the robot to cut off the power signal of the robot; wherein the logic control circuit Connected to the control circuit and the control terminal of the semiconductor strobe circuit respectively, the first connection end of the semiconductor strobe circuit is used for connecting with an external power source, and the second connection end of the semiconductor strobe circuit is A drive circuit is coupled; the drive circuit is further configured to be coupled to the robot.
  10. 根据权利要求9所述的控制机器人停止的方法,其特征在于,所述机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号具体包括:The method of controlling the stopping of the robot according to claim 9, wherein the controlling means of the robot outputs the first control signal to the semiconductor gating circuit after the logic control circuit receives the first triggering command, and the method includes:
    所述机器人的控制装置在其逻辑控制电路接收到第一触发指令后,所述逻辑控制电路向所述驱动电路发送停止指令,以使所述机器人停止;After the logic control circuit receives the first trigger command, the logic control circuit sends a stop command to the drive circuit to stop the robot;
    在所述机器人停止后,所述逻辑控制电路向其半导体选通电路输出第一控制信号。The logic control circuit outputs a first control signal to its semiconductor gating circuit after the robot is stopped.
  11. 根据权利要求9所述的控制机器人停止的方法,其特征在于,所述机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号之前还包括:The method for controlling the stopping of a robot according to claim 9, wherein the control means of the robot further comprises: after the logic control circuit outputs the first control signal to the semiconductor gate circuit after receiving the first triggering command;
    所述机器人的控制装置在其控制器接收到第二触发指令时,向所述驱动电路发送第二控制信号,以使所述驱动电路控制所述机器人根据所述第二控制信号按照预设程序停止工作,并向所述逻辑控制电路发送所述第一触发指令;The control device of the robot sends a second control signal to the driving circuit when the controller receives the second triggering instruction, so that the driving circuit controls the robot to follow the preset program according to the second control signal. Stop working, and send the first trigger instruction to the logic control circuit;
    所述机器人的控制装置在其逻辑控制电路接收到第一触发指令后向其半导体选通电路输出第一控制信号具体包括:The control unit of the robot outputs the first control signal to the semiconductor strobe circuit after the logic control circuit receives the first trigger command, and the method includes:
    所述机器人的控制装置在其逻辑控制电路接收到所述控制器所发送的所述第一触发指令后,向其半导体选通电路输出第一控制信号。The control device of the robot outputs a first control signal to its semiconductor gating circuit after its logic control circuit receives the first trigger command sent by the controller.
  12. 根据权利要求9~11所述的控制机器人停止的方法,其特征在于,所述半导体选通电路包括可控硅。A method of controlling the stopping of a robot according to any of claims 9-11, wherein said semiconductor gating circuit comprises a thyristor.
  13. 根据权利要求11所述的控制机器人停止的方法,其特征在于,所述机器人的控制装置在其控制器接收到第二触发指令时,向所述驱动电路发送第二控制信号,以使所述驱动电路控制所述机器人根据所述第二控制信号按照预设程序停止工作,并向所述逻辑控制电路发送触发指令具体包括:The method of controlling the stopping of a robot according to claim 11, wherein the control means of the robot transmits a second control signal to the driving circuit when the controller receives the second triggering command, so that the The driving circuit controls the robot to stop working according to the preset control signal according to the second control signal, and sending the triggering instruction to the logic control circuit specifically includes:
    所述机器人的控制装置在其控制器接收到第二触发指令时向所述驱动电路发送第二控制信号,以使所述驱动电路根据所述第二控制信号确定与所述控制信号相匹配的控制算法,并按照所述控制算法输出对应的驱动功率信号,进而使得所述机器人按照所述驱动功率信号停止工作,并向所述逻辑控制电路发送触发指令。The control device of the robot transmits a second control signal to the driving circuit when the controller receives the second triggering command, so that the driving circuit determines that the control signal matches the second control signal according to the second control signal. Controlling an algorithm, and outputting a corresponding driving power signal according to the control algorithm, so that the robot stops working according to the driving power signal, and sends a triggering instruction to the logic control circuit.
  14. 根据权利要求13所述的控制机器人停止的方法,其特征在于,所述驱动功率信号为脉冲宽度调制信号。The method of controlling the stopping of a robot according to claim 13, wherein the driving power signal is a pulse width modulation signal.
  15. 一种存储介质,其特征在于,所述存储介质上存储有计算机程序,所述程序能够被执行实现如权利要求9~14任一所述的控制机器人停止的方法。A storage medium characterized in that a computer program is stored on the storage medium, and the program can be executed to implement the method of controlling the stopping of the robot according to any one of claims 9 to 14.
  16. 一种机器人系统,其特征在于,所述机器人系统包括机器人的控制装置、机器人以及外部电源;A robot system, characterized in that the robot system comprises a robot control device, a robot and an external power source;
    所述机器人的控制装置包括逻辑控制电路、驱动电路以及半导体选通电路;The control device of the robot includes a logic control circuit, a driving circuit, and a semiconductor gating circuit;
    所述逻辑控制电路分别与所述驱动电路和所述半导体选通电路的控制端连接,所述半导体选通电路的第一连接端与所述外部电源连接,所述半导体选通电路的第二连接端与所述驱动电路连接;所述驱动电路与所述机器人连接;The logic control circuit is respectively connected to the driving circuit and the control end of the semiconductor gating circuit, the first connection end of the semiconductor gating circuit is connected to the external power source, and the second side of the semiconductor gating circuit a connection end connected to the driving circuit; the driving circuit is connected to the robot;
    所述逻辑控制电路用于在接收到第一触发指令后向所述半导体选通电路输出第一控制信号,控制所述半导体选通电路的断开以控制所述驱动电路的电源断开,以切断所述机器人的动力信号。The logic control circuit is configured to output a first control signal to the semiconductor gating circuit after receiving the first triggering instruction, and control disconnection of the semiconductor gating circuit to control power-off of the driving circuit to The power signal of the robot is cut off.
PCT/CN2018/074610 2018-01-30 2018-01-30 Method and device for controlling robot to stop, storage medium, and robot system WO2019148333A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201880002366.9A CN109414818B (en) 2018-01-30 2018-01-30 Method and device for controlling robot to stop, storage medium and robot system
PCT/CN2018/074610 WO2019148333A1 (en) 2018-01-30 2018-01-30 Method and device for controlling robot to stop, storage medium, and robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2018/074610 WO2019148333A1 (en) 2018-01-30 2018-01-30 Method and device for controlling robot to stop, storage medium, and robot system

Publications (1)

Publication Number Publication Date
WO2019148333A1 true WO2019148333A1 (en) 2019-08-08

Family

ID=65462102

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2018/074610 WO2019148333A1 (en) 2018-01-30 2018-01-30 Method and device for controlling robot to stop, storage medium, and robot system

Country Status (2)

Country Link
CN (1) CN109414818B (en)
WO (1) WO2019148333A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080079382A1 (en) * 2006-10-02 2008-04-03 Fanuc Ltd Robot control apparatus comprising a servo amplifier having an AC/DC converter
CN201282325Y (en) * 2008-09-27 2009-07-29 世融科技有限公司 Power-off protection device for detecting input/output signal abnormal
CN101834486A (en) * 2009-03-09 2010-09-15 贺雷 Switch-off electronic motor and control system thereof
CN105223858A (en) * 2014-06-13 2016-01-06 深圳市双赢伟业科技股份有限公司 A kind of switching on and shutting down control circuit of electronic equipment
CN205644180U (en) * 2016-05-19 2016-10-12 深圳市越疆科技有限公司 Soft power -off control circuit and arm device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080079382A1 (en) * 2006-10-02 2008-04-03 Fanuc Ltd Robot control apparatus comprising a servo amplifier having an AC/DC converter
CN201282325Y (en) * 2008-09-27 2009-07-29 世融科技有限公司 Power-off protection device for detecting input/output signal abnormal
CN101834486A (en) * 2009-03-09 2010-09-15 贺雷 Switch-off electronic motor and control system thereof
CN105223858A (en) * 2014-06-13 2016-01-06 深圳市双赢伟业科技股份有限公司 A kind of switching on and shutting down control circuit of electronic equipment
CN205644180U (en) * 2016-05-19 2016-10-12 深圳市越疆科技有限公司 Soft power -off control circuit and arm device

Also Published As

Publication number Publication date
CN109414818A (en) 2019-03-01
CN109414818B (en) 2022-02-18

Similar Documents

Publication Publication Date Title
CN102939714B (en) The method of voltage inverter and this inverter of control
US20200350903A1 (en) Igbt drive circuit for motor controller, and motor controller
TW201320140A (en) Powre supply system with automatic transfer function and method of controlling the same
CN105555489A (en) Multiaxial robot power shut-off device and multiaxial robot
CN205195359U (en) New uninterrupted power source
WO2019148333A1 (en) Method and device for controlling robot to stop, storage medium, and robot system
CN105958437A (en) Control circuit for achieving decompression tripping of circuit breaker through external loop
EP1160141A2 (en) Motor break releasing device
KR20130025199A (en) Device and method for articulated robot
WO2023104193A1 (en) Bidirectional power supply, and method for controlling bidirectional power supply
CN109193915B (en) Switch machine control circuit, system, control method and fault detection method
WO2020022693A1 (en) Power switchover switch
CN111030234A (en) Novel hardware battery redundancy protection device and working method thereof
CN103762714A (en) Switching device for achieving switching control over multiple power systems
CN113629873B (en) Contact net isolator monitoring unit based on IGBT is realized
CN210968964U (en) Industrial robot with power-off protection
CN111610437B (en) Dynamic braking circuit, state detection and fault processing method based on dynamic braking circuit
CN114172120A (en) Active short circuit control circuit and method
WO2013183802A1 (en) Apparatus for controlling a cascaded hybrid construction machine system and a method therefor
CN207098981U (en) A kind of three-phase inverting circuit compensation device
CN113021332B (en) Industrial robot control system and control equipment
CN206602049U (en) A kind of three power automatic transfer switch devices
CN206498190U (en) Secondary DSP control devices for switching ring main unit
TW201935803A (en) A fail-safe circuit for UPS and a UPS device
CN211744126U (en) UPS power supply integrated system capable of being parallel-connected

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 18903356

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 18903356

Country of ref document: EP

Kind code of ref document: A1