ITTO20110994A1 - Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune - Google Patents
Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune Download PDFInfo
- Publication number
- ITTO20110994A1 ITTO20110994A1 IT000994A ITTO20110994A ITTO20110994A1 IT TO20110994 A1 ITTO20110994 A1 IT TO20110994A1 IT 000994 A IT000994 A IT 000994A IT TO20110994 A ITTO20110994 A IT TO20110994A IT TO20110994 A1 ITTO20110994 A1 IT TO20110994A1
- Authority
- IT
- Italy
- Prior art keywords
- robot
- region
- robots
- regions
- hybrid
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 18
- 230000000903 blocking effect Effects 0.000 claims description 3
- 230000009849 deactivation Effects 0.000 description 3
- 230000004913 activation Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39083—Robot interference, between two robot arms
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40219—Detect contact, proximity of other manipulators
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40306—Two or more independent robots
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Quality & Reliability (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- General Factory Administration (AREA)
Description
DESCRIZIONE
“Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comuneâ€
La presente invenzione riguarda un metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune, in cui si predispone una unità elettronica centrale di controllo dei robot, predisposta per comunicare con i diversi robot e per comandare i movimenti dei robot evitando una interferenza fra i robot nella loro regione di lavoro comune.
Tecnica nota
Nella programmazione standard di una cella industriale con più robot che devono lavorare in uno spazio condiviso, à ̈ necessario definire istruzioni all’interno del programma di ciascun robot, affinché il robot effettui in successione le seguenti operazioni:
1. Richiesta di prenotazione per l’ingresso in regione condivisa (un segnale di output verso l’unità di controllo)
2. Attesa di consenso dall’unità di controllo per l’ingresso in regione condivisa (un segnale di input al robot dall’unità di controllo)
3. Presenza all’interno della regione condivisa (un segnale di output)
4. Uscita dalla regione condivisa
La successione di questi comandi deve essere riportata su ogni singola parte di programma in cui à ̈ previsto un cosiddetto “interblocco†di programmazione (corrispondente ad una fase di lavoro in regione condivisa). La gestione della policy che regola gli accessi ad una o più regioni condivise à ̈ demandata all’unità di controllo (PLC), che si prende carico di governare la priorità dei robot che possono accedere a dette regioni. In un esempio di programma semplice in cui due soli robot condividono un’area di lavoro comune, il PLC, a fronte di una richiesta di accesso da parte di un robot R1, controlla che non vi siano altre richieste pendenti da R2e che R2non stia lavorando nella regione condivisa. In caso affermativo, à ̈ permesso l’accesso ad R1. Analogamente si può riformulare la policy per l’accesso di R2. Il suddetto sistema di accessi PLC può essere schematizzato come riportato nell’annessa Figura 1.
I programmi robot devono essere in grado a loro volta di gestire i segnali di input (per l’accesso) e di output (per comunicare al PLC la prenotazione e la presenza o meno all’interno della regione condivisa) in modo tale da poter gestire correttamente la politica di accesso e rilascio delle regioni condivise. Un esempio di programma robot à ̈ il seguente:
invio(rich_I2, ON)
attesa(cons_I2, ON)
invio(interf_I2, OFF)
invio(rich_I2, OFF)
MOVEFLY JOINT TO pnt0650x ADVANCE
MOVEFLY JOINT TO pnt0150x ADVANCE
MOVEFLY JOINT TO pnt0653x ADVANCE
MOVE JOINT TO wp4661,
WITH CONDITION[spot(1, 4661, 1, FALSE)], ENDMOVE MOVEFLY JOINT TO pnt0444x ADVANCE
MOVEFLY JOINT TO pnt0443x ADVANCE
MOVEFLY JOINT TO pnt0442x ADVANCE
MOVE JOINT TO xtn0008X
Invio (interf_I2, ON)
Come si vede, à ̈ previsto l’invio del segnale rich_I2 che rappresenta la richiesta di accesso nella regione di interblocco I2. Successivamente a questo segnale, il sistema rimane in attesa del segnale cons_I2 che deve essere inviato dal PLC per consentire l’accesso alla regione di interblocco. Una volta ottenuto il via libera dal PLC, il robot invia il segnale di occupazione della regione di interferenza interf_I2 ed azzera il segnale di prenotazione rich_I2. Dopo aver effettuato i movimenti infine, il robot azzera il segnale di occupazione della regione di interblocco interf_I2.
Data un’architettura siffatta, i principali limiti sono i seguenti:
- modificando il flusso dei programmi robot, ci sono alte probabilità di porre il sistema in situazioni di incongruenza. E.g. se un robot viene spostato manualmente (in PROG) in una regione condivisa, il PLC non viene “avvertito†della sua presenza e questo può causare un generico malfunzionamento del sistema di interblocchi, con il conseguente probabile impatto tra i robot;
- la complessità dei programmi robot à ̈ particolarmente elevata in quanto per ogni singolo interblocco à ̈ necessario inserire le istruzioni per la prenotazione, per l’attesa, per la presenza ed il rilascio della regione condivisa;
- non c’à ̈ alcun controllo real-time della posizione del robot per individuare la presenza dello stesso in una regione condivisa; la disattivazione dei programmi di movimento del robot implica che in programmazione non esiste alcun tipo di controllo per prevenire le collisioni tra robot;
- l’eventuale modifica dei programmi di lavoro del robot implica necessariamente una modifica coerente delle istruzioni relative agli interblocchi in ogni parte del/i programma/i;
- un ulteriore limite riguarda l’eventualità , molto frequente, che l’utente salti alcune istruzioni nel programma di lavoro (bypass che à ̈ effettuato prevalentemente nelle fasi iniziali della programmazione, per testare i programmi di lavoro dei robot) oppure che l’utente sposti erroneamente il cursore all’interno del programma, saltando ad esempio le operazioni di richiesta d’accesso o di occupazione della regione d’interblocco.
Scopo dell’invenzione
Lo scopo della presente invenzione à ̈ quello di ovviare ai suddetti inconvenienti. Sintesi dell’invenzione
In vista di raggiungere tale scopo, l’invenzione ha per oggetto un metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune, in cui si predispone una unità elettronica centrale di controllo dei robot predisposta per comunicare con i diversi robot e per comandare i movimenti dei robot evitando una interferenza fra i robot nella loro regione di lavoro comune, detto metodo essendo caratterizzato dal fatto che:
- lo spazio di lavoro di ciascun robot viene modellato, tenendo conto degli oggetti presenti nello spazio di lavoro del robot, mediante la definizione di una o più regioni di interferenza (IR) costituite ciascuna da una figura geometrica elementare, - le suddette regioni di interferenza vengono classificate nelle seguenti tre diverse categorie:
- regioni di interferenza proibite (PIR), definite come regioni di spazio dove la presenza del robot à ̈ sempre tassativamente interdetta, ad esempio a causa della presenza permanente di uno o più oggetti con cui il robot non deve interferire,
- regioni di interferenza monitorate (MIR), definite come regioni di spazio dove la presenza del robot à ̈ accettata, ma controllata, il robot essendo predisposto per inviare un segnale all’unità di controllo centrale ogni volta che esso entra in una regione monitorata e ogni volta che esso esce da una regione monitorata,
- regioni di interferenza ibride (HIR), definite come regioni di spazio che sono suscettibili di cambiare fra uno stato di regione monitorata ed uno stato di regione proibita, in funzione di un segnale di input al robot inviato da detta unità di controllo centrale,
- ciascun robot à ̈ predisposto per inviare all’unità di controllo centrale un primo segnale di output, servente come prenotazione di ingresso, ogni volta che à ̈ prossimo ad entrare in una regione ibrida, e un secondo segnale di output, servente come segnalazione di ingresso/presenza, ogni volta che entra in una regione ibrida,
- lo stato di ciascuna regione ibrida viene variato dinamicamente per ciascun robot, durante il funzionamento dei robot, mediante invio da parte dell’unità di controllo centrale di un segnale di input al robot, che rende la regione ibrida proibita o monitorata per tale robot, in funzione del fatto che detta regione ibrida sia libera o no da altri robot.
Secondo un’ulteriore caratteristica, quando una regione ibrida à ̈ commutata per un dato robot in uno stato di regione proibita mediante invio a detto robot del suddetto segnale di input al robot da parte dell’unità di controllo centrale, se il robot à ̈ in movimento verso detta regione esso viene decelerato in modo controllato fino al limite della regione ibrida, dove la velocità del robot raggiunge lo zero, mentre quando la regione viene riabilitata mediante un nuove segnale di input al robot, portandola nello stato di regione monitorata, il sistema provvede a ripristinare automaticamente il movimento del robot, senza bloccare il movimento pendente del robot nel caso esso sia ancora in corso.
Come si vede, il metodo secondo l’invenzione si caratterizza essenzialmente per il fatto di controllare i robot in parallelo, invece che adottare il modo di funzionamento sequenziale della tecnica nota. In particolare nel metodo dell’invenzione, oltre a prevedere il controllo dello spazio di lavoro di ciascun robot mediante un segnale di output dal robot, prevede anche la possibilità di gestire l’attivazione/disattivazione dell’interdizione all’ingresso nella regione ibrida con un input al robot dal PLC e prevede inoltre la possibilità di definire un ulteriore segnale di output verso il PLC per la prenotazione dell’ingresso nella regione ibrida. Il metodo inoltre gestisce la fermata e la ripresa automatica del movimento del robot regolando la velocità di arresto e di ripresa dello stesso in maniera da evitare arresti bruschi in prossimità del limite della regione di interferenza interdetta e per ripristinare il movimento del robot il più velocemente possibile.
Ulteriori caratteristiche e vantaggi dell’invenzione risulteranno dalla descrizione che segue con riferimento ai disegni annessi, forniti a puro titolo di esempio non limitativo, in cui:
- la figura 1 illustra lo schema a blocchi già sopra descritto, corrispondente ai metodi secondo la tecnica nota,
- la figura 2 Ã ̈ una vista prospettica schematica che mostra una cella con due robot industriali aventi rispettivi spazi di lavoro includenti regioni condivise,
- le figure 3-6 mostrano diverse figure geometriche utilizzate per definire le regioni di interferenza nello spazio di lavoro di ciascun robot.
Con riferimento alla figura 2, una cella 1 prevede una postazione di lavoro con un banco di lavoro 2 su cui due robot 3,4 eseguono operazioni, ad esempio per l’assemblaggio e/o la saldatura di componenti. I due robot 3, 4 sono controllati da rispettive unità elettroniche di controllo 5 e 6 a loro volta collegate entrambe ad una unità elettronica centrale di controllo 7 utilizzata per implementare il metodo secondo l’invenzione. L’unità centrale 7 ad esempio può essere costituita dal PLC di controllo della cella 1. Tuttavia, la funzione di controllo centrale può anche essere delegata ad una delle due unità 5, 6 di controllo dei singoli robot. Inoltre, nella presente descrizione e nelle rivendicazioni che seguono, laddove si parla di almeno due robot suscettibili di interferire fra loro, si vuole comprendere anche il caso di un robot multi-braccio, in cui almeno due bracci sono controllati separatamente e sono suscettibili di interferire fra loro. In questo caso l’unico robot ha un’unica unità di controllo, in cui viene implementato il metodo dell’invenzione.
I robot 3, 4 hanno rispettivi spazi di lavoro che includono regioni condivise, che comportano un potenziale rischio di interferenza fra i due robot. Negli spazi di lavoro dei robot sono anche presenti oggetti (ad esempio il banco fisso 2) che rendono del tutto inaccessibili ai robot le corrispondenti regioni del loro spazio di lavoro.
Per affrontare il problema delle interferenze tra ciascun robot e l’ambiente intorno ad esso, secondo l’invenzione si definiscono figure geometriche elementari, chiamate regioni di interferenza (IR), ad esempio sostanzialmente in forma di cilindri (figura 3), parallelepipedi (figura 4), piani (figura 5), o sfere (figura 6), da inserire nell’area di lavoro del robot in modo tale da avere una modellazione spaziale e volumetrica coerente con gli oggetti presenti all’interno dello spazio di lavoro del robot. Nelle figure 3, 4 e 6, le regioni di interferenza sono costituite dai volumi mostrati con linea tratteggiata, contenuti all’interno di volumi più grandi, mostrati con linea continua, che fungono da regioni di “warning†, all’interno delle quali si segnala l’approssimarsi di una parte mobile del robot al confine di una regione di interferenza. Nel caso della figura 5, la regione di interferenza à ̈ costituita da un piano verticale A. Il piano B ad esso affacciato delimita il confine oltre il quale viene attivato un segnale di warning.
Nel metodo secondo l’invenzione à ̈ possibile definire un numero anche elevato (ad esempio fino a 16) di regioni di interferenza. Secondo l’invenzione le regioni di interferenza sono classificate nelle seguenti tre diverse categorie:
- Regioni di Interferenza Monitorate (MIR)
- Regioni di Interferenza Proibite (PIR)
- Regioni di interferenza Ibride (HIR)
Le regioni monitorate sono dei volumi dove la presenza del robot à ̈ controllata e nel caso in cui il robot acceda a queste regioni, un segnale di output verrà alzato verso l’esterno (ad es. verso un PLC) ed analogamente abbassato nel caso di uscita dalla regione (à ̈ anche possibile scegliere la logica dell’output).
Le regioni proibite sono dei volumi dove la presenza del robot à ̈ tassativamente interdetta. La definizione di un volume di questo tipo nell’area di lavoro del robot, comporta il controllo continuo della posizione del robot in modo tale da evitare il raggiungimento dell’area; questo controllo viene fatto, qualunque sia lo stato del robot (programmazione o automatico). La prestazione permette di evitare il contatto con la/e regione/i di interferenza dichiarata/e regolando automaticamente la velocità del robot in base alla sua distanza dalla regione stessa. Nessun segnale di output verrà inviato al PLC ma nel caso di raggiungimento della IR, il sistema provvederà a generare un errore, fermando il robot.
Le regioni ibride infine sono dei volumi che possono cambiare il loro stato da monitorate a proibite e viceversa sulla base dello stato logico del segnale di input. Contemporaneamente à ̈ possibile definire un segnale di output che funga da prenotazione per l’ingresso nella regione ed un altro segnale di output per l’accesso nella regione ibrida. In questo modo si possono gestire in maniera versatile ed innovativa (rispetto ai competitors) gli interblocchi come descritto nel prossimo paragrafo. Le regioni ibride, quando sono rese proibite dall’input, hanno inoltre la caratteristica di indurre nel robot una decelerazione controllata fino al limite della regione, dove la velocità del robot raggiunge lo zero. Nel momento in cui la regione viene riabilitata dall’input, rendendola monitorata, il sistema provvede a ripristinare automaticamente il movimento del robot, senza bloccare il movimento pendente; essendo la regione monitorata a questo punto il sistema provvederà a comunicare all’esterno tramite gli output, la presenza o meno del robot all’interno dell’area di prenotazione o all’interno dell’Interference Region.
Grazie ai suddetti accorgimenti, l’invenzione à ̈ in grado di consentire una programmazione avanzata degli interblocchi.
La possibilità di definire delle regioni ibride che possano variare il loro stato passando da monitorate a proibite permette una gestione avanzata degli interblocchi “classici†utilizzati nelle celle robotizzate reali. L’aspetto essenziale dell’invenzione risiede essenzialmente nella possibilità di definire regioni, con diverse forme/geometrie, dinamicamente attivabili/disattivabili da un input e che automaticamente gestiscono il settaggio di due tipologie di output: un output di prenotazione per l’ingresso nella regione condivisa ed un output di presenza all’interno della regione condivisa stessa. Con questi tre segnali à ̈ possibile mantenere invariata la gestione della policy di accesso del PLC rappresentata in Fig.1 (offrendo un vantaggio non indifferente per quanto riguarda gli aspetti di compatibilità con gli attuali sistemi), semplificando però in maniera drastica la gestione degli interblocchi all’interno dei programmi robot. Dopo aver definito, infatti, le regioni di interferenza ibride (che quindi rappresentano lo spazio di lavoro condiviso tra due o più robot), basta associare i corretti input ed output alle regioni di interferenza dichiarate nel programma in modo che possano essere gestiti dal PLC. Nel seguito viene riportato un esempio di programmazione di una regione di interferenza ibrida sferica:
IR_SET(IR_RESERVATION,$FMO[1],1,1,ON)
IR_SET(IR_PRESENCE,$FMO[1],2,1,OFF)
IR_SET(IR_CONSENT,$FMI[1],1,1,ON)
IR_CreateSphere(pnt0007P, 200, 1, 1)
IR_SWITCH(ON,1)
MOVEFLY JOINT TO pnt0650x ADVANCE
MOVEFLY JOINT TO pnt0150x ADVANCE
MOVEFLY JOINT TO pnt0653x ADVANCE
MOVE JOINT TO wp4661,
WITH CONDITION[spot(1, 4661, 1, FALSE)], ENDMOVE MOVEFLY JOINT TO pnt0444x ADVANCE
MOVEFLY JOINT TO pnt0443x ADVANCE
MOVEFLY JOINT TO pnt0442x ADVANCE
MOVE JOINT TO xtn0008X
Le prime tre istruzioni sopra indicate servono per dichiarare che l’Interference Region à ̈ di tipo ibrido e per definire su quali output e input devono essere mappate le porte per la prenotazione, la presenza e la richiesta di accesso. L’istruzione IR_CreateSphere(…) ha lo scopo di definire nello spazio di lavoro del robot, una regione di interferenza sferica ibrida alla quale sono associati gli output ed input precedentemente dichiarati. È da notare che la dichiarazione della regione à ̈ effettuata una sola volta all’inizio del programma e renderà totalmente automatica la gestione degli interblocchi, a prescindere dal flusso del programma stesso, nel quale non saranno più presenti istruzioni esplicite su invio ed attesa di segnali (diversamente dalla soluzione secondo la tecnica nota).
In qualunque condizione operativa (sia in fase di programmazione del robot, sia nella fase di funzionamento automatico del robot), il sistema verificherà automaticamente lo stato delle regioni di interferenza ibride, imposto dall’input in ingresso. In questo modo se l’accesso ad una regione di interferenza à ̈ interdetto ad un robot (impostando ad esempio l’input a 0), questo non sarà in grado di entrare autonomamente all’interno della regione, qualora ad esempio sul robot à ̈ in esecuzione un programma qualsiasi di movimento, ed analogamente l’ingresso sarà interdetto al robot anche quando un operatore umano in programmazione tenti di portare il robot all’interno della regione interdetta. Il comportamento del robot in entrambi i casi à ̈ quello di effettuare un rallentamento controllato per portarlo a velocità nulla al limitare della regione di interferenza proibita, con una riduzione dell’override generale proporzionale alla distanza dal punto più vicino tra il Tool Center Point del robot e l’Interference Region.
L’innovazione introdotta con le Hybrid Interference Regions riguarda principalmente la possibilità di ripristinare automaticamente la movimentazione del robot a fronte di un cambiamento nell’input di controllo dello stato della IR ibrida. In altre parole il robot à ̈ in grado di riprendere autonomamente il movimento precedente (con un aumento smooth dell’override) alla fermata in prossimità dell’IR interdetta, qualora il segnale di input passasse da 0 (condizione di interdizione all’ingresso) a 1 (condizione di accesso consentito).
Come risulta evidente dalla descrizione che precede, il metodo secondo l’invenzione si caratterizza essenzialmente per il fatto di controllare i robot in parallelo, invece che adottare il modo di funzionamento sequenziale della tecnica nota. In particolare nel metodo dell’invenzione, oltre a prevedere il controllo dello spazio di lavoro di ciascun robot mediante un segnale di output dal robot, prevede anche la possibilità di gestire l’attivazione/disattivazione dell’interdizione all’ingresso nella regione ibrida con un input al robot dal PLC e prevede inoltre la possibilità di definire un ulteriore segnale di output verso il PLC per la prenotazione dell’ingresso nella regione ibrida. Il metodo inoltre gestisce la fermata e la ripresa automatica del movimento del robot regolando la velocità di arresto e di ripresa dello stesso in maniera da evitare arresti bruschi in prossimità del limite della regione di interferenza interdetta e per ripristinare il movimento del robot il più velocemente possibile.
Naturalmente, fermo restando il principio del trovato, i particolari di costruzione e le forme di attuazione potranno ampiamente variare rispetto a quanto descritto e illustrato a puro titolo di esempio, senza per questo uscire dall'ambito della presente invenzione.
Claims (2)
- RIVENDICAZIONI 1. Metodo per il controllo di almeno due robot (3, 4) aventi rispettivi spazi di lavoro includenti almeno una regione in comune, in cui si predispone una unità elettronica centrale (7) di controllo dei robot predisposta per comunicare con i diversi robot (3, 4) e per comandare i movimenti dei robot evitando una interferenza fra i robot nella loro regione di lavoro comune, detto metodo essendo caratterizzato dal fatto che: - lo spazio di lavoro di ciascun robot viene modellato, tenendo conto degli oggetti presenti nello spazio di lavoro del robot, mediante la definizione di una o più regioni di interferenza (IR) costituite ciascuna da una figura geometrica elementare, - le suddette regioni di interferenza vengono classificate nelle seguenti tre diverse categorie: - regioni di interferenza proibite (PIR), definite come regioni di spazio dove la presenza del robot à ̈ sempre tassativamente interdetta, ad esempio a causa della presenza permanente di uno o più oggetti con cui il robot non deve interferire, - regioni di interferenza monitorate (MIR), definite come regioni di spazio dove la presenza del robot à ̈ accettata, ma controllata, il robot essendo predisposto per inviare un segnale all’unità di controllo centrale ogni volta che esso entra in una regione monitorata e ogni volta che esso esce da una regione monitorata, - regioni di interferenza ibride (HIR), definite come regioni di spazio che sono suscettibili di cambiare fra uno stato di regione monitorata ed uno stato di regione proibita, in funzione di un segnale di input al robot inviato da detta unità di controllo centrale, - ciascun robot (3, 4) à ̈ predisposto per inviare all’unità di controllo centrale (7) un primo segnale di output, servente come prenotazione di ingresso, ogni volta che à ̈ prossimo ad entrare in una regione ibrida, e un secondo segnale di output, servente come segnalazione di ingresso/presenza, ogni volta che entra in una regione ibrida, - lo stato di ciascuna regione ibrida viene variato dinamicamente per ciascun robot (3,4), durante il funzionamento dei robot, mediante invio da parte dell’unità di controllo centrale (7) di un segnale di input al robot, che rende la regione ibrida monitorata o proibita per tale robot, in funzione del fatto che detta regione ibrida sia libera o no da altri robot.
- 2. Metodo secondo la rivendicazione 1, caratterizzato dal fatto che quando una regione ibrida à ̈ commutata per un dato robot (3, 4) in uno stato di regione proibita mediante invio a detto robot del suddetto segnale di input al robot da parte dell’unità di controllo centrale (7), a patto che il robot sia in movimento verso detta regione, esso viene decelerato in modo controllato fino al limite della regione ibrida, dove la velocità del robot raggiunge lo zero, mentre quando la regione viene riabilitata mediante un nuovo segnale di input al robot, portandola nello stato di regione monitorata per il robot, il sistema provvede a ripristinare automaticamente il movimento del robot, senza bloccare il movimento pendente del robot nel caso esso sia ancora in corso.
Priority Applications (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
IT000994A ITTO20110994A1 (it) | 2011-10-31 | 2011-10-31 | Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune |
EP12160063.9A EP2586574B1 (en) | 2011-10-31 | 2012-03-19 | Method for controlling at least two robots having respective working spaces including at least one region in common |
KR1020120033099A KR101867626B1 (ko) | 2011-10-31 | 2012-03-30 | 적어도 하나의 공통 영역을 포함하여 각자의 작업 공간을 가지는 2대 이상의 로봇을 제어하는 방법 |
BR102012010254A BR102012010254B8 (pt) | 2011-10-31 | 2012-04-30 | método para controlar pelo menos dois robôs |
US13/473,124 US8818558B2 (en) | 2011-10-31 | 2012-05-16 | Method for controlling at least two robots having respective working spaces including at least one region in common |
JP2012122936A JP6118509B2 (ja) | 2011-10-31 | 2012-05-30 | 少なくとも1つの共通の領域を含むそれぞれの作業スペースを有する少なくとも2台のロボットを制御する方法 |
RU2012122451/02A RU2593816C2 (ru) | 2011-10-31 | 2012-05-30 | Способ управления по меньшей мере двумя роботами, имеющими соответствующие рабочие пространства, включающие в себя по меньшей мере одну общую область |
CN2012101877990A CN103085057A (zh) | 2011-10-31 | 2012-05-31 | 用于控制具有包括至少一个公共区域的各自的工作空间的至少两个机械手的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
IT000994A ITTO20110994A1 (it) | 2011-10-31 | 2011-10-31 | Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune |
Publications (1)
Publication Number | Publication Date |
---|---|
ITTO20110994A1 true ITTO20110994A1 (it) | 2013-05-01 |
Family
ID=45814435
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
IT000994A ITTO20110994A1 (it) | 2011-10-31 | 2011-10-31 | Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune |
Country Status (8)
Country | Link |
---|---|
US (1) | US8818558B2 (it) |
EP (1) | EP2586574B1 (it) |
JP (1) | JP6118509B2 (it) |
KR (1) | KR101867626B1 (it) |
CN (1) | CN103085057A (it) |
BR (1) | BR102012010254B8 (it) |
IT (1) | ITTO20110994A1 (it) |
RU (1) | RU2593816C2 (it) |
Families Citing this family (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6229324B2 (ja) | 2013-06-14 | 2017-11-15 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットの制御方法 |
US10073434B1 (en) * | 2014-07-25 | 2018-09-11 | Jonathan Marc Hollander | Manufacturing systems and methods with multiple independent toolheads |
DE102014222857A1 (de) * | 2014-11-10 | 2016-05-12 | Kuka Roboter Gmbh | Flexibles taktzeitoptimiertes Teilen eines Arbeitsraums für Roboter |
CN107003646B (zh) * | 2014-11-13 | 2020-01-10 | 西门子公司 | 用于在产品处执行生产功能的生产模块 |
CN104476027B (zh) * | 2014-11-14 | 2016-01-20 | 南京熊猫电子股份有限公司 | 一种多机器人焊接系统的群控装置及其方法 |
EP3256292B1 (en) | 2015-02-13 | 2022-05-11 | ABB Schweiz AG | A method for avoiding collisions between two robots |
DE102015104821A1 (de) * | 2015-03-27 | 2016-09-29 | Medineering Gmbh | Chirurgisches Instrument, System, Haltearm sowie Verfahren |
US9744668B1 (en) | 2015-08-21 | 2017-08-29 | X Development Llc | Spatiotemporal robot reservation systems and method |
CN108290285B (zh) * | 2015-11-17 | 2021-08-06 | Abb瑞士股份有限公司 | 用于在机器人系统中优化工作周期的方法 |
JP6654926B2 (ja) * | 2016-02-24 | 2020-02-26 | 本田技研工業株式会社 | 処理時間の予測方法 |
CN109153134B (zh) * | 2016-05-26 | 2021-08-13 | 三菱电机株式会社 | 机器人控制装置 |
DE102017005604A1 (de) | 2017-06-12 | 2018-12-13 | Kuka Deutschland Gmbh | Überwachung eines Roboters |
EP3427904B1 (de) | 2017-07-13 | 2020-06-10 | Siemens Aktiengesellschaft | Anordnung mit einem manipulator und einer begrenzungseinrichtung zur begrenzung des arbeitsbereichs |
JP6521021B2 (ja) * | 2017-10-18 | 2019-05-29 | セイコーエプソン株式会社 | ロボット、ロボット制御装置およびロボットの制御方法 |
CN109093622B (zh) * | 2018-08-20 | 2021-10-01 | 珠海格力智能装备有限公司 | 机械手的监控方法和装置 |
CN109159118B (zh) * | 2018-08-29 | 2020-10-27 | 苏州精濑光电有限公司 | 干涉机构交叉作业防撞方法及装置 |
JP7143776B2 (ja) * | 2019-01-31 | 2022-09-29 | オムロン株式会社 | 制御システム、及び、制御システムの制御方法 |
DE102019115571B4 (de) * | 2019-06-07 | 2021-11-11 | Bystronic Laser Ag | Schnelles Abtransportieren von geschnittenen Teilen aus einer Verarbeitungsanlage |
RU2755994C1 (ru) * | 2021-02-17 | 2021-09-24 | Общество С Ограниченной Ответственностью "Дс-Роботикс" | Автономная сборочная модульная ячейка |
TW202406697A (zh) * | 2022-04-06 | 2024-02-16 | 美商即時機器人股份有限公司 | 採用前瞻規劃之共享工作空間中機器人的運動規劃和控制 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59205601A (ja) * | 1983-05-06 | 1984-11-21 | Hitachi Ltd | 協調動作をする産業用ロボットの安全運転制御方式 |
JPH0419084A (ja) * | 1990-05-15 | 1992-01-23 | Matsushita Electric Ind Co Ltd | ロボット |
US5561742A (en) * | 1992-01-28 | 1996-10-01 | Fanuc Ltd. | Multiple-robot control and interference prevention method |
US5798627A (en) * | 1995-01-04 | 1998-08-25 | Gilliland; Malcolm T. | Method for simultaneous operation of robot welders |
US20070118250A1 (en) * | 2005-11-24 | 2007-05-24 | Denso Wave Incorporated | Robot and multi-robot interference avoidance method |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6151204A (ja) * | 1984-08-20 | 1986-03-13 | Kobe Steel Ltd | ロボツトの動作空間識別システム |
JPH07299793A (ja) * | 1994-05-11 | 1995-11-14 | Toyota Autom Loom Works Ltd | ロボットの干渉防止制御装置 |
JPH0836410A (ja) * | 1994-07-21 | 1996-02-06 | Nissan Motor Co Ltd | ロボットの干渉防止方法およびその装置 |
JP3203305B2 (ja) * | 1996-05-28 | 2001-08-27 | 宇部興産株式会社 | 金型スプレイロボットの簡易干渉チェック方法 |
JPH103308A (ja) * | 1996-06-18 | 1998-01-06 | Fanuc Ltd | 産業用ロボットの干渉回避方法 |
JPH10264058A (ja) * | 1997-03-21 | 1998-10-06 | Nissan Motor Co Ltd | ロボット干渉域設定プログラム作成方法 |
JPH11134017A (ja) * | 1997-10-27 | 1999-05-21 | Honda Motor Co Ltd | オフラインティーチング方法 |
JP3937080B2 (ja) * | 2002-06-19 | 2007-06-27 | 株式会社安川電機 | ロボットの干渉判断方法および制御装置 |
FR2861857B1 (fr) * | 2003-10-29 | 2006-01-20 | Snecma Moteurs | Deplacement d'un objet articule virtuel dans un environnement virtuel en evitant les collisions internes entre les elements articules de l'objet articule |
DE102004027944B4 (de) * | 2004-06-08 | 2012-02-16 | Kuka Laboratories Gmbh | Verfahren zum Schützen eines Roboters gegen Kollisionen |
JP3907649B2 (ja) * | 2004-09-02 | 2007-04-18 | ファナック株式会社 | ロボット間の干渉防止制御装置 |
ATE395167T1 (de) * | 2005-04-19 | 2008-05-15 | Comau Spa | Verfahren zur steuerung von industriellen robotern und entsprechend gesteuerte roboter, robotersysteme und computerprogramme |
JP2007144524A (ja) * | 2005-11-24 | 2007-06-14 | Denso Wave Inc | ロボットの干渉回避方法およびロボット |
JP4159577B2 (ja) * | 2005-12-13 | 2008-10-01 | ファナック株式会社 | 複数のロボット間のインターロック自動設定装置及び自動設定方法 |
EP1815949A1 (en) * | 2006-02-03 | 2007-08-08 | The European Atomic Energy Community (EURATOM), represented by the European Commission | Medical robotic system with manipulator arm of the cylindrical coordinate type |
ATE459030T1 (de) * | 2006-09-14 | 2010-03-15 | Abb Research Ltd | Verfahren und vorrichtung zur vermeidung von kollisionen zwischen einem industrieroboter und einem objekt |
JP4951783B2 (ja) * | 2008-02-01 | 2012-06-13 | 株式会社デンソーウェーブ | ロボット制御装置及びロボット制御方法 |
US9144904B2 (en) * | 2008-05-21 | 2015-09-29 | Fanuc Robotics America Corporation | Method and system for automatically preventing deadlock in multi-robot systems |
-
2011
- 2011-10-31 IT IT000994A patent/ITTO20110994A1/it unknown
-
2012
- 2012-03-19 EP EP12160063.9A patent/EP2586574B1/en active Active
- 2012-03-30 KR KR1020120033099A patent/KR101867626B1/ko active IP Right Grant
- 2012-04-30 BR BR102012010254A patent/BR102012010254B8/pt not_active IP Right Cessation
- 2012-05-16 US US13/473,124 patent/US8818558B2/en active Active
- 2012-05-30 RU RU2012122451/02A patent/RU2593816C2/ru active
- 2012-05-30 JP JP2012122936A patent/JP6118509B2/ja active Active
- 2012-05-31 CN CN2012101877990A patent/CN103085057A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59205601A (ja) * | 1983-05-06 | 1984-11-21 | Hitachi Ltd | 協調動作をする産業用ロボットの安全運転制御方式 |
JPH0419084A (ja) * | 1990-05-15 | 1992-01-23 | Matsushita Electric Ind Co Ltd | ロボット |
US5561742A (en) * | 1992-01-28 | 1996-10-01 | Fanuc Ltd. | Multiple-robot control and interference prevention method |
US5798627A (en) * | 1995-01-04 | 1998-08-25 | Gilliland; Malcolm T. | Method for simultaneous operation of robot welders |
US20070118250A1 (en) * | 2005-11-24 | 2007-05-24 | Denso Wave Incorporated | Robot and multi-robot interference avoidance method |
Also Published As
Publication number | Publication date |
---|---|
US8818558B2 (en) | 2014-08-26 |
KR20130047544A (ko) | 2013-05-08 |
KR101867626B1 (ko) | 2018-06-15 |
BR102012010254A2 (pt) | 2014-04-01 |
JP6118509B2 (ja) | 2017-04-19 |
RU2593816C2 (ru) | 2016-08-10 |
JP2013094956A (ja) | 2013-05-20 |
BR102012010254B1 (pt) | 2021-04-20 |
US20130110288A1 (en) | 2013-05-02 |
CN103085057A (zh) | 2013-05-08 |
RU2012122451A (ru) | 2013-12-10 |
BR102012010254B8 (pt) | 2021-08-03 |
EP2586574A1 (en) | 2013-05-01 |
EP2586574B1 (en) | 2014-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
ITTO20110994A1 (it) | Metodo per il controllo di almeno due robot aventi rispettivi spazi di lavoro includenti almeno una regione in comune | |
KR101885415B1 (ko) | 로봇들을 위한 작업 공간의 유연하면서도 클럭 사이클 최적화된 공유 | |
US10220862B2 (en) | Method for operating a transport assembly in the form of a linear stator linear motor | |
US11440188B2 (en) | Robot system | |
JP5768828B2 (ja) | ロボットシステム、及び、ロボットシステムの制御方法 | |
KR102081494B1 (ko) | 복수의 통로 및 복수의 카를 갖는 엘리베이터 시스템의 작동 방법 | |
US9144904B2 (en) | Method and system for automatically preventing deadlock in multi-robot systems | |
JP7025896B2 (ja) | クレーンシステム、および、クレーンの制御方法 | |
KR102053557B1 (ko) | 가동장치의 동작 제어 장치, 동작 제어 시스템 및 가동장치의 동작 제어 방법 | |
US11795036B2 (en) | Method for generating a trajectory for a hoisting appliance | |
CN109502484B (zh) | 一种起重机运行区域的控制方法及系统 | |
JP7081704B1 (ja) | 自律移動体の管理装置 | |
JP2007210697A (ja) | エレベータ制御装置 | |
JP2012180185A (ja) | エレベータ群管理制御装置 | |
JP5833158B2 (ja) | エレベータ群管理装置およびエレベータ群管理方法 | |
JP6243820B2 (ja) | 自動保守運転装置及び自動保守運転方法 | |
WO2022244393A1 (ja) | 人機械協調制御システム並びに人機械協調制御方法 | |
KR102515061B1 (ko) | 무인운반차 시스템의 무인운반차 충돌 방지방법 | |
CN110604897B (zh) | 一种基于化成分容柜的联动消防控制方法及其装置 | |
US20230273622A1 (en) | Method, system, and non-transitory computer-readable recording medium for controlling plurality of automated guided vehicles | |
JP2006182467A (ja) | コンテナクレーン及びコンテナターミナル |