DE112019003470T5 - Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern - Google Patents

Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern Download PDF

Info

Publication number
DE112019003470T5
DE112019003470T5 DE112019003470.7T DE112019003470T DE112019003470T5 DE 112019003470 T5 DE112019003470 T5 DE 112019003470T5 DE 112019003470 T DE112019003470 T DE 112019003470T DE 112019003470 T5 DE112019003470 T5 DE 112019003470T5
Authority
DE
Germany
Prior art keywords
target object
track
steering gear
robots
squares
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
DE112019003470.7T
Other languages
English (en)
Inventor
Tianlei Wang
Zhu Wang
Tianqing Wang
Xin Zhang
Bing Luo
Ye Li
Yuqing Wang
Jingling Zhang
Xiaoxi HAO
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuyi University
Original Assignee
Wuyi University
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 Wuyi University filed Critical Wuyi University
Publication of DE112019003470T5 publication Critical patent/DE112019003470T5/de
Ceased legal-status Critical Current

Links

Images

Classifications

    • 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/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G05B19/425Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1646Programme controls characterised by the control loop variable structure system, sliding mode control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0028Gripping heads and other end effectors with movable, e.g. pivoting gripping jaw surfaces
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697Vision controlled systems
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T1/00General purpose image data processing
    • G06T1/0014Image feed-back for automatic industrial control, e.g. robot with camera
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/246Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/20Special algorithmic details
    • G06T2207/20081Training; Learning
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/20Special algorithmic details
    • G06T2207/20084Artificial neural networks [ANN]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

Die vorliegende Erfindung offenbart ein auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern, umfassend: Sammeln eines Zielobjektbildes und Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild; Einstellen eines Aufnahmeabstandes und Auswählen der mehreren ersten Abtastpunkte und zweiten Abtastpunkte in Übereinstimmung mit dem Positionsziel; durch das Schwenklenkgetriebes durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß einer ersten Spur und einer zweiten Spur; Lesen des Tastverhältnisses S des PWM-Signals in dem Schwenklenkgetriebe; Berechnen des Werts Di=S/P; Durchführen einer Anpassung von xi basierend auf der Methode der kleinsten Quadrate, um eine Anpassungsgleichung zu erhalten; Einstellen des Aufnahmeabstandes, Einstellen des Tastverhältnisses des PWM-Signals in dem Schwenklenkgetriebe in Übereinstimmung mit den Anpassungsdaten und Ansteuern der Klaue zur Bewegung nacheinander gemäß der ersten Spur und der zweiten Spur; Ansteuern der Klaue zum Schließen, um ein Greifen, ein Abheben und eine Aufwärtsbewegung des Zielobjekts zu vervollständigen. Die vorliegende Erfindung verwendet eine Anpassung der Methode der kleinsten Quadrate, wodurch die Kalibrierungsschritte der Implementierungsspur erheblich vereinfacht werden, was förderlich für Verbessern der Aufnahmeeffizienz des Roboterarms und Erleichtern des experimentellen Lehrens von Robotern ist.

Description

  • TECHNISCHES GEBIET
  • Die vorliegende Erfindung betrifft einen Roboterarm des Roboters, insbesondere ein auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern.
  • STAND DER TECHNIK
  • Gegenwärtig erfolgt die Bilderkennung und -positionierung von Robotern im Allgemeinen wie folgt: der Abstand zwischen dem Ziel und dem Roboter wird berechnet und dann an das Roboterarmsteuersystem übertragen, und der Roboterarm wird durch das Lenkgetriebe angesteuert, um ein Nehmen und Ablegen des Ziels zu realisieren, während der allgemeine Roboterarm einen Zwei-Verbindungsstangen-Mechanismus verwendet, wobei jede Verbindungsstange durch ein separates Lenkgetriebe angetrieben wird. Während des Bewegungsvorgangs ist es erwünscht, sich entlang einer vertikalen Abwärtsspur zu bewegen, da die Klaue vertikal von einer bestimmten Höhe zu einer vorbestimmten Zielposition abgesenkt werden soll, aber der durch das Lenkgetriebe angetriebene Zwei-Verbindungsstangen-Mechanismus kann es tatsächlich schwierig genaue implementieren;
    insbesondere umfasst der Zwei-Verbindungsstangen-Mechanismus des Roboterarms üblicherweise einen großen Arm, einen kleinen Arm und eine Klaue, unter der Annahme, dass die Positionskoordinate für die Aufnahme der Klaue P(y, z) ist, kann die folgende Beziehungsformel erhalten werden: { y p = l 1 cos θ 1 + l 2 cos ( θ 1 + θ 2 ) z p = l 1 sin θ 1 + l 2 sin ( θ 1 + θ 2 )
    Figure DE112019003470T5_0001
    dabei steht 01 für einen durch den großen Arm und die horizontalebene eingeschlossenen Winkel nach Ansteuern des großen Arms zur Drehung durch das Lenkgetriebe und θ2 für einen durch die Verlängerungslinien des kleinen Arms und des großen Arms eingeschlossenen Winkel, wobei 11 und 12 beides Konstanten sind, Ermitteln der Umkehrfunktion für die obige Beziehungsformel: { θ 1 = arccos [ y p 2 + z p 2 + l 1 2 l 2 2 2 l 1 x p cos θ p ] + arctg z p y p θ 2 = arccos [ y p 2 + z p 2 + l 2 2 l 1 2 2 l 2 x p cos θ p ] + arctg z p y p θ 1
    Figure DE112019003470T5_0002
    , von der obigen Formel kann es herausgefunden werden,
    dass im Implementierungsprozess die Bestimmung der Werte von 01 und θ2 relativ komplex ist, 01 und θ2 einen größeren Einfluss auf das Greifen haben und eine nichtlineare Kopplungsbeziehung miteinander bilden, was die Kalibrierung der Spur insbesondere der sich zur Zielposition bewegenden Spur, um einen gewissen Grad schwieriger macht.
  • INHALT DER VORLIEGENDEN ERFINDUNG
  • Hinsichtlich der oben geschilderten Probleme stellt die vorliegende Erfindung ein auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern zur Verfügung, mit dem die Kalibrierungsschritte vereinfacht werden können, die Aufnahmeeffizienz des Roboterarms verbessert und die Verwendung des Roboters für experimentelles Lehren erleichtert werden kann.
  • Um die Mängel aus dem Stand der Technik zu überwinden, verwendet die vorliegende Erfindung die folgende technische Lösung:
    • Ein auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern, umfassend die folgenden Schritte:
      • Sammeln eines Zielobjektbildes und Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild;
      • Einstellen eines Aufnahmeabstandes, nämlich eines Abstandes xides Umdrehmittelpunkts des Roboterarms zu der Klaue, Auswählen mehrerer erster Abtastpunkte und zweiter Abtastpunkte und durch das Schwenklenkgetriebes durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß einer ersten Spur und einer zweiten Spur; wobei die mehreren ersten Abtastpunkte/die zweiten Abtastpunkte mit einem gleichen Niveau angeordnet sind, und wobei jeder zweite Abtastpunkt sich jeweils genau unterhalb des entsprechenden ersten Abtastpunkts befindet; und wobei die Bewegungsspur von der Ausgangsposition zu jedem ersten Abtastpunkt die erste Spur ist, während die Bewegungsspur von jedem ersten Abtastpunkt zum entsprechenden zweiten Abtastpunkt die zweite Spur ist;
      • Lesen des Tastverhältnisses S des PWM-Signals in dem Schwenklenkgetriebe während der beiden Bewegungsspuren,
      • Berechnen des Werts Di=S/P; wobei Di die Anpassungsdaten und P die Auflösung des Schwenklenkgetriebes darstellt;
      • Durchführen einer Anpassung von xi basierend auf der Methode der kleinsten Quadrate, um eine Anpassungsgleichung zu erhalten: D i ( x i ) = c 0 + c 1 x i + c 2 x i 2
        Figure DE112019003470T5_0003
        wobei C0, C1 und C2 alle Gleichungsparameter sind;
      • Einstellen des Aufnahmeabstandes, Erhalten der Anpassungsdaten gemäß der Anpassungsgleichung, entsprechendes Einstellen des Tastverhältnisses des PWM-Signals in dem Schwenklenkgetriebe, durch das Schwenklenkgetriebe durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß der ersten Spur und der zweiten Spur, wodurch die Klaue die Position des Zielobjekts erreicht;
      • Ansteuern der Klaue zum Schließen, um ein Greifen, ein Abheben und eine Aufwärtsbewegung des Zielobjekts zu vervollständigen.
  • Bevorzugt wird ein Zielobjektbild durch eine Kamera oder eine Hochgeschwindigkeitskamera erfasst.
  • Bevorzugt umfasst das Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild die folgenden Schritte:
    • Übertragen des Zielobjektbilds an einen Computer über drahtloses Routing;
    • Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers.
    • Bevorzugt umfassen das Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers die folgenden Schritte:
      • aufeinanderfolgendes Durchführen einer Gaußschen Filterung, einer binären Teilung der Kanaldifferenz und einer morphologischen Verarbeitung für das Zielobjektbild, um ein transformiertes Bild zu erhalten;
      • Identifizieren der Eigenschaften des transformierten Bildes unter Verwendung des BP-Neuronalnetz-Algorithmus, um die Positionskoordinaten des Zielobjekts zu erhalten.
  • Bevorzugt beträgt die Anzahl der ausgewählten ersten Abtastpunkte und zweiten Abtastpunkte jeweils 10.
  • Bevorzugt umfasst das Auswählen der mehreren ersten Abtastpunkte und zweiten Abtastpunkte in Übereinstimmung mit dem Positionsziel die folgenden Schritte:
    • Berechnen des horizontalen Greifbereichs des Zielobjekts in Übereinstimmung mit dem Positionsziel;
    • Auswählen von mehreren horizontal eingereihten ersten Abtastpunkten an einer Höhe oberhalb des horizontalen Greifbereichs;
    • Nehmen der entsprechenden zweiten Abtastpunkte genau unterhalb jedes ersten Abtastpunkts und innerhalb des horizontalen Greifbereichs.
  • Bevorzugt wird der Roboterarm mittels des Drehlenkgetriebes zur Drehung zur Front des Zielobjekts angesteuert, um den Aufnahmeabstand einzustellen.
  • Die vorliegende Erfindung hat den folgenden Vorteil: durch Erfassen und Verarbeiten der Bilder werden die Positionskoordinaten eines Zielobjekts erhalten, und entsprechende Abtastpunkte werden ausgewählt, um einen Spurtest durchzuführen, nämlich wird bezüglich der Beziehung zwischen dem Tastverhältnis und dem Aufnahmeabstand eine Kurvenanpassung der Methode der kleinsten Quadrate durchgeführt, durch den Prozess wird schließlich eine Anpassungsgleichung der einzelnen Variable erhalten, deshalb können die Anpassungsdaten durch ein Feststellen eines neuen Aufnahmeabstandes festgestellt werden, wodurch das Tastverhältnis festgestellt wird, danach kann die Klaue durch ein Einstellen gemäß dem Tastverhältnis zu der Position des Zielobjekts gefördert werden, um eine Aufnahme zu realisieren; im Vergleich zum Stand der Technik besteht keine Notwendigkeit, die geometrischen Parameter zwischen zwei Verbindungsstangen zu berücksichtigen, insbesondere die durch die tatsächliche Position bewirkte Variierung des Winkels zwischen den beiden Stangen, wodurch die Kalibrierung einfacher und leichter wird. Aufgrund dessen verwendet die vorliegende Erfindung eine Anpassung der Methode der kleinsten Quadrate, wodurch die Kalibrierungsschritte der Implementierungsspur erheblich vereinfacht werden, was förderlich für Verbessern der Aufnahmeeffizienz des Roboterarms und Erleichtern des experimentellen Lehrens von Robotern ist.
  • Figurenliste
  • Im Zusammenhang mit Figuren werden bevorzugte Ausführungsbeispiele der vorliegenden Erfindung im Folgenden dargestellt, um die Ausführungsform der vorliegenden Erfindung näher zu erläutern.
    • 1 zeigt ein Ablaufdiagramm der Schritte der vorliegenden Erfindung.
    • 2 zeigt ein schematisches Effektdiagramm der vorliegenden Erfindung.
  • AUSFÜHRLICHE BESCHREIBUNG
  • Siehe 1 und 2, ein auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern, umfassend die folgenden Schritte:
    • Sammeln eines Zielobjektbildes und Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild;
    • Einstellen eines Aufnahmeabstandes, nämlich eines Abstandes xides Umdrehmittelpunkts des Roboterarms zu der Klaue, Auswählen mehrerer erster Abtastpunkte 3 und zweiter Abtastpunkte 4 und durch das Schwenklenkgetriebes durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß einer ersten Spur 1 und einer zweiten Spur 2; wobei die mehreren ersten Abtastpunkte 3/die zweiten Abtastpunkte 4 mit einem gleichen Niveau angeordnet sind, und wobei jeder zweite Abtastpunkt 4 sich jeweils genau unterhalb des entsprechenden ersten Abtastpunkts 3 befindet; und wobei die Bewegungsspur von der Ausgangsposition zu jedem ersten Abtastpunkt die erste Spur 1 ist, während die Bewegungsspur von jedem ersten Abtastpunkt zum entsprechenden zweiten Abtastpunkt 4 die zweite Spur 2 ist;
    • Lesen des Tastverhältnisses S des PWM-Signals in dem Schwenklenkgetriebe während der beiden Bewegungsspuren, Berechnen des Werts Di; wobei Di die Anpassungsdaten und P die Auflösung des Schwenklenkgetriebes darstellt;
    • Durchführen einer Anpassung von xi basierend auf der Methode der kleinsten Quadrate, um eine Anpassungsgleichung zu erhalten: D i ( x i ) = c 0 + c 1 x i + c 2 x i 2
      Figure DE112019003470T5_0004
      ; wobei C0, C1 und C2 alle Gleichungsparameter sind;
    • Einstellen des Aufnahmeabstandes, Erhalten der Anpassungsdaten gemäß der Anpassungsgleichung, entsprechendes Einstellen des Tastverhältnisses des PWM-Signals in dem Schwenklenkgetriebe, durch das Schwenklenkgetriebe durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß der ersten Spur 1 und der zweiten Spur 2, wodurch die Klaue die Position des Zielobjekts erreicht;
    • Ansteuern der Klaue zum Schließen, um ein Greifen, ein Abheben und eine Aufwärtsbewegung des Zielobjekts zu vervollständigen.
  • Durch Erfassen und Verarbeiten der Bilder werden insbesondere die Positionskoordinaten eines Zielobjekts erhalten, und entsprechende Abtastpunkte werden ausgewählt, um einen Spurtest durchzuführen, nämlich wird bezüglich der Beziehung zwischen dem Tastverhältnis und dem Aufnahmeabstand eine Kurvenanpassung der Methode der kleinsten Quadrate durchgeführt, durch den Prozess wird schließlich eine Anpassungsgleichung der einzelnen Variable erhalten, deshalb können die Anpassungsdaten durch ein Feststellen eines neuen Aufnahmeabstandes festgestellt werden, wodurch das Tastverhältnis festgestellt wird, danach kann die Klaue durch ein Einstellen gemäß dem Tastverhältnis zu der Position des Zielobjekts gefördert werden, um eine Aufnahme zu realisieren; im Vergleich zum Stand der Technik besteht keine Notwendigkeit, die geometrischen Parameter zwischen zwei Verbindungsstangen zu berücksichtigen, insbesondere die durch die tatsächliche Position bewirkte Variierung des Winkels zwischen den beiden Stangen, wodurch die Kalibrierung einfacher und leichter wird.
  • Aufgrund dessen verwendet die vorliegende Erfindung eine Anpassung der Methode der kleinsten Quadrate, wodurch die Kalibrierungsschritte der Implementierungsspur erheblich vereinfacht werden, was förderlich für Verbessern der Aufnahmeeffizienz des Roboterarms und Erleichtern des experimentellen Lehrens von Robotern ist.
  • Bevorzugt wird ein Zielobjektbild durch eine Kamera oder eine Hochgeschwindigkeitskamera erfasst.
  • Bevorzugt umfasst das Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild die folgenden Schritte:
    • Übertragen des Zielobjektbilds an einen Computer über drahtloses Routing;
    • Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers.
  • Bevorzugt umfassen das Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers die folgenden Schritte:
    • aufeinanderfolgendes Durchführen einer Gaußschen Filterung, einer binären Teilung der Kanaldifferenz und einer morphologischen Verarbeitung für das Zielobjektbild, um ein transformiertes Bild zu erhalten;
    • Identifizieren der Eigenschaften des transformierten Bildes unter Verwendung des BP-Neuronalnetz-Algorithmus, um die Positionskoordinaten des Zielobjekts zu erhalten.
    • Insbesondere sind die Prinzipien der Gaußschen Filterung, der binären Teilung der Kanaldifferenz und der morphologischen Verarbeitung im Wesentlichen bekannt für die Fachleute auf diesem Gebiet, und der BP-Neuronalnetz-Algorithmus ist auch ein bestehendes Verfahren, aufgrund dessen wird der konkrete Prozess hier nicht näher erläutert.
  • Bevorzugt beträgt die Anzahl der ausgewählten ersten Abtastpunkte 3 und zweiten Abtastpunkte 4 jeweils 10.
  • Bevorzugt umfasst das Auswählen der mehreren ersten Abtastpunkte 3 und zweiten Abtastpunkte 4 in Übereinstimmung mit dem Positionsziel die folgenden Schritte:
    • Berechnen des horizontalen Greifbereichs des Zielobjekts in Übereinstimmung mit dem Positionsziel;
    • Auswählen von mehreren horizontal eingereihten ersten Abtastpunkten 3 an einer Höhe oberhalb des horizontalen Greifbereichs;
    • Nehmen der entsprechenden zweiten Abtastpunkte 4 genau unterhalb jedes ersten Abtastpunkts 3 und innerhalb des horizontalen Greifbereichs.
  • Obwohl das berechnete Positionsziel auf dem verarbeiteten Bild basierend erhalten wird, besteht insbesondere eine bestimmte Abweichung, deshalb wird die Aufnahmeposition zeitweilig nicht zu viel beschränkt, dazu wird ein horizontaler Greifbereich eingestellt, im Allgemeinen wird auf der linken Seite und rechten Seite auf demselben Niveau des Positionsziels jeweils ein Positionspunkt ausgewählt, dabei werden die beiden Positionspunkte als zwei Endpunkte des horizontalen Greifbereichs verwendet.
  • Bevorzugt wird der Roboterarm mittels des Drehlenkgetriebes zur Drehung zur Front des Zielobjekts angesteuert, um den Aufnahmeabstand einzustellen, bevorzugt wird der Roboterarm zur genauen Front des Zielobjekts gedreht, wodurch der Aufnahmeabstand leicht eingestellt werden kann, so dass der Bewegungspfad, der durch den Roboterarm zum Einstellen durchgeführt wird, einfacher wird.
  • Bevorzugt wird mittels des Greiflenkgetriebes die Klaue zum Schließen angesteuert, um ein Greifen, ein Abheben und eine Aufwärtsbewegung des Zielobjekts zu vervollständigen.
  • Insbesondere besteht in dem vorliegenden Ausführungsbeispiel keine Beschränkung für den Roboterarm, dabei kann ein allgemeiner Roboterarm zum Greifen verwendet werden; siehe 2, umfasst ein allgemeiner Roboterarm einen Sitz, einen Manipulator und ein entsprechendes Lenkgetriebe, wobei der Manipulator eine Klaue umfasst, und wobei das Lenkgetriebe ein Drehlenkgetriebe zum Ansteuern des Manipulators zur horizontalen Drehung auf dem Sitz, ein Greiflenkgetriebe zum Ansteuern der Klaue zum Öffnen und Schließen und ein Schwenklenkgetriebe zum Ansteuern des Manipulators zum Schwenken umfasst, und wobei dem Zwei-Verbindungsstangen-Mechanismus entsprechend der Manipulator weiterhin einen großen Arm 6 und einen kleinen Arm 5 umfasst, und wobei das Schwenklenkgetriebe ein Lenkgetriebe Nr. 2 zum Ansteuern des großen Arms 6 und ein Lenkgetriebe Nr. 3 zum Ansteuern des kleinen Arms 5 umfasst.
  • Aufgrund dessen ist eine Spur durch die Betätigungen des großen Arm 6 und des kleinen Arms 5 gemeinsam vervollständigt, beim Testen kann das Tastverhältnis des Lenkgetriebes Nr. 2 und des Lenkgetriebes Nr. 3 jeweils erhalten werden, dann wird in Übereinstimmung mit dem jeweiligen Tastverhältnis und dem Aufnahmeabstand eine segmentierte Kurvenanpassung mit der Methode der kleinsten Quadrate durchgeführt, um eine angepasste Steuerkurve zu erhalten, nämlich wird die Anpassungsgleichung erhalten; beim tatsächlichen Greifen wird das Tastverhältnis gemäß der entsprechenden Anpassungsgleichung berechnet, um eine Ansteuerung für den großen Arm 6 und den kleinen Arm 5 zu realisieren.
  • Es ist ersichtlich, dass das Prinzip gleich wie die Steuerung für ein einzelnes Schwenklenkgetriebe, davon kann es abgeleitet werden, dass unabhängig davon, wie viele Komponenten zu steuern sind, es durch eine Anpassung des entsprechenden Lenkgetriebes mittels des Verfahrens der vorliegenden Erfindung realisiert werden kann.
  • Bevorzugt werden in dem vorliegenden Ausführungsbeispiel das Schwenklenkgetriebe, das Drehlenkgetriebe und das Greiflenkgetriebe jeweils mittels des PCA9685-Moduls angetrieben, wobei die inhärente Auflösung 4069 beträgt, nämlich Di=S/4069.
  • Oben werden die bevorzugten Ausführungsbeispiele und die wesentlichen Prinzipien der vorliegenden Erfindung näher erläutert, darauf wird die vorliegende Erfindung nicht auf die obige Ausführungsform beschränkt, der Fachmann, der mit diesem Gebiet vertraut ist, kann ohne Abweichung von dem Gedanken der vorliegenden Erfindung äquivalente Varianten oder Ersetzungen durchführen, und diese äquivalenten Varianten oder Ersetzungen sollen als von dem durch die Ansprüche definierten Schutzumfang gedeckt angesehen werden.

Claims (7)

  1. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern, dadurch gekennzeichnet, dass es die folgenden Schritte umfasst: Sammeln eines Zielobjektbildes und Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild; Einstellen eines Aufnahmeabstandes, nämlich eines Abstandes xides Umdrehmittelpunkts des Roboterarms zu der Klaue, Auswählen mehrerer erster Abtastpunkte und zweiter Abtastpunkte und durch das Schwenklenkgetriebes durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß einer ersten Spur und einer zweiten Spur; wobei die mehreren ersten Abtastpunkte/die zweiten Abtastpunkte mit einem gleichen Niveau angeordnet sind, und wobei jeder zweite Abtastpunkt sich jeweils genau unterhalb des entsprechenden ersten Abtastpunkts befindet; und wobei die Bewegungsspur von der Ausgangsposition zu jedem ersten Abtastpunkt die erste Spur ist, während die Bewegungsspur von jedem ersten Abtastpunkt zum entsprechenden zweiten Abtastpunkt die zweite Spur ist; Lesen des Tastverhältnisses S des PWM-Signals in dem Schwenklenkgetriebe während der beiden Bewegungsspuren, Berechnen des Werts Di rechnen mit =S/P; wobei Di die Anpassungsdaten und P die Auflösung des Schwenklenkgetriebes darstellt; Durchführen einer Anpassung von xi basierend auf der Methode der kleinsten Quadrate, um eine Anpassungsgleichung zu erhalten: D i ( x i ) = c 0 + c 1 x i + c 2 x i 2
    Figure DE112019003470T5_0005
    ; wobei C0, C1 und C2 alle Gleichungsparameter sind; Einstellen des Aufnahmeabstandes, Erhalten der Anpassungsdaten gemäß der Anpassungsgleichung, entsprechendes Einstellen des Tastverhältnisses des PWM-Signals in dem Schwenklenkgetriebe, durch das Schwenklenkgetriebe durchgeführtes Ansteuern der Klaue zur Bewegung nacheinander gemäß der ersten Spur und der zweiten Spur, wodurch die Klaue die Position des Zielobjekts erreicht; Ansteuern der Klaue zum Schließen, um ein Greifen, ein Abheben und eine Aufwärtsbewegung des Zielobjekts zu vervollständigen.
  2. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach Anspruch 1, dadurch gekennzeichnet, dass ein Zielobjektbild durch eine Kamera oder eine Hochgeschwindigkeitskamera erfasst wird.
  3. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach Anspruch 1, dadurch gekennzeichnet, dass das Berechnen der Positionskoordinaten des Zielobjekts in Übereinstimmung mit dem Zielobjektbild die folgenden Schritte umfasst: Übertragen des Zielobjektbilds an einen Computer über drahtloses Routing; Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers.
  4. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach Anspruch 3, dadurch gekennzeichnet, dass das Analysieren und Berechnen der Positionskoordinaten des Zielobjekts mittels des Computers die folgenden Schritte umfassen: aufeinanderfolgendes Durchführen einer Gaußschen Filterung, einer binären Teilung der Kanaldifferenz und einer morphologischen Verarbeitung für das Zielobjektbild, um ein transformiertes Bild zu erhalten; Identifizieren der Eigenschaften des transformierten Bildes unter Verwendung des BP-Neuronalnetz-Algorithmus, um die Positionskoordinaten des Zielobjekts zu erhalten.
  5. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach Anspruch 1, dadurch gekennzeichnet, dass die Anzahl der ausgewählten ersten Abtastpunkte und zweiten Abtastpunkte jeweils 10 bevorzugt.
  6. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach Anspruch 1, wobei das Auswählen der mehreren ersten Abtastpunkte und zweiten Abtastpunkte in Übereinstimmung mit dem Positionsziel die folgenden Schritte umfasst: Berechnen des horizontalen Greifbereichs des Zielobjekts in Übereinstimmung mit dem Positionsziel; Auswählen von mehreren horizontal eingereihten ersten Abtastpunkten an einer Höhe oberhalb des horizontalen Greifbereichs; Nehmen der entsprechenden zweiten Abtastpunkte genau unterhalb jedes ersten Abtastpunkts und innerhalb des horizontalen Greifbereichs.
  7. Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern nach einem der Ansprüche 1 bis 6, dadurch gekennzeichnet, dass der Roboterarm mittels des Drehlenkgetriebes zur Drehung zur Front des Zielobjekts angesteuert wird, um den Aufnahmeabstand einzustellen.
DE112019003470.7T 2018-07-09 2019-03-22 Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern Ceased DE112019003470T5 (de)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201810745022.9A CN108748162B (zh) 2018-07-09 2018-07-09 一种机器人实验教学用基于最小二乘法的机械臂控制方法
CN201810745022.9 2018-07-09
PCT/CN2019/079255 WO2020010876A1 (zh) 2018-07-09 2019-03-22 一种机器人实验教学用基于最小二乘法的机械臂控制方法

Publications (1)

Publication Number Publication Date
DE112019003470T5 true DE112019003470T5 (de) 2021-04-29

Family

ID=63972915

Family Applications (1)

Application Number Title Priority Date Filing Date
DE112019003470.7T Ceased DE112019003470T5 (de) 2018-07-09 2019-03-22 Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern

Country Status (4)

Country Link
US (1) US20200290201A1 (de)
CN (1) CN108748162B (de)
DE (1) DE112019003470T5 (de)
WO (1) WO2020010876A1 (de)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108748162B (zh) * 2018-07-09 2021-05-25 五邑大学 一种机器人实验教学用基于最小二乘法的机械臂控制方法
CN111208730B (zh) * 2020-01-08 2021-06-22 南昌大学 一种快速终端滑模阻抗控制算法
CN114770461B (zh) * 2022-04-14 2023-12-01 深圳技术大学 一种基于单目视觉的移动机器人及其自动抓取方法

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6278906B1 (en) * 1999-01-29 2001-08-21 Georgia Tech Research Corporation Uncalibrated dynamic mechanical system controller
US20010056313A1 (en) * 2000-05-08 2001-12-27 Osborne William Joseph Object locating and retrieving system utilizing labels
JP4298757B2 (ja) * 2007-02-05 2009-07-22 ファナック株式会社 ロボット機構のキャリブレーション装置及び方法
CN101396830A (zh) * 2007-09-29 2009-04-01 株式会社Ihi 机器人装置的控制方法以及机器人装置
TWI446305B (zh) * 2012-07-11 2014-07-21 Univ Nat Taipei Technology 機械手臂的教導裝置及其教導方法
CN103955207B (zh) * 2014-04-24 2016-06-22 哈尔滨工业大学 一种三爪式空间末端执行器在微重力环境下的捕获容差能力测试系统及方法
CN105654474A (zh) * 2015-12-28 2016-06-08 深圳先进技术研究院 基于视觉引导的机械臂定位方法及装置
CN106217374B (zh) * 2016-08-11 2019-01-11 广州成潮智能科技有限公司 一种智能机械臂的控制方法、装置及系统
CN106737855B (zh) * 2016-08-22 2019-07-02 南京理工大学 一种综合位姿误差模型与刚度补偿的机器人精度补偿方法
CN106651949B (zh) * 2016-10-17 2020-05-15 中国人民解放军63920部队 一种基于仿真的空间机械臂抓捕目标遥操作方法及系统
CN107160389B (zh) * 2017-05-09 2019-07-30 浙江工业大学 一种工业机器人的力矩控制方法
CN107450885B (zh) * 2017-07-21 2020-09-08 上海交通大学 一种工业机器人与三维传感器的坐标变换求解方法
CN107186701B (zh) * 2017-07-24 2023-07-14 佛山科学技术学院 一种三自由度并联机构的示教机械臂参数标定装置及方法
CN108177145A (zh) * 2017-12-28 2018-06-19 北京航空航天大学 一种无偏最优的工业机械臂绝对定位精度标定方法
CN108748162B (zh) * 2018-07-09 2021-05-25 五邑大学 一种机器人实验教学用基于最小二乘法的机械臂控制方法

Also Published As

Publication number Publication date
WO2020010876A1 (zh) 2020-01-16
CN108748162B (zh) 2021-05-25
CN108748162A (zh) 2018-11-06
US20200290201A1 (en) 2020-09-17

Similar Documents

Publication Publication Date Title
DE102009034529B4 (de) Automatisches Führungs- und Erkennungssystem sowie Verfahren für dieses
DE112019003470T5 (de) Auf der Methode der kleinsten Quadrate basiertes Roboterarmsteuerverfahren für experimentelles Lehren von Robotern
DE112011103794B4 (de) Aufnehmervorrichtung für Werkstücke
DE102015001527B4 (de) Robotersystem, das visuelle Rückmeldung verwendet
DE102017128543B4 (de) Störbereich-einstellvorrichtung für einen mobilen roboter
DE102015101710B4 (de) Verfahren zum Kalibrieren eines beweglichen Greiforgans unter Verwendung einer entfernten Digitalkamera
DE102016122678B4 (de) Werkstückpositions-/-Stellungsberechnungssystem und Handhabungssystem
DE102018132213A1 (de) Artikelübertragungsvorrichtung, Robotersystem und Artikelübertragungsverfahren
EP2834789B1 (de) Verfahren und vorrichtung zur optischen bestimmung einer position und/oder orientierung eines objekts im raum
DE102016001174B4 (de) Robotersystem zum Entnehmen von Werkstücken mit Umrechenfunktion von Position und Orientierung und Verfahren zum Entnehmen von Werkstücken
DE102021107532A1 (de) System und Verfahren zum Anlernen eines Roboters mittels Demonstration durch einen Menschen
EP3587044B1 (de) Verfahren zum greifen von objekten in einem suchbereich und positioniersystem
EP1717573B1 (de) Verfahren zur automatischen Fehlererkennung in Prüfteilen mittels einer Röntgenprüfanlage
DE112019007852B4 (de) Informationsverarbeitungsvorrichtung, Werkstückerkennungsvorrichtung und Werkstückaufgreifvorrichtung
DE69105867T2 (de) Verfahren Türen an Fahrzeugkarosserien anzubringen und Ausrüstung zur Durchführung dieses Verfahrens.
DE102019125117B4 (de) Sichtgeführter Roboterarm und Verfahren zum Betreiben desselben
DE102018121481A1 (de) Entfernungsmesssystem und Entfernungsmessverfahren
DE102019118342A1 (de) Objektprüfvorrichtung, Objektprüfsystem, und Verfahren zum Einstellen der Prüfposition
DE102018007287B4 (de) Roboter-Controller zum Durchführen einer Kalibrierung, Messsystem und Kalibrierverfahren
DE102020204768A1 (de) Unbemanntes Transferrobotersystem
DE112019005484T5 (de) Automatische Kalibrierung für ein Kamera-Robotersystem mit Werkzeugoffsets
DE102022130652A1 (de) Anlernen eines roboters durch vorführen mit visualservoing
DE102017007737A1 (de) Verfahren und Vorrichtung zum Erfassen einer Abbildung einer Pflanze mit einer Sensoreinrichtung
DE102016120809B4 (de) Verfahren zum robotergestützten Einpassen eines männlichen Bauteils in ein weibliches Bauteil
DE112020006594B4 (de) Maschinenlernverfahren und Robotersystem

Legal Events

Date Code Title Description
R012 Request for examination validly filed
R002 Refusal decision in examination/registration proceedings
R003 Refusal decision now final