Parabolic position and attitude interpolation for a robot hand

Claim 2

A control system for an industrial robot comprising a robot having a hand at an end of the robot; instruction means for providing a polygonal path defined by a plurality of straight lines which interconnect a plurality of point coordinates taught to said robot; arithmetical means for continuously interconnecting said straight lines by a parabola at predetermined locations in the vicinity of the centers of said straight lines, said parabola being generated by dividing a span between two predetermined positions through arithmetic linear interpolation technique in a manner in which points located between said predetermined positions are defined on a straight line interconnecting said two predetermined positions; and driving means for continuously moving said hand of the robot along said parabola generated by said arithemical means from a straight line to the next straight line.

Claim 3

A control system for an industrial robot comprising a robot having a hand at an end of the robot; instruction means for providing a path constituted by a plurality of first and second straight lines (AB, BC) which interconnect a plurality of point coordinates taught to the robot and providing a speed (v a ) on said first straight line (AB) and a second speed (v b ) on said second straight line (BC); arithmetical means for dividing said second straight line (BC) arithmetically in dependence on the second speed (v b ) corresponding to the speed at which said hand is moved along said second straight line, determining a starting coordinate point (D) by a parabolic interpolation in correspondence with the speed (v a ) on said first straight line (AB), and arithmetically dividing sequentially by a predetermined value the spans between said starting coordinate point (D) and coordinate points (E m ) determined by said first arithmetic division for determining parabolic interpolating points (p m ); and driving means for continuously moving said hand of the robot along the interpolating points (p m ) determined by said arithmetical means from said first to said second straight line.

Claim 4

A control system for an industrial robot comprising a robot having a hand at an end of the robot; instruction means for providing a path constituted by a plurality of first and second straight lines (AB, BC) which interconnect a plurality of point coordinates taught to the robot and providing a speed (v a ) on said first straight line (AB) and a second speed (v b ) on said second straight line (BC); arithmetical means for dividing said second straight line (BC) arithmetically in dependence on the second speed (v b ) corresponding to the speed at which said hand is moved along said second straight line, determining a starting coordinate point (D) by a parabolic interpolation in correspondence with the speed (v a ) on said first straight line (AB), and arithmetically dividing sequentially by a predetermined value the spans between said starting coordinate point (D) and coordinate points (E m ) determined by said first arithmetic division for determining parabolic interpolating points (p m ); and driving means for continuously moving said hand of the robot along the interpolating points (p m ) determined by said arithmetical means from said first to said second straight line.

Claim 5

A control system for an industrial robot according to claim 2, wherein said arithmetical means comprises setting means for setting the parabolic interpolation starting point (D) so that a span (DB) between said starting point and the intermediate nodal point (B) is equal to n/n a ·v a ·T, and a parabolic interpolation ending point (E) on the second straight line so that a span (BE) between said parabolic interpolation ending point (E) and said intermediate nodal point (B) is equal to n'/n b ·v b ·T where v a represents speed of the hand on said first straight line, v b represents speed of the hand on said second straight line, T represents a sampling time, n a represents a natural number selected such that AB/v a T≦n a <AB/v a T+1, n b represents a natural number selected such that BC/v b T ≦n b <BC/v b T+1, and n and n' represents predetermined natural numbers.

Claim 6

A control system for an industrial robot according to claim 3, wherein n is equal to n'.

Claim 7

A control system for an industrial robot according to claim 4, wherein coordinate points (E m ) on said second straight line determined through arithmetic division divide equally a line segment (BE) by 2n, and line segments among said coordinate points (E m ) are arithmetically divided by n+1-m/2 with said coordinate point (D) serving as the starting point for the parabolic interpolation, to thereby determine the parabolic interpolating points (p m ).

Claim 8

A control system for an industrial robot according to claim 4 or 5, wherein n is so selected that BE≦1/2BC, so that the parabolic interpolation can be effected successively.

Claim 9

A control system for an industrial robot comprising: a robot having a hand at an end of the robot; instruction means for providing two attitudes (f o , g o ; f n , g n ) of the hand taught to the robot in terms of two unit vectors (f, g); arithmetical means for interpolating the the rotation angle of said hand about an axis (f o -f n )×(g o -g n ) for rotating from the attitude (f o , g o ) to the attitude (f n , g n ); and driving means for driving said robot's hand to change the attitude thereof in accordance with the rotation angle interpolated by said arithemical means.

Claim 10

A control system for an industrial robot comprising: a robot having a hand at an end of the robot; instruction means for providing two attitudes (f o , g o ; f n , g n ) of the hand taught to the robot in terms of two unit vectors (f, g); arithmetical means for interpolating the the rotation angle of said hand about an axis (f o -f n )×(g o -g n ) for rotating from the attitude (f o , g o ) to the attitude (f n , g n ); and driving means for driving said robot's hand to change the attitude thereof in accordance with the rotation angle interpolated by said arithemical means.

Claim 11

A control system for an industrial robot according to claim 7, wherein said interpolation is a parabolic interpolation.

Claim 16

A method of controlling an industrial robot according to claim 10, wherein said parabolic interpolation starting point (d) on said first straight line is so set that a span (DB) between said starting point and the intermediate nodal point (B) is equal to n/n a ·v a ·T, while a parabolic interpolation ending point (E) is so set on the second straight line so that a span (BE) between said parabolic interpolation ending point (E) and said intermediate nodal point (B) is equal to n'/n b ·v b ·T where v a represents speed of the hand on said first straight line, v b represents speed of the hand on said second straight line, T represents a sampling time, n a represents a natural number selected such that AB/v a T<n a <AB/v a T+1, n b represents a natural number selected such that BC/v b T≦n b <BC/v b T+1, and n and n' represent predetermined natural numbers.

Claim 17

A method of controlling an industrial robot according to claim 11, wherein n is equal to n'.

Claim 18

A method of controlling an industrial robot according to claim 12, wherein coordinate points (E m ) on said second straight line determined through arithmetic division divide equally a line segment (BE) by 2n, and line segments among said coordinate points (E m ) are arithmetically divided by n+1-m/2 with said coordinate point (D) serving as the starting point for the parabolic interpolation, to thereby determine the parabolic interpolating points (p m ).

Claim 19

A method of controlling an industrial robot according to claim 12 or 13, wherein n is so selected that BE≦1/2BC, so that the parabolic interpolation can be effected successively.