摘要 |
PROBLEM TO BE SOLVED: To provide a robot-laser sensor system provided with a function of automatically approaching a work starting location by searching a work line location. SOLUTION: A robot mounted with a laser sensor and a work tool at the finger part approaches a work starting location Q 1 by various kinds of serach operation route patterns (a) to (d). The pattern (a) is determined so as to evade an obstacle F and an obstacle shape part G. The locus can be fixed by designating the coordinate axis of a coordinateΣw, for instance. The patterns (b), (c) can be realized by performing a teaching of data for successively fixing the locus for a robot. As for the pattern (d), initial vector <V1>, a rotation angleθand a normed growth factorγare set by parameters, vector <Vi+1> is fixed from vector <Vi> which is calculated the previous time by an illustrated relation (rotation ofθand normedγtimes) at the time of the calculation of incremental moving amountΔof the (i+1)th (i=0, 1, 2) and <Vi+1>-<Vi> may be fixed as the (i+1)th incremental moving amountΔ.
|