TWI748501B - Safety system and method for teaching a robot - Google Patents
Safety system and method for teaching a robot Download PDFInfo
- Publication number
- TWI748501B TWI748501B TW109118891A TW109118891A TWI748501B TW I748501 B TWI748501 B TW I748501B TW 109118891 A TW109118891 A TW 109118891A TW 109118891 A TW109118891 A TW 109118891A TW I748501 B TWI748501 B TW I748501B
- Authority
- TW
- Taiwan
- Prior art keywords
- robot
- safety
- mode
- teaching
- hand
- 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 a user to perform teaching and protection of the robot when the robot is switched between automatic and hand-pulled or non-pulled mode.
隨著機器人的技術蓬勃發展,工廠利用機器人,雖可協助作業人員快速進行加工組裝製造作業,提高工廠生產效率,但是機器人能否正常的運作,嚴重影響到作業人員的安全,因此各國訂定嚴格的安全標準規範,以維護機器人的作業安全。 With the vigorous development of robot technology, factories use robots to assist operators in rapid processing, assembly and manufacturing operations and improve factory production efficiency. However, the normal operation of robots seriously affects the safety of operators. Therefore, various countries have set strict regulations. Safety standards and regulations to maintain the 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 Figure 5. In the prior art, in order to teach the robot 1 to operate, a
前述先前技術機器人1的示教器4,為了符合安全標準規範ISO 10218-1的要求,在教導模式下,裝設致能裝置(Enable Device),以保護協作的使用者。致能裝置6通常在示教器4,為三段式按鈕(3 Position Enabling Switch),其結構設計有三個按壓階段,完全放開、中位、壓緊,其中僅中位可致能機器人1進行教導行為,完全放開或壓緊時,都將電性或通訊傳達至控制器3,安全系統7啟動中斷教導行為,讓機器人1停止運動,並透過「監控靜止」(Stand Still Monitoring)監控機器人1在致動器仍有電時不輕舉妄動,如監控發現機器人發生運動,安全系統7將切斷機器人1致動器之電力,以保護使用者在教導過程中的安全。
In order to comply with the requirements of the safety standard ISO 10218-1, the teach
然而,前述先前技術的機器人在教導模式下,需進行手拉,或協同工作,或例如吋動、試跑等非手拉等多種教導作業,而各種教導作業均有不同的安全需求,除此以外更有自動模式下之手拉牽引,以單一功能的安全系統套用至全部教導作業,極易造成使用者的危險。因此,機器人在手拉牽引的安全系統及方法上,仍有問題亟待解決。 However, in the teaching mode of the aforementioned prior art robots, they need to be hand-drawn, or work collaboratively, or a variety of teaching tasks such as inching, trial running and other non-hand-drawn tasks, and various teaching tasks have different safety requirements, except for this. In addition, there is a hand-drawn traction in automatic mode, and a single-function safety system is applied to all teaching operations, which is very easy to cause danger to users. Therefore, there are still problems that need to be solved urgently in the safety system and method of the robot in the hand-drawn traction.
本發明的目的提供一種教導機器人的安全系統,藉由模式切換裝置切換機器人多種運行模式,配合致能裝置,啟用相對應各教導模式預設不同的安全模組及安全功能,以方便切換模式。 The object of the present invention is to provide a safety system for teaching robots. The mode switching device switches multiple operating modes of the robot, and cooperates with the enabling device to enable preset different safety modules and safety functions corresponding to each teaching mode to facilitate switching modes.
本發明的另一目的提供一種教導機器人的安全方法,利用預設各運行模式相對應的安全模組及安全功能切換機器人,建構各運行模式專適合的安全系統,以確保使用者的安全。 Another object of the present invention is to provide a safety method for teaching robots, using preset safety modules and safety functions corresponding to each operation mode to switch the robot to construct a safety system suitable for each operation mode to ensure the safety of users.
本發明的再一目的提供一種教導機器人的安全方法,在各種運行模式切換至手拉模式時,都能維持手拉模式專有的安全模組及安全功能,以提升使用者的安全性。 Another object of the present invention is to provide a safety method for teaching robots, which can maintain the specific safety module and safety functions of the pull mode when various operating modes are switched to the pull mode, so as to enhance the safety of the user.
為了達到前述發明的目的,本發明教導機器人的安全系統,具有多肘節的機器人,一端為活動的末端,各肘節中設置致動器及位置感測器,連接控制器,控制致動器及位置感測器,移動機器人的末端,致能裝置連接至該控制器,安全模組設於該控制器內,與能裝置電性或通訊相連,依據致能裝置開關狀態,發出電性或通訊訊號,使該機器人進入安全狀態或取消安全狀態,安全功能單元,設於該控制器內,與該安全模組電性或通訊相連,監控的該機器人的安全功能超過預設限制時,讓安全模組使機器人進入安全狀態,模式切換裝置與控制器、安全模組及安全功能單元電性或通訊相連,切換機器人的複數運行模式,當模式切換裝置切換機器人至各運行模式,使安全模組及安全功能單元啟用相對應各運行模式預設的安全模組及安全功能。 In order to achieve the purpose of the foregoing invention, the present invention teaches a safety system for a robot. A robot with multiple toggle joints has a movable end at one end. An actuator and a position sensor are set in each toggle joint, and the controller is connected to control the actuator. And the position sensor, the end of the mobile robot, the enabling device is connected to the controller, the safety module is set in the controller, and is electrically or communicatively connected to the enabling device. According to the switch state of the enabling device, it emits electrical or The communication signal enables the robot to enter the safe state or cancel the safe state. The safety function unit is set in the controller and is electrically or communicatively connected to the safety module. When the safety function of the monitored robot exceeds the preset limit, The safety module makes the robot enter a safe state. The mode switching device is electrically or communicatively connected to the controller, the safety module and the safety function unit to switch the plural operation modes of the robot. When the mode switching device switches the robot to each operation mode, the safety mode Groups and safety function units enable the safety modules and safety functions preset for each operation mode.
本發明的安全模組電性或通訊連接機器人各肘節之位置感測器,接收位置感測器的訊號進行監控機器人。安全模組至少包含以下一種安全狀態的類型,零類安全狀態為斷電停機功能,進入安全狀態時,直接關斷該致動器電力,一類安全狀態為進階斷電停機功能,進入安全狀態時,對該控制器下達減速命令後,經過固定時間該機器人減速運動達成後,關斷該致動器電源,二類安全狀態為非斷電停機功能,進入安全狀態時,對該控制器下達減速命令後,經過固定時間該機器人減速運動達成後,開啟靜止監控安全功能,持續監控該位置感測器,當監控該機器人產生運動, 即關斷該致動器電源。本發明的安全功能單元啟動至少一項以上的下列安全功能:肘節之角度限制、機器人末端的空間位置限制、力量限制或速度限制等。 The safety module of the present invention is electrically or communicatively connected to the position sensors of each toggle of the robot, and receives signals from the position sensors to monitor the robot. The safety module includes at least one of the following types of safety states. The zero safety state is the power-off shutdown function. When entering the safe state, the actuator power is directly shut off. The first safety state is the advanced power-off shutdown function and enters the safe state. When a deceleration command is issued to the controller, the actuator will be turned off after a fixed period of time when the deceleration movement of the robot is achieved. The second type of safety state is the non-power-off stop function. When the controller enters the safe state, the controller will be issued After the deceleration command, after the deceleration movement of the robot is reached for a fixed time, the static monitoring safety function is turned on to continuously monitor the position sensor. When the robot is monitored for movement, That is, the actuator power is turned off. The safety function unit of the present invention activates at least one of the following safety functions: the angle limit of the toggle, the space position limit of the end of the robot, the force limit or the speed limit, etc.
本發明教導機器人的安全系統的模式切換裝置切換的運行模式包含教導模式及自動模式,教導模式又包含手拉模式、手動低速模式及手動高速模式。模式切換裝置設於機器人的示教器,或由控制器外接。模式切換裝置為多位置旋鈕,透過旋鈕位置標示模式,或以燈號顯示模式。模式切換裝置亦可為純軟體按鍵、或硬體按鍵組合、或軟體與硬體組合按鍵。 The operating mode switched by the mode switching device of the safety system of the teaching robot of the present invention includes a teaching mode and an automatic mode, and the teaching mode includes a hand-pulling mode, a manual low-speed mode, and a manual high-speed mode. The mode switching device is installed on the robot's teach pendant, or externally connected by the controller. The mode switching device is a multi-position knob, through which the position of the knob indicates the mode, or the mode is displayed by the light. The mode switching device can also be a pure software button, or a combination of hardware buttons, or a combination of software and hardware buttons.
本發明教導機器人的安全方法,預設各運行模式相對應的安全模組及安全功能,安全模組及安全功能,啟用與否及限制值,依機器人各運行模式的需求預先設定。進行切換模式,檢查切換的模式為教導模式,例如手動低速模式或手動高速模式,進入教導模式,啟用教導模式預設相對應的安全模組及安全功能,停機機器人進入安全狀態,使致能裝置致能,偵測該致能裝置的開狀態,解除機器人的安全狀態,進行教導機器人作業。檢查機器人完成作業,則結束作業,未完成作業則回至切換模式繼續作業。 The present invention teaches the safety method of the robot. The safety module and safety function corresponding to each operation mode are preset. The safety module and safety function, whether to enable or not and the limit value are preset according to the requirements of each operation mode of the robot. Switch the mode, check that the switched mode is the teaching mode, such as manual low-speed mode or manual high-speed mode, enter the teaching mode, enable the corresponding safety module and safety function of the teaching mode preset, stop the robot to enter the safe state, and enable the device Enable, detect the on state of the enabling device, release the safe state of the robot, and teach the robot. When the inspection robot completes the job, it ends the job, and if the job is not completed, it returns to the switching mode to continue the job.
本發明檢查切換的模式為自動模式時,啟動該自動模式預設相對應的安全功能,監控機器人,進行機器人自動作業。檢查切換的模式為手拉模式時,進入手拉模式,至少持續按壓致能裝置,解除安全狀態,並致能手拉功能。本發明自手動慢速模式或手動高速模式或自動模式切換至手拉模式時,該機器人自行記錄運行程序的斷點,並啟動該手拉模式預 先設定的安全模組及安全功能,手拉教導該機器人作業後,切回各運行模式後,從中斷點繼續運行程序。 When the switching mode of the present invention is the automatic mode, the preset corresponding safety function of the automatic mode is activated, the robot is monitored, and the robot is automatically operated. Check that when the switched mode is the hand-pulling mode, enter the hand-pulling mode and at least keep pressing the enabling device to release the safe state and enable the hand-pulling function. When the present invention switches from manual slow speed mode or manual high speed mode or automatic mode to hand pull mode, the robot records the breakpoint of the running program by itself, and starts the hand pull mode preset The first set of safety modules and safety functions, after the robot is taught to work by hand, after switching back to each operation mode, the program will continue to run from the interruption point.
10:安全系統 10: Security system
11:機器人 11: Robot
12:控制器 12: Controller
13:示教器 13: Teach Pendant
14:安全模組 14: Security module
15:安全功能單元 15: Safety function unit
16:致能裝置 16: Enabling device
17:模式切換裝置 17: Mode switching device
18:肘節 18: toggle
19:基座 19: Pedestal
20:末端 20: end
21:位置感測器 21: position sensor
圖1 為本發明教導機器人的安全系統的示意圖。 Fig. 1 is a schematic diagram of the safety system of the teaching robot of the present invention.
圖2 為本發明安全系統的控制功能的示意圖。 Figure 2 is a schematic diagram of the control function of the security system of the present invention.
圖3 為本發明利用模式切換裝置切換模式的示意圖。 Fig. 3 is a schematic diagram of switching modes using a mode switching device according to the present invention.
圖4 為本發明教導機器人的安全方法的流程圖。 Figure 4 is a flow chart of the safety method for teaching robots in the present invention.
圖5 為先前技術手拉教導機器人的示意圖。 Figure 5 is a schematic diagram of the prior art hand-drawn teaching robot.
有關本發明為達成上述目的,所採用之技術手段及其功效,茲舉較佳實施例,並配合圖式加以說明如下。 With regard to the technical means adopted by the present invention in order to achieve the above-mentioned objects and their effects, preferred embodiments are described below in conjunction with the drawings.
機器人為了符合安全標準規範ISO 10218-1之要求,具備以下幾種運行模式(Operation Mode):自動模式(Auto Mode)、手動(或稱教導)模式(Manual Mode),教導模式又分為手動低速模式(Manual Reduced Mode)及手動高速模式(Manual High Speed Mode),其中自動模式定義為機器人自動運行程式,用於生產自動化作業,使用者為產線作業員;手動或教導模式則非用於生產自動化作業,而是用於機器人程式之編寫與測試,使用者為自動化工程師,其中手動低速模式用於點位教導、程式編纂、低速之試跑,而手動高速模式專門只用於程式之試跑,可達程式中全速之試跑,與自動模式功能相近但須額外安全裝置保護-於示教器上須持續按壓致能裝置以保安全。這些傳統之運行模式之切換常用模式切換裝置(Mode Switch)進行切換,如AUT(自動模式)、T1(手動低速模式)、T2(手動高速模式)之三位置旋鈕切換。而手拉牽引功能於ISO 10218-1中僅定義為協作功能,但未明述用於以上哪種用途,蓋因協作機器人技術尚仍處於發展期,安規尚未對新興技術之手拉牽引加以定義。目前手拉牽引已被用於各種運行模式,常見的有用於手動或教導模式中,便利自動化工程師教導點位、拖拉路徑,除此之外,亦常見用於自動模式中,便利產線操作員進行以下任務:手拉移動(例如牽引機器人至下一工作起始點)、手拉示範(例如手拉示範工作路徑)、手拉協作(例如使機器人舉重而由人引導其放置位置),以上自動模式下之手拉牽引非安全規範中之教導行為,而是自動生產過程中之手拉牽引操作。由此可見,手拉牽引可廣泛使用於自動模式、手動或教導模式。 In order to meet the requirements of the safety standard ISO 10218-1, the robot has the following operating modes: Auto Mode, Manual (or teaching) mode, and the teaching mode is divided into manual low speed Mode (Manual Reduced Mode) and Manual High Speed Mode (Manual High Speed Mode), in which the automatic mode is defined as the robot automatically runs the program, used for production automation operations, the user is the production line operator; manual or teaching mode is not used for production Automated operations are used for writing and testing robot programs. The user is an automation engineer. The manual low-speed mode is used for point teaching, programming, and low-speed test runs, while the manual high-speed mode is only used for program test runs. , Can reach the full speed test run in the program, similar to the automatic mode function but need additional safety device protection-keep pressing the enable device on the teach pendant to ensure safety. These traditional mode switching devices (Mode Switch) to switch, such as AUT (automatic mode), T1 (manual low-speed mode), T2 (manual high-speed mode) three-position knob switch. The hand pull function is only defined as a collaboration function in ISO 10218-1, but it is not clearly stated which purpose it is used for. The Gein collaborative robot technology is still in the development stage, and the safety regulations have not yet defined the emerging technology of hand pull. At present, manual traction has been used in various operating modes. Commonly used in manual or teaching mode, it is convenient for automation engineers to teach points and drag paths. In addition, it is also commonly used in automatic mode to facilitate production line operators. Carry out the following tasks: hand-drawn movement (for example, pulling the robot to the next starting point of work), hand-drawn demonstration (for example, hand-drawn demonstration of the working path), hand-drawn collaboration (for example, the robot lifts weight and the human guides its placement position), above The hand-pulling operation in automatic mode is not the teaching behavior in the safety specification, but the hand-pulling operation in the automatic production process. It can be seen that the hand traction can be widely used in automatic mode, manual or teaching mode.
請同時參閱圖1至圖2,圖1為本發明教導機器人的安全系統的示意圖,圖2為本發明安全系統的控制功能的示意圖,圖3為本發明利用模式切換裝置切換模式的示意圖。圖1中,本發明的安全系統10包含機器人11、控制器12、示教器13、安全模組14、安全功能單元15、致能裝置16及模式切換裝置17等。其中機器人11具有多肘節18,一端為固定的基座19,另一端為活動的末端20。機器人11連接至控制器12,控制器12內含一安全模組14及安全功能單元15。控制器12藉由控制各肘節18中的致動器及位置感測器21,控制移動機器人11的末端20。控制器12連接示教器13,用以編輯機器人11程式或操作控制機器人11。本發明的致能裝置16可設於示教器13或設於機器人11例如末端20,或使用者由控制器12外接獨立的致能裝置16,致能裝置16可設置於以上任一位置或複數位置設置。模式切換裝置17,
可為機器人示教器13內建,或使用者由控制器12外接的模式切換裝置17。
Please refer to FIGS. 1 to 2 at the same time. FIG. 1 is a schematic diagram of the safety system of the teaching robot of the present invention, FIG. 2 is a schematic diagram of the control function of the safety system of the present invention, and FIG. 3 is a schematic diagram of switching modes using the mode switching device of the present invention. In FIG. 1, the
圖2中,安全模組14及安全功能單元15經由控制器12與致能裝置16、模式切換裝置17及位置感測器21電性或通訊相連。致能裝置16具備開狀態(ON)與關狀態(OFF)操作的功能,當致能裝置16處於開狀態(ON)狀態時,安全模組14取消機器人11之安全狀態,而當致能裝置16處於關狀態(OFF)狀態時,安全模組14使機器人11停機進入安全狀態。安全模組14電性或通訊連接機器人11各肘節18之位置感測器21,接收位置感測器21的訊號進行監控機器人11的活動狀態。
In FIG. 2, the
安全模組14停機機器人11進入安全狀態有三種類型,零類安全狀態為斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,直接關斷致動器電力。一類安全狀態為進階斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,對控制器12下達減速命令後,經過固定時間或觀察機器人11減速運動達成後,關斷致動器電源。二類安全狀態為非斷電停機功能:當安全模組14判定機器人11應進入安全狀態時,對控制器12下達減速命令後,經過固定時間或觀察機器人減速運動達成後,開啟靜止監控安全功能(Standstill Monitoring),持續監控位置感測器21,當監控機器人11產生運動,即關斷致動器電源。
The
本發明的安全功能單元15可利用控制器12經由安全模組監控機器人11,啟動單一或多項安全功能,例如肘節18之角度限制、機器人11末端20的空間位置限制、力量限制(Power and force limiting)或速度限制等,但包含且不限於本實施例列舉的安全功能。當監控的機器人11的安全功能,超過預設限制而產生異常時,讓安全模組14使機器人11進入安全
狀態。本發明的安全模組14的各類安全狀態,及安全功能單元15的多項安全功能,啟用與否,及限制值,係依機器人11不同模式的需求而預先選擇設定。
The
圖3中,本發明的模式切換裝置17為多位置旋鈕,可於示教器13上透過旋鈕位置標示模式,或以燈號顯示模式。模式切換裝置17亦可為純軟體按鍵、硬體按鍵組合、或軟體與硬體組合按鍵,例如硬體按壓或旋轉允許輸入目標模式,接著由軟體選擇目標模式,再由硬體確認切往的模式。模式切換裝置17可切換機器人11的多種運行模式(Operation Mode),本實施例舉例包含自動模式(A模式),手拉模式(H模式)及非手拉模式,非手拉模式包含手動低速模式(T1模式)與手動高速模式(T2模式)等,但包含且不限於本實施例列舉的運行模式。
In FIG. 3, the
當使用者利用模式切換裝置17切入手拉模式(H模式)時,本發明機器人11進入安全狀態,因使用者切換手拉模式是要繼續手拉牽引機器人11,安全模組14將手拉模式預設為非斷電停機功能的二類安全狀態,再由使用者至少持續按壓致能裝置16,解除安全狀態,並致能手拉功能,由使用者手拉牽引機器人11,進行例如手拉牽引機器人至下一工作起始點,或手拉示範工作路徑,或手拉協作機器人舉重引導放置等。由於在手拉模式下,使用者接近機器人11作業,需要嚴格的安全保護,因此預設安全功能單元15的肘節18之角度限制、機器人11末端20的空間位置限制、力量限制及速度限制等多項安全功能,以確保使用者安全。
When the user uses the
使用者利用模式切換裝置17切換至非手拉的手動低速模式(T1模式),安全模組14將手動低速模式可預設例如為一類安全狀態的進階
斷電停機功能,切換後安全模組14先進入安全狀態,確保機器人已停機之後,重新啟動對致能裝置16之監控與反應,此時致能裝置16用於致能包含但不限於非手拉教導或教導驗證動作,例如對各肘節18、機器人11、末端20的坐標系各軸方向進行吋動,或機器人11校正動作,或末端20移動到特定點位之動作,或單步執行教導編程之動作等。由於在手動低速模式屬非手拉模式,使用者未接近機器人11作業,不需要嚴格的安全保護,因此僅需預設安全功能單元15的力量限制及速度限制等項安全功能。
The user uses the
使用者利用模式切換裝置17切換至手動高速模式(T2模式),因高速移動對使用者危害較大,安全模組14將手動高速模式可預設例如為零類安全狀態為斷電停機功能,切換後安全模組14先進入安全狀態,確保機器人已停機之後,重新啟動對致能裝置16之監控與反應,需持續按壓致能裝置16始能連續致能,進行例如手動試跑等。由於在手動高速模式屬非手拉模式,使用者未接近機器人11作業,不需要嚴格的安全保護,因此僅需預設安全功能單元15的速度限制等項安全功能。
The user uses the
使用者利用模式切換裝置17切換至自動模式(A模式),由使用者藉控制器12控制機器人11進行自動作業。由於自動模式,因自動移動對使用者危害較大,安全模組14將手動高速模式可預設例如為零類安全狀態為斷電停機功能,另需監控機器人11自動作業是否異常,因此當自動運行為協作情境時,需啟用預設安全功能單元15的機器人11末端20的空間位置限制、力量限制及速度限制等多項安全功能,而當自動模式為非協作情境時則可不啟用,以確保作業效率。
The user uses the
利用模式切換裝置17自手動慢速模式或手動高速模式或自
動模式切換至手拉模式時,機器人11自行記錄運行程序的斷點,並啟動手拉模式預先設定的二類安全狀態的安全模組14及多項安全功能,致能手拉功能,在維持手拉模式專用的安全系統下,由使用者手拉教導機器人11修正新作業程序後,切回各運行模式後,從中斷點繼續運行程序。前述本實施利對各運行模式預設的安全模式及安全功能為舉例說明,本發明包含且不限於本實施例的設定項目。
Use the
如圖4所示,為本發明教導機器人的安全方法的流程圖。本發明教導機器人的安全方法的詳細步驟說明如下:步驟S1,依照機器人各種運行模式的需要,預設各教導模式相對應的安全模組的安全狀態種類;步驟S2,依照機器人各種運行模式的需要,預設各運行模式相對應的安全模組的安全功能;步驟S3,進行切換模式;步驟S4,檢查切換的模式是否為自動模式?假如切換的模式不為自動模式,則至步驟S5,再檢查切換的模式是否為手拉模式?假如切換的模式為手拉模式,則至步驟S6,進入手拉模式;至步驟S7,啟動該模式預設相對應的安全模組,停機機器人進入安全狀態;再至步驟S8,啟動該模式預設相對應的安全功能,監控機器人;接著在步驟S9,使致能裝置致能,在步驟S10,偵測致能裝置的開狀態,解除機器人的安全狀態,進行教導機器人作業,然後至步驟S11,檢查機器人的是否完成作業?假如機器人完成作業,則至步驟S12,結束作業,假如機器人未完成作業,則回至步驟S3,繼續切換模式。 As shown in Fig. 4, it is a flow chart of the safety method for teaching robots in the present invention. The detailed steps of the safety method for teaching a robot of the present invention are described as follows: Step S1, according to the needs of various operating modes of the robot, preset the safety state types of the safety modules corresponding to each teaching mode; Step S2, according to the needs of various operating modes of the robot , Preset the security function of the security module corresponding to each operating mode; step S3, switch mode; step S4, check whether the switched mode is automatic mode? If the switched mode is not the automatic mode, go to step S5, and then check whether the switched mode is the hand-drawn mode? If the switched mode is the hand-pulling mode, go to step S6 to enter the hand-pulling mode; to step S7, start the safety module corresponding to the mode preset, and stop the robot to enter the safe state; go to step S8 to start the mode preset Set the corresponding safety function to monitor the robot; then in step S9, enable the enabling device, in step S10, detect the on state of the enabling device, release the safe state of the robot, and perform the teaching robot operation, and then go to step S11 , Check whether the robot has completed the job? If the robot completes the work, go to step S12 to end the work. If the robot does not complete the work, go back to step S3 and continue to switch modes.
在步驟S4,檢查切換的模式為自動模式時,則至步驟S13,進入自動模式,接著至步驟S14,啟動自動模式預設相對應的安全模組及安全功能,監控機器人,進行機器人自動作業,然後回至步驟S11,繼續作業。 In step S4, check that the switched mode is the automatic mode, go to step S13, enter the automatic mode, and then go to step S14, start the safety module and safety function corresponding to the automatic mode preset, monitor the robot, and perform the robot automatic operation, Then return to step S11 to continue the operation.
在步驟S5,檢查切換的模式不為手拉模式時,則至步驟S15,檢查切換的模式是否為手動高速模式?假如檢查切換的模式為手動高速模式,則至步驟S16,進入手動高速模式,然後回至步驟S7,繼續作業,假如檢查切換的模式不為手動高速模式,則至步驟S17,進入手動低速模式,然後回至步驟S7,繼續作業。 In step S5, check that the switched mode is not the hand-pulled mode, then go to step S15 to check whether the switched mode is manual high-speed mode? If the checked mode is manual high-speed mode, go to step S16 to enter manual high-speed mode, and then return to step S7 to continue the operation. If the checked mode is not manual high-speed mode, go to step S17 and enter manual low-speed mode. Then return to step S7 to continue the operation.
因此,本發明的教導機器人的安全系統及方法,就可藉由模式切換裝置切換機器人的多種運行模式,並配合致能裝置,啟用相對應各教導模式預設不同的安全模組及安全功能,達到方便切換多種運行模式的目的。此外,本發明的教導機器人的安全方法,利用預設各運行模式相對應的安全模組及安全功能切換機器人,建構各運行模式適合的安全系統,同時確保在各種運行模式切換至手拉模式時,都能維持手拉模式專有的安全模組及安全功能,達到提升使用者的安全性的目的。 Therefore, the safety system and method for teaching a robot of the present invention can switch multiple operating modes of the robot through the mode switching device, and cooperate with the enabling device to enable preset different safety modules and safety functions corresponding to each teaching mode. To achieve the purpose of facilitating the switching of multiple operating modes. In addition, the safety method for teaching robots of the present invention utilizes preset safety modules and safety function switching robots corresponding to each operation mode to construct a safety system suitable for each operation mode, and at the same time ensures that when various operation modes are switched to the hand-drawn mode , Can maintain the exclusive safety module and safety function of the pull mode, and achieve the purpose of improving the safety of the user.
以上所述者,僅為用以方便說明本發明之較佳實施例,本發明之範圍不限於該等較佳實施例,凡依本發明所做的任何變更,於不脫離本發明之精神下,皆屬本發明申請專利之範圍。 The above are only used to facilitate the description of the preferred embodiments of the present invention. The scope of the present invention is not limited to these preferred embodiments. Any changes made according to the present invention will not depart from the spirit of the present invention. , All belong to the scope of the patent application of the present invention.
10:安全系統 10: Security system
11:機器人 11: Robot
12:控制器 12: Controller
13:示教器 13: Teach Pendant
14:安全模組 14: Security module
15:安全功能單元 15: Safety function unit
16:致能裝置 16: Enabling device
17:模式切換裝置 17: Mode switching device
18:肘節 18: toggle
19:基座 19: Pedestal
20:末端 20: end
21:位置感測器 21: position sensor
Claims (15)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW109118891A TWI748501B (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 |
---|---|---|---|
TW109118891A TWI748501B (en) | 2020-06-05 | 2020-06-05 | Safety system and method for teaching a robot |
Publications (2)
Publication Number | Publication Date |
---|---|
TWI748501B true TWI748501B (en) | 2021-12-01 |
TW202146195A TW202146195A (en) | 2021-12-16 |
Family
ID=80680827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW109118891A TWI748501B (en) | 2020-06-05 | 2020-06-05 | Safety system and method for teaching a robot |
Country Status (1)
Country | Link |
---|---|
TW (1) | TWI748501B (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101992470A (en) * | 2009-08-25 | 2011-03-30 | 库卡罗伯特有限公司 | Method and assembly for securely controlling a manipulator |
CN108340370A (en) * | 2017-01-24 | 2018-07-31 | 发那科株式会社 | The robot system of press device is controlled with power |
CN109249376A (en) * | 2017-07-12 | 2019-01-22 | 发那科株式会社 | The teaching method of robot system and robot |
CN209335656U (en) * | 2018-12-24 | 2019-09-03 | 合肥欣奕华智能机器有限公司 | A kind of industrial robot function test system |
-
2020
- 2020-06-05 TW TW109118891A patent/TWI748501B/en active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101992470A (en) * | 2009-08-25 | 2011-03-30 | 库卡罗伯特有限公司 | Method and assembly for securely controlling a manipulator |
CN108340370A (en) * | 2017-01-24 | 2018-07-31 | 发那科株式会社 | The robot system of press device is controlled with power |
CN109249376A (en) * | 2017-07-12 | 2019-01-22 | 发那科株式会社 | The teaching method of robot system and robot |
CN209335656U (en) * | 2018-12-24 | 2019-09-03 | 合肥欣奕华智能机器有限公司 | A kind of industrial robot function test system |
Also Published As
Publication number | Publication date |
---|---|
TW202146195A (en) | 2021-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2541351B1 (en) | Block execution sequence display system | |
CN109483601B (en) | Industrial robot function test system and test method | |
US9802286B2 (en) | Robot control system provided in machining system including robot and machine tool | |
CN107414837B (en) | Method and system for safely and automatically returning to original position after abnormal shutdown of industrial robot | |
JP6457416B2 (en) | Robot system | |
JP2005103690A (en) | Industrial control controller | |
TWI748501B (en) | Safety system and method for teaching a robot | |
JP6240422B2 (en) | Robot control system and robot control method | |
US20210213610A1 (en) | Control Method For Robot, And Robot System | |
CN113799176B (en) | Safety system and method for teaching robot | |
US9971331B2 (en) | Monitoring device for programmable controller | |
US11667037B2 (en) | Robot system with hand-guiding function | |
US20220258350A1 (en) | Robot Monitoring Apparatus And Robot System | |
CN114347025B (en) | Cooperative robot function safety control circuit, control method and cooperative robot | |
EP4169671A1 (en) | Safety system and method for teaching a robot | |
US20230122989A1 (en) | Safety system and method for teaching a robot | |
CN114161424B (en) | Control method and control system for dynamic braking of SCARA robot | |
TW202146191A (en) | Safety system and method for teaching a robot | |
TWI789639B (en) | Robot safety system and method for auto mode | |
CN113799117A (en) | Safety system and method for teaching robot | |
US10232509B2 (en) | Robot apparatus | |
JP2016212802A (en) | Screen information generation device | |
JPH07299793A (en) | Robot interference preventive controlling device | |
TWI762006B (en) | Control system and method for a safety state of a robot | |
CN105785970A (en) | Monitoring Device For Programmable Controller |