Fanuc Corporation

Yuuki Makihata

Masayuki Hamura

Mitsuhiro Okuda

Yoshitaka Ikeda

Fumikazu Terawaki

Control method for a robot with sensor

A method of controlling a robot attached to a tool. The position of the robot is corrected in real time by detecting a target position on a workpiece by a laser sensor. A laser light emitted from a laser light source of the laser sensor scans a surface of the workpiece toward a direction across an operating line. An initial scanning forms a locus of laser irradiation points and crossing points which intersect the locus with the operating line on the workpiece. Angle .alpha. is defined to be an angle formed between an axis of the tool and the locus on the surface of the workpiece. Angle .beta. is defined to be an angle formed between the operating line (point series line connecting the crossing points obtained by a current and past scanning) and the center axis of the tool. Further, angle .gamma. is defined to be a rotation angle around an axis of the tool on the basis of the operating line. An attitude of the robot is determined by the angles .alpha., .beta. and .gamma.. The attitude of the robot is controlled by equalizing the angles .alpha., .beta. and .gamma. to set values .alpha..sub.set, .beta..sub.set and .gamma..sub.set, respectively, at instruction positions.

Growing community of inventors

Minamitsuru-gun, Japan

Yuuki Makihata