TW202146191A - Safety system and method for teaching a robot - Google Patents
Safety system and method for teaching a robot Download PDFInfo
- Publication number
- TW202146191A TW202146191A TW109118887A TW109118887A TW202146191A TW 202146191 A TW202146191 A TW 202146191A TW 109118887 A TW109118887 A TW 109118887A TW 109118887 A TW109118887 A TW 109118887A TW 202146191 A TW202146191 A TW 202146191A
- Authority
- TW
- Taiwan
- Prior art keywords
- robot
- enabling device
- state
- teaching
- safety
- Prior art date
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
本發明有關一種機器人的安全系統及方法,尤其關於機器人在切換至教導模式下,對於使用者執行手拉或非手拉教導機器人,進行保護的安全系統及方法。 The present invention relates to a safety system and method for a robot, in particular, to a safety system and method for protecting the robot from hand-pulling or non-hand-pull teaching the robot when the robot is switched to the teaching mode.
隨著機器人的技術蓬勃發展,工廠利用機器人,雖可協助作業人員快速進行加工組裝製造作業,提高工廠生產效率,但是機器人能否正常的運作,嚴重影響到作業人員的安全,因此各國訂定嚴格的安全標準規範,以維護機器人的作業安全。 With the vigorous development of robot technology, the use of robots in factories can help operators to quickly carry out processing, assembly and manufacturing operations and improve factory production efficiency, but the normal operation of robots will seriously affect the safety of operators. safety standards and specifications to maintain the operational safety of robots.
請參圖5,先前技術為了教導機器人1作業,在機器人1的末端設置手拉按鈕2,手拉按鈕通常設計為按壓運行(Hold to Run),或為軟體上的按鍵,手拉按鈕2電性或通訊連接至機器人1控制器3。在示教器4設定機器人1處於教導模式時,當使用者按壓手拉按鈕2,訊號通知控制器3,將機器人1從靜止狀態切入手拉模式(Hand Guiding)。先前技術的手拉模式有多種方式,例如透過機器人1各肘節5中致動器之編碼器、馬達電流感測器經計算與補償,得知對各關節之施力或對末端之手拉施力,控制機器人1順從手拉移動。利用手拉機器人1至點位記錄位置、或手拉紀錄路徑,教導機器人1作業。並於放開手拉按鈕2時,使機器人1切出手拉模式回到靜
止狀態。
Please refer to FIG. 5 , in order to teach the
前述先前技術機器人1的示教器4,為了符合安全標準規範ISO 10218-1的要求,在例如手拉、吋動、試跑調速等教導模式下,裝設致能裝置(Enable Device),以保護協作的使用者。致能裝置通常為三段式按鈕(3 Position Enabling Switch),其結構設計有三個按壓階段,完全放開、中位、壓緊,其中僅中位可致能機器人1進行教導行為,完全放開或壓緊時,都將電性或通訊傳達至控制器3,啟動安全系統中斷教導行為,讓機器人1停止運動,並透過「監控靜止」(Stand Still Monitoring)監控機器人1在致動器仍有電時不輕舉妄動,如監控發現機器人發生運動,安全系統將切斷機器人1致動器之電力,以保護使用者在教導過程中的安全。
In order to meet the requirements of the safety standard specification ISO 10218-1, the
然而,前述先前技術依安全標準規範在示教器設置致能裝置,處於教導模式時,限制在致能裝置致能狀態下慢速移動,近距離手拉機器人的使用者,以獲得安全保護。此外設在示教器的致能裝置,與設在機器人末端的手拉按鈕分開設置,必須同時按壓,才能手拉教導機器人,極為不便,而分開操作時,示教器易被其他使用者切換為其他模式時,造成手拉協作中使用者的危險。因此,機器人在教導模式的安全系統及方法上,仍有問題亟待解決。 However, in the prior art, an enabling device is installed on the teach pendant according to safety standards. When in the teaching mode, the user is restricted to move slowly when the enabling device is enabled, and the user of the robot is pulled close by hand for safety protection. In addition, the enabling device on the teach pendant is set separately from the hand-pull button on the end of the robot. It must be pressed at the same time to teach the robot by hand, which is extremely inconvenient. When operated separately, the teach pendant is easily switched by other users. When it is in other modes, it will cause danger to the user in the hand-pull collaboration. Therefore, there are still problems to be solved urgently in the safety system and method of the robot in the teaching mode.
本發明的目的提供一種教導機器人的安全系統,藉由在機器人末端設置第一致能裝置,及於示教器設置第二致能裝置,在教導模式下,由控制器偵測兩致能裝置的啟動次序,選擇致能的致能裝置,以確保教導機器人的安全性。 The object of the present invention is to provide a safety system for teaching a robot. By arranging a first enabling device at the end of the robot and a second enabling device on the teach pendant, in the teaching mode, the controller detects the two enabling devices. In order to ensure the safety of the teaching robot, select the enabling device to be enabled.
本發明的另一目的提供一種教導機器人的安全方法,利用偵測首先啟動開狀態的致能裝置,致能首先啟動開狀態的致能裝置,不致能其餘的致能裝置,避免誤操作,以提高使用者的安全。 Another object of the present invention is to provide a safety method for teaching a robot. By detecting the enabling device in the ON state first, the enabling device in the ON state is enabled first, and the other enabling devices are disabled, so as to avoid misoperation and improve the user safety.
為了達到前述發明的目的,本發明教導機器人的安全系統,機器人具有多肘節,一端為固定基座,另一端為活動的末端,設置第一致能裝置,各肘節中設置致動器及位置感測器。控制器連接至機器人,控制致動器及位置感測器,移動機器人的末端,第二致能裝置連接控制器。控制器內設安全模組,電性或通訊相連第一致能裝置及第二致能裝置,依據致能的第一致能裝置或第二致能裝置關狀態,發出電性訊號,使機器人進入安全狀態。控制器利用偵測第一致能裝置或第二致能裝置,致能首先啟動開狀態的致能裝置,不致能另一致能裝置。 In order to achieve the purpose of the foregoing invention, the present invention teaches the safety system of the robot. The robot has multiple toggle joints, one end is a fixed base, the other end is a movable end, a first enabling device is provided, and an actuator and an actuator are arranged in each toggle joint. position sensor. The controller is connected to the robot, controls the actuator and the position sensor, moves the end of the robot, and the second enabling device is connected to the controller. The controller is equipped with a safety module, which is electrically or communicatively connected to the first enabling device and the second enabling device. According to the off state of the enabled first enabling device or the second enabling device, an electrical signal is sent to enable the robot to Enter a safe state. The controller detects the first enabling device or the second enabling device to enable the enabling device in the on-state first, but disable the other enabling device.
本發明教導機器人的安全系統,安全模組電性或通訊連接各肘節之位置感測器,接收位置感測器的訊號進行監控機器人的活動狀態,當監控機器人產生運動,關斷致動器電源,或監控機器人超過速度限制時,使機器人進入安全狀態。第一致能裝置或第二致能裝置處於關狀態時,安全模組使機器人進入安全狀態,而第一致能裝置或第二致能裝置處於開狀態時,安全模組取消機器人的安全狀態。安全模組利用切斷致動器的電力,或經過固定時間或觀察機器人減速運動達成後,關斷致動器電源,或開啟靜止監控安全功能,使機器人進入安全狀態。第一致能裝置或第二致能裝置以燈光或音響區別顯示致能或未致能的狀態。第一致能裝置設為具有手拉按鈕的功能。 The present invention teaches the safety system of the robot. The safety module is electrically or communicatively connected to the position sensor of each toggle, and receives the signal of the position sensor to monitor the activity state of the robot. When the monitoring robot generates motion, the actuator is turned off. power, or monitor the robot to enter a safe state when it exceeds the speed limit. When the first enabling device or the second enabling device is off, the safety module makes the robot enter a safe state, and when the first enabling device or the second enabling device is on, the safety module cancels the safe state of the robot . The safety module cuts off the power of the actuator, or after a fixed time or after observing the deceleration of the robot, the power of the actuator is turned off, or the static monitoring safety function is turned on, so that the robot enters a safe state. The first enabling device or the second enabling device displays the enabled or disabled state by light or sound. The first enabling device is set to have the function of a hand-pulled button.
本發明教導機器人的安全方法,將機器人切換至教導模式, 使第一致能裝置或第二致能裝置均未致能,機器人進入安全狀態;偵測第一致能裝置及第二致能裝置皆為關狀態,進入偵測狀態,開始偵測第一致能裝置或第二致能裝置何者首先啟動開狀態;當第一致能裝置首先啟動開狀態時,致能第一致能裝置,且未致能第二致能裝置,解除該機器人的安全狀態,進入第一狀態。第一狀態可設為手拉教導狀態,則致能手拉該機器人的控制。接著偵測第一致能裝置切換至關狀態時,回到偵測狀態。 The invention teaches the safety method of the robot, switches the robot to the teaching mode, Disable the first enabling device or the second enabling device, and the robot enters a safe state; detect that both the first enabling device and the second enabling device are off, enter the detecting state, and start to detect the first enabling device Which one of the enabling device or the second enabling device is first activated to the ON state; when the first enabling device is first activated to the ON state, the first enabling device is enabled, and the second enabling device is not enabled, releasing the safety of the robot state, enter the first state. The first state can be set as the hand-pull teaching state, which enables hand-pull control of the robot. Then it is detected that when the first enabling device is switched to the off state, it returns to the detection state.
本發明教導機器人的安全方法,偵測第一致能裝置非首先啟動開狀態,再檢查第二致能裝置非首先啟動開狀態,則回至偵測狀態繼續偵測何者首先啟動開狀態。檢查第二致能裝置為首先啟動開狀態,致能第二致能裝置,未致能第一致能裝置,解除機器人的安全狀態,進入第二狀態。第二狀態可設為非手拉教導狀態,則致能非手拉該機器人的控制。接著偵測第二致能裝置切換至關狀態時,回到偵測狀態。 The present invention teaches the safety method of the robot to detect the first enabling device is not first turned on, then check the second enabling device is not first turned on, then return to the detection state and continue to detect which one is first turned on. Check that the second enabling device is in the ON state first, enable the second enabling device, and fail to enable the first enabling device, release the safe state of the robot, and enter the second state. The second state can be set as a non-hand-pull teaching state, which enables non-hand-pull control of the robot. Then, when the second enabling device is detected to be switched to the off state, it returns to the detection state.
10:安全系統 10: Security System
11:機器人 11: Robots
12:控制器 12: Controller
13:示教器 13: Teach Pendant
14:安全模組 14: Security Module
15:第一致能裝置 15: The first enabling device
16:第二致能裝置 16: Second enabling device
17:肘節 17: Toggle
18:基座 18: Pedestal
19:末端 19: End
20:位置感測器 20: Position Sensor
圖1 為本發明教導機器人的安全系統的示意圖。 FIG. 1 is a schematic diagram of the safety system of the teaching robot of the present invention.
圖2 為本發明安全系統的控制功能的示意圖。 FIG. 2 is a schematic diagram of the control function of the safety system of the present invention.
圖3 為本發明安全系統的致能裝置開關狀態切換的示意圖。 FIG. 3 is a schematic diagram of the switch state of the enabling device of the safety system of the present invention.
圖4 為本發明教導機器人的安全方法的流程圖。 FIG. 4 is a flow chart of the safety method of teaching a robot according to the present invention.
圖5 為先前技術手拉教導機器人的示意圖。 FIG. 5 is a schematic diagram of a prior art hand-pulled teaching robot.
有關本發明為達成上述目的,所採用之技術手段及其功效,茲舉較佳實施例,並配合圖式加以說明如下。 Regarding the technical means adopted by the present invention to achieve the above-mentioned objects and their effects, preferred embodiments are given and described below with the accompanying drawings.
請同時參閱圖1至圖2,圖1為本發明教導機器人的安全系統的示意圖,圖2為本發明安全系統的控制功能的示意圖,圖3為本發明安全系統的致能裝置開關狀態切換的示意圖。圖1中,本發明的安全系統10包含機器人11、控制器12、示教器13、安全模組14、第一致能裝置15及第二致能裝置16。其中機器人11具有多肘節17,一端為固定基座18,另一端為活動的末端19,末端19設置第一致能裝置15。機器人11連接至控制器12,控制器12內含一安全模組14,安全模組14具備直接發出電性訊號或通訊訊號切斷致動器的電力停機機器人11的功能。控制器12藉由控制各肘節17中的致動器及位置感測器20,控制移動機器人11的末端19。控制器12連接示教器13,用以編輯機器人11程式或操作控制機器人11,示教器13設置第二致能裝置16。本實施例雖以第二智能裝置16設在示教器13舉例說明,但包含且不限於本實施例,第二致能裝置16可不位於示教器13上,或可為獨立一個手持致能裝置連接至安全模組14,或於控制器12具備讓使用者自行連接自購之第二致能裝置16之致能模組埠。
Please refer to FIG. 1 to FIG. 2 at the same time, FIG. 1 is a schematic diagram of a safety system of the teaching robot of the present invention, FIG. 2 is a schematic diagram of a control function of the safety system of the present invention, and FIG. 3 is a switch state of an enabling device of the safety system of the present invention. Schematic. In FIG. 1 , the
圖2中,安全模組14經由控制器12與第一致能裝置15及第二致能裝置16電性或通訊相連,第一致能裝置15及第二致能裝置16具備開狀態(ON)與關狀態(OFF)操作的功能,當第一致能裝置15或第二致能裝置16處於開狀態(ON)狀態時,安全模組14取消機器人11之安全狀態,而當第一致能裝置15或第二致能裝置16處於關狀態(OFF)狀態時,安全模組14使機器人11停機進入安全狀態。安全模組14另電性或通訊連接機器人11各肘節17之位置感測器20,接收位置感測器20的訊號進行監控機器人11的活動狀態,當監控機器人11產生運動,即關斷致動器電源,或由安全模組14監控機器
人11的速度,超過預設速度限制時,使機器人11進入安全狀態。
In FIG. 2 , the
安全模組14停機機器人11進入安全狀態有三種類型,零類停機為斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,直接關斷致動器電力。一類停機為進階斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,對控制器12下達減速命令後,經過固定時間或觀察機器人11減速運動達成後,關斷致動器電源。二類停機為非斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,對控制器12中下達減速命令後,經過固定時間或觀察機器人減速運動達成後,開啟靜止監控安全功能(Standstill Monitoring),持續監控位置感測器20,當監控機器人11產生運動,即關斷致動器電源。
The
圖3中,當機器人11從其他模式切換至教導模式(Teaching Mode)時,不論第一致能裝置15或第二致能裝置16是否位於開狀態,都無法進行手拉或非手拉(例如吋動或試跑調速等)教導機器人11,且安全模組14皆使機器人11進入例如關斷致動器電源或靜止監控等停機的安全狀態。接著,偵測第一致能裝置15或第二致能裝置16皆為關狀態,安全系統10進入偵測狀態,安全系統10利用控制器12開始檢查偵測第一致能裝置15或第二致能裝置16啟動開狀態,致能首先啟動開狀態的致能裝置,不致能另一致能裝置。
In FIG. 3 , when the
當第一致能裝置15首先啟動開狀態,即位於機器人末端19的第一致能裝置15先被使用者啟動,使用者位於機器人11,安全系統10致能第一致能裝置15,且未致能第二致能裝置16,安全系統10可以燈光或音響區別致能或未致能的狀態,同時安全模組14解除機器人11的停機安全狀
態(即致動器復電或停止靜止監控),由偵測狀態進入手拉教導狀態,並對控制器12中表示致能手拉機器人11的控制,為了操作方便,第一致能裝置15亦可設為具有手拉按鈕的功能。此時僅由使用者選擇的第一致能裝置15進行手拉控制,不管第二致能裝置16是否為開狀態,安全系統10皆禁止第二致能裝置16教導機器人11的控制,亦即,第二致能裝置16按壓與否不造成手拉教導狀態改變,以保護進行手拉的使用者。當安全系統10偵測第一致能裝置15切換至關狀態時,安全模組14使機器人11進入停機的安全狀態,回到偵測狀態。
When the first enabling
於偵測狀態中,當第二致能裝置16早於第一致能裝置15首先啟動開狀態,即位於示教器13的第二致能裝置16先被使用者啟動,安全系統10致能第二致能裝置16,且未致能第一致能裝置15,安全系統10可以燈光或音響區別顯示致能裝置的致能或未致能的狀態,同時安全模組14解除機器人11的停機安全狀態,由偵測狀態進至非手拉教導狀態,並對控制器12中表示致能非手拉機器人11的控制。此時僅由使用者選擇的第二致能裝置16進行控制,不管第一致能裝置15是否為開狀態,安全系統10皆禁止手拉機器人11,亦即,第一致能裝置15按壓與否不造成非手拉教導狀態改變。當安全模組14偵測第二致能裝置16切換至關狀態時,安全模組14使機器人11進入停機的安全狀態,回到偵測狀態。
In the detection state, when the second enabling
如圖4所示,為本發明教導機器人的安全方法的流程圖。本發明教導機器人的安全方法的詳細步驟說明如下:步驟S1,機器人切換至教導模式;步驟S2,第一致能裝置及第二致能裝置均未致能,無法進行手拉或非手拉教導機器人,機器人進入安全狀態;接著進入步驟S3,當偵測第 一致能裝置及第二致能裝置皆為關狀態時,進入偵測狀態;步驟S4,開始偵測第一致能裝置或第二致能裝置何者首先啟動開狀態;步驟S5,檢查第一致能裝置是否首先啟動開狀態?假如第一致能裝置為首先啟動開狀態,則至步驟S6,致能第一致能裝置,且未致能第二致能裝置,接著至步驟S7解除機器人的停機安全狀態;再至步驟S8,進入第一狀態,第一狀態相對應第一致能裝置設定作業狀態,例如第一致能裝置設在機器人末端,第一狀態可設為手拉教導狀態,則致能手拉機器人的控制。然後至步驟S9,偵測第一致能裝置切換至關狀態時,回到步驟S3的偵測狀態。 As shown in FIG. 4 , it is a flow chart of the safety method for teaching a robot according to the present invention. The detailed steps of the safety method for teaching the robot of the present invention are described as follows: step S1, the robot switches to the teaching mode; step S2, the first enabling device and the second enabling device are not enabled, and cannot be taught by hand or not by hand robot, the robot enters a safe state; then enter step S3, when the detection of the first When both the first enabling device and the second enabling device are off, enter the detecting state; step S4, start to detect which of the first enabling device or the second enabling device is turned on first; step S5, check the first enabling device Does the device start the ON state first? If the first enabling device is in the ON state first, then go to step S6 to enable the first enabling device, but not enable the second enabling device, then go to step S7 to release the robot from the shutdown safe state; then go to step S8 , enter the first state. The first state corresponds to the first enabling device to set the working state. For example, the first enabling device is located at the end of the robot. Then go to step S9, when it is detected that the first enabling device is switched to the off state, it returns to the detection state of step S3.
在步驟S5假如第一致能裝置非首先啟動開狀態,則至步驟S10,檢查第二致能裝置是否首先啟動開狀態?假如第二致能裝置非首先啟動開狀態,則回至步驟S4,繼續偵測何者致能裝置首先啟動開狀態,假如第二致能裝置首先啟動開狀態,致能第二致能裝置,且未致能第一致能裝置,接著至步驟S11解除機器人的停機安全狀態;再至步驟S12,進入第二狀態,第二狀態相對應第二致能裝置設定作業狀態,例如第二致能裝置設在示教器,第二狀態可設為非手拉教導狀態,則致能非手拉機器人的控制。然後至步驟S9偵測第二致能裝置切換至關狀態時,回到步驟S3的偵測狀態。 In step S5, if the first enabling device is not in the on state first, then go to step S10 to check whether the second enabling device is in the on state first? If the second enabling device is not the first to enable the on state, then go back to step S4 to continue to detect which enabling device first enables the on state, if the second enabling device first enables the on state, the second enabling device is enabled, and If the first enabling device is not enabled, then go to step S11 to release the shutdown safety state of the robot; then go to step S12, enter the second state, the second state corresponds to the setting operation state of the second enabling device, such as the second enabling device Set on the teach pendant, the second state can be set as the non-hand-pull teaching state, which enables the control of the non-hand-pull robot. Then, when it is detected in step S9 that the second enabling device is switched to the off state, it returns to the detection state in step S3.
因此,本發明教導機器人的安全系統及方法,就可藉由在機器人末端設置第一致能裝置,在示教器或其他位置設置的第二致能裝置,在教導模式下,由控制器偵測兩致能裝置的啟動次序,致能首先啟動開狀態的致能裝置,不致能其餘的致能裝置,選擇單一致能的致能裝置操作,避免其他使用者誤操作,達到確保使用者教導機器人的安全性的目的。 Therefore, the safety system and method of the teaching robot of the present invention can be detected by the controller by setting the first enabling device at the end of the robot and the second enabling device at the teaching pendant or other positions in the teaching mode. Measure the activation sequence of the two enabling devices, enable the enabling device in the open state first, and disable the rest of the enabling devices, select a single enabling device for operation, avoid misoperation by other users, and ensure that the user can teach the robot. for security purposes.
以上所述者,僅為用以方便說明本發明之較佳實施例,本發 明之範圍不限於該等較佳實施例,凡依本發明所做的任何變更,於不脫離本發明之精神下,皆屬本發明申請專利之範圍。 The above descriptions are only for the convenience of describing the preferred embodiments of the present invention. The scope of the invention is not limited to these preferred embodiments, and any changes made according to the present invention, without departing from the spirit of the present invention, all belong to the scope of the patent application of the present invention.
Claims (13)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW109118887A TW202146191A (en) | 2020-06-05 | 2020-06-05 | Safety system and method for teaching a robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW109118887A TW202146191A (en) | 2020-06-05 | 2020-06-05 | Safety system and method for teaching a robot |
Publications (1)
Publication Number | Publication Date |
---|---|
TW202146191A true TW202146191A (en) | 2021-12-16 |
Family
ID=80783702
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW109118887A TW202146191A (en) | 2020-06-05 | 2020-06-05 | Safety system and method for teaching a robot |
Country Status (1)
Country | Link |
---|---|
TW (1) | TW202146191A (en) |
-
2020
- 2020-06-05 TW TW109118887A patent/TW202146191A/en unknown
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6457416B2 (en) | Robot system | |
CN104972473B (en) | With the people's coordination type industrial robot for introducing function | |
US7501778B2 (en) | Robot control device | |
JP6055014B2 (en) | Robot control device having function of detecting contact with object or person | |
JPWO2004009303A1 (en) | Robot control apparatus and robot system | |
US20240159634A1 (en) | Safety systems requiring intentional function activation and material testing systems including safety systems requiring intentional function activation | |
JP2011500336A (en) | Multi-axis control method and industrial robot system in industrial robot system | |
WO2020045483A1 (en) | Robot control device | |
JP6240422B2 (en) | Robot control system and robot control method | |
TW202146191A (en) | Safety system and method for teaching a robot | |
Hull et al. | Considerations in collaborative robot system designs and safeguarding | |
TWI748501B (en) | Safety system and method for teaching a robot | |
CN114939866B (en) | Robot monitoring device and robot system | |
JP2509339B2 (en) | Robot controller | |
CN113799176B (en) | Safety system and method for teaching robot | |
CN113799117A (en) | Safety system and method for teaching robot | |
CN114347100B (en) | Automatic mode safety system and method for robot | |
US11667037B2 (en) | Robot system with hand-guiding function | |
CN114474037B (en) | Control system and method for robot safety state | |
JP4610635B2 (en) | Die cushion mechanism, control device and control method thereof | |
WO1991009354A1 (en) | Protection device in automatic production equipments | |
JP2004330346A (en) | Robot control device | |
JP2006130523A (en) | Die cushion mechanism, and controller and control method therefor | |
WO2024004170A1 (en) | Robot control device, robot system, and robot control method | |
KR20220137667A (en) | Material testing systems including pneumatic grip systems and pneumatic grip systems |