CN102218735B - Sensing motion generating method of working manipulator and sensing motion generating device - Google Patents
Sensing motion generating method of working manipulator and sensing motion generating device Download PDFInfo
- Publication number
- CN102218735B CN102218735B CN 201110094297 CN201110094297A CN102218735B CN 102218735 B CN102218735 B CN 102218735B CN 201110094297 CN201110094297 CN 201110094297 CN 201110094297 A CN201110094297 A CN 201110094297A CN 102218735 B CN102218735 B CN 102218735B
- Authority
- CN
- China
- Prior art keywords
- sensing
- manipulator
- model
- action
- part model
- 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.)
- Active
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
The invention provides a sensing motion generating method of a working manipulator and a sensing motion generating device. The sensing motion generating method of a working manipulator (2) in the invention is suitable for generating sensing motion data applied during a sensing motion process. The working manipulator (2) comprises a contact type sensor (3) contacting a working workpiece (W) havingan arc part (C). The sensing motion generating method is characterized in that a real workpiece model (RM) performing interpolation among discrete points (D) is estimated based on a discrete workpiece model (DM) with a discrete point (D) similar to an arc part (C) of the working piece; and sensing motion data of the working manipulator (2) are generated based on the estimated real workpiece model(RM). In this way, proper sensing motion data can be generated even on working workpieces having arc parts. Therefore, loads of sensing motion data correction and working resetting can be alleviated.
Description
Technical field
The present invention relates to a kind of method and device thereof that under the off line environment, automatically generates the suitable sensing action data of manipulator.
Background technology
At present, usually before manipulator carries out operation to the operation workpiece, carry out following sensing operation, namely, by the touch sensor that arranges on hand at Work machine is contacted with the operation workpiece, thereby the operation workpiece on the checking computer and the position relationship of manipulator are based on the training data of this result correction manipulator.
For example, even want based on the training data on the computer, with manipulator in position, posture carries out weld job, because exist the shape of actual operation workpiece or alignment error, because of the bending of the initial position of manipulator itself, joint portion that gravity causes or backlash etc., so between the operation workpiece information of reality and training data, produce error, if actually want to carry out weld job, then deviation is understood in the welding position sometimes, and the operation workpiece is run at the position beyond the welding rod of manipulator.
Therefore, before the operations such as manipulator welds, need to carry out a kind of sensing operation, contact with the operation workpiece to be used for the actual welding rod that makes, revise the error between the training data of actual operation workpiece information and the operation workpiece on the computer.
When carrying out described sensing operation, need to be with respect to the sensing action data of manipulator, generate this sensing action data method, be that the sensing action generation method of manipulator often is that the operator manually carries out, but also develop the technology of several automatic generation sensings actions.Technology is as follows disclosed in patent documentation 1, by with respect to the operation workpiece with circular shape with any 3 contacts on the circular arc, carry out the sensing of the present position of this operation workpiece, calculate actual operation workpiece and the deviation of the center of arc on the operation workpiece on the computer, be used for the operation action of actual weld job etc.
The technology of patent documentation 1 be a kind of with on the circular arc portion of operation workpiece arbitrarily 3 as the position of the present position of operation workpiece being carried out sensing, the direction that is created on the center by circular arc at this each sensing location is carried out the production line control method for correcting of industrial robot of the training data of contact action.
In detail, in patent documentation 1, in the situation of the circular-arc production line (sealing wire) between cylinder part and the flat board member being carried out the sensing action, based on the positional information on the computer, make first sensing location on the actual outer peripheral face that is contacted with cylinder part of manipulator (robot).
Be stored in predetermined memory at the operation workpiece of the reality that this sensing location of first obtains and the error (correction value) of the operation workpiece on the computer, the sensing location of the second point on robot and the cylinder part is contacted.
When the contact of the sensing location of this second point, utilize the correction value that obtains at first sensing location, positional information on computers adds correction, makes robot be contacted with the sensing location of second point.In addition, when making robot be contacted with thirdly sensing location, utilize the compensating value that obtains at and second point sensing location at first, revise the positional information on the computer.
Then, by making robot be contacted with cylinder part as sensing location at 3, thereby can detect the coordinate of the center of arc of actual operation workpiece, the difference of the coordinate of the center of arc of the operation workpiece on detected center of arc coordinate and the computer as circular arc sensing compensating value, is used in the 4th later sensing action or the actual weld job.
The prior art document
Patent documentation 1:JP speciallys permit communique No. 2985336
But, although the method with above-mentioned patent documentation 1 can generate the sensing action data, but in fact robot is not contacted with the operation workpiece and just can't detects the revisal amount, sensing action data that can't be after the position revisal of the center of arc that generates the operation workpiece under the off line environment.
But, be not limited in this patent documentation 1 disclosed method, in the generation of sensing action data, prior art has the problem that can't avoid.
Namely, the curved surface of the surrounding enviroment of the manipulator under the off line environment, for drawing or the high speed of the calculating of interference checking, the lightweight of cad data of manipulator and surrounding enviroment, mostly approximate with polygon performance work data (with reference to figure 2, Fig. 3) in the situation, the curved surface of the manipulator that in the off line environment, reproduces or the curved surface of surrounding enviroment and actual operation workpiece in the position, vpg connection is different, therefore sometimes can't make sensing location at the face of the operation workpiece of reality.
For example shown in Fig. 3 (a), even set sensing location being approximately polygonal operation workpiece, shown in Fig. 3 (b), sometimes sensing location departs from respect to the operation workpiece of reality, and the touch sensor (welding rod etc.) that can produce the manipulator that will contact reaches the sensing training data of operation workpiece.In addition, though not shown, generate in addition the touch sensor of manipulator and the situation of the sensing training data that the operation workpiece is interfered.
Even this sensing training data is used for the robot real machine, neither obtain wanting the detection position of the center of the circular arc of calculating, so results operation person need to use the manual correction sensing locations such as teaching suspension apparatus (pendant).
Therefore, when the operator revises, exist the burden of teaching operation to want the problem of the part of this correction operation of corresponding increase.
Summary of the invention
In view of the above problems, the object of the present invention is to provide a kind of sensing action generation method and sensing action generating apparatus of manipulator, it is in having the operation workpiece of circular arc portion, can be under the off line environment, generation comprises the sensing action data of the detection position that can obtain wanting the center of arc position of calculating, in other words, the sensing action data of sensing can be correctly carried out in generation to circular arc portion, thereby can alleviate the correction operation of the sensing action of manipulator, the load of teaching operation.
In order to reach above-mentioned purpose, the present invention adopts following technological means.
The sensing action generation method of manipulator of the present invention generates the sensing action data that uses when manipulator carries out the sensing action, and described manipulator possesses the touch sensor that can contact with the operation workpiece with circular arc portion,
It is characterized in that,
Based on the discrete workpieces model of the circular arc portion that has been similar to described operation workpiece with discrete point, infer carrying out the true part model of interpolation between described discrete point,
Based on described true part model of inferring, generate the sensing action data of manipulator.
Thus, even have the operation workpiece of circular arc portion, by inferring the true part model than the operation workpiece of the more approaching reality of discrete workpieces model, can reduce actual operation workpiece and the error of the operation workpiece on the computer, can be under the off line environment automatically generation can make manipulator and the suitable sensing action data that contacts of actual operation workpiece, alleviate the burden of correction operation of the sensing action data of manipulator, therefore, the rise time of sensing action data can be shortened, the operating efficiency that training data generates can be improved.In addition, true part model be roughly faithful reappearance the part model of circular arc portion of operation workpiece, be the model of setting on computers.Can set again the sensing action data based on this true part model.
Preferably, when inferring described true part model, according to circular shape to carrying out interpolation between described discrete point.
In addition, preferably, when inferring described true part model, extract the contact-making surface that touch sensor contacts with described discrete workpieces model at described discrete workpieces model, the contact-making surface that extracts and the intersection that erects the datum level that this contact-making surface is set are extracted, and then the circular arc with the end points by the intersection that extracts extracts as described true part model.
Thus, according to circular shape to carrying out interpolation between discrete point, perhaps infer job model with a circle, therefore can infer the true part model that more approaches actual operation workpiece, even sensing location is set in job model on computers and the actual more different place (for example between discrete point) of job model, there is not the situation that does not reach actual operation workpiece or interfere with the operation workpiece yet, contact position can be set in and correctly calculates on the position of center of arc.
Preferably, described discrete workpieces model is made of the polygon take described discrete point as the summit.
In addition also can be when generating described sensing action data, obtain the sensing location that touch sensor contacts with described discrete workpieces model on described discrete workpieces model, on true part model, the sensing location of obtaining is set again, generated the sensing action data in the mode that comprises the described sensing location of setting again.
Especially, can also be when generating described sensing action data, be set as follows again the crossing point of such straight line and described true part model as sensing location, the sensing location of described straight-line pass before setting again, and from according to the center of arc radius vector outer direction extension of circular shape to the true part model that carried out interpolation between described discrete point.
In addition, can also be when generating described sensing action data, be set as follows the crossing point of such straight line and described true part model as sensing location, front sensing location is set in described straight-line pass again, and overlaps with the moving direction of described touch sensor again.
Thus, except the sensing location before setting again, the moving direction of the touch sensor the when center of arc of the true part model of inferring by utilization or sensing action, can be set in again reliably sensing location on the circular arc of true part model, can further reduce the error of sensing location of the operation workpiece of the sensing location of actual operation workpiece and computer, can be fully under the off line environment, automatically generate the high sensing action data of precision, can realize the alleviating of burden of sensing action data correction, the shortening of time that the sensing action data generates.
And then, judge preferably also whether the sensing location of touch sensor contact on described discrete workpieces model is consistent with discrete point, be judged as in the inconsistent situation of described sensing location and discrete point, infer described true part model.
The sensing action generating apparatus of manipulator of the present invention, it generates the sensing action data that uses when manipulator carries out the sensing action, and described manipulator possesses the touch sensor that can contact with the operation workpiece with circular arc portion,
It is characterized in that,
Described sensing action generating apparatus has:
The model estimating mechanism, it is inferred carrying out the true part model of interpolation between described discrete point based on the discrete workpieces model of the circular arc portion that has been similar to described operation workpiece with discrete point; And
Data generate mechanism, and it generates the sensing action data of manipulator based on described true part model of inferring.
Preferred described model estimating mechanism constitutes according to circular shape carrying out interpolation between described discrete point.
In addition, preferred described model estimating mechanism constitutes and extracts the contact-making surface that touch sensor contacts with described discrete workpieces model, the contact-making surface that extracts and the intersection that erects the datum level that this contact-making surface is set are extracted, and then the circular arc with the end points by the intersection that extracts extracts as described true part model.
Preferred described discrete workpieces model is made of the polygon take described discrete point as the summit.
Also can be that described data generate mechanism and constitute and obtain the sensing location that touch sensor contacts with described discrete workpieces model in addition, on true part model, the sensing location of obtaining is set again, generated the sensing action data in the mode that comprises the described sensing location of setting again.
Especially can be that described data generate mechanism and constitute and be set as follows the crossing point of such straight line and described true part model as sensing location again, the sensing location of described straight-line pass before setting again, and from according to the center of arc radius vector outer direction extension of circular shape to the true part model that carried out interpolation between described discrete point.
Can be that described data generate mechanism and constitute and be set as follows the crossing point of such straight line and described true part model as sensing location again in addition, front sensing location is set in described straight-line pass again, and overlaps with the moving direction of described touch sensor.
And then preferred described sensing action generating apparatus has the sensing location discrete point decision mechanism consistent with discrete point whether of judging touch sensor contact on described discrete workpieces model, described model estimating mechanism constitutes at described discrete point decision mechanism and is judged as in sensing location and the inconsistent situation of discrete point, infers described true part model.
The invention effect
According to the present invention, even the circular arc portion of the part model on the computer is made of discrete data, also can automatically generate comprise can make manipulator suitably contact actual operation workpiece sensing location at interior sensing action data, can alleviate the correction of sensing action and the homework burden of teaching.
Description of drawings
Fig. 1 is the pie graph of the sensing action generating apparatus of manipulator of the present invention;
Fig. 2 is the actual operation workpiece of expression and to the figure of its approximate discrete workpieces model, and Fig. 2 (a) is stereogram, and Fig. 2 (b) is top view;
Fig. 3 (a) is the setting of the sensing location of the operation workpiece of expression on the computer, and Fig. 3 (b) is be illustrated in that sensing location departs from the actual operation workpiece figure of (reach or interfere);
Fig. 4 (a), Fig. 4 (b) are top view, the stereograms at the edge of the face of the touch sensor contact on the expression discrete workpieces model and datum level; Fig. 4 (c), Fig. 4 (d) are that expression is from stereogram, the top view of the circle of the end points extraction at edge;
Fig. 5 (a) is the top view of the circle of the initial sensing location of expression and extraction, Fig. 5 (b) is the top view that expression utilizes the sensing location that initial sensing location and center of arc set again, and Fig. 5 (c) is the top view that expression utilizes the sensing location that the moving direction of initial sensing location and touch sensor sets again;
Fig. 6 is the flow chart of the sensing action generation method of expression manipulator.
Fig. 7 is the pie graph of the sensing action generating apparatus of manipulator;
Among the figure:
1-sensing action generating apparatus
The 2-manipulator
3-touch sensor (welding rod)
The 4-computer
W-operation workpiece
The circular arc portion of C-operation workpiece
The D-discrete point
DM-discrete workpieces model
The true part model of RM-
The T-contact-making surface
The K-datum level
The intersection of E-contact-making surface and datum level (edge)
The end points at EP-edge
RC-is by the circular arc of the end points at edge
The P-sensing location
O-center of arc
Sensing location before P1-sets again
Sensing location after P2-sets again
M1-sensing action set mechanism (data generate mechanism)
M2-discrete point decision mechanism
M3-model estimating mechanism
M4-is set mechanism again
The specific embodiment
Below based on Fig. 1～Fig. 7 embodiments of the present invention are described.
In addition, following embodiment is the example that the present invention is specialized, and does not limit technical scope of the present invention.
[formation of manipulator]
Fig. 1 represents the sensing action generating apparatus 1 of manipulator 2 of the present invention (operation robot).
This sensing action generating apparatus 1 has manipulator 2, makes the control panel 11 of these manipulator 2 actions and the teaching suspension apparatus 12 that can input training data according to built-in training data.And then control panel 11 is connected in the computer 4 that the off line teaching is used.
[about the sensing action]
The computer 4 of present embodiment by making the welding rod 3 (touch sensor) that arranges at manipulator 2 be contacted with operation workpiece W, generates the sensing posture of the manipulator 2 when comprising sensing location P, sensing in the training data (sensing action data) of interior sensing action under the off line environment.
In addition, the operation workpiece W position of the position of the operation workpiece W in the training data of computer 4 on off line and the reality that obtained by welding rod 3 detections is not simultaneously, utilize the difference with the position of surveying, can revise one by one the action of the later manipulator 2 in the position of carrying out sensing action, carry out simultaneously the sensing operation.
In addition, the operator is with the input of computer 4 or teaching suspension apparatus 12, according in advance teaching the program (tutorial program) of action, control manipulator 2 perhaps also can manually generate the sensing action data.
Welding rod 3 is the bar members with specific length, when the sensing operation, can also play the effect of surveying with the touch sensor that contacts of operation workpiece W.For example, can make hand front end 2a near operation workpiece W at the electrode flow electric current of the hand front end 2a of manipulator 2, observe the short-circuit condition when contacting with welding rod 3, judge whether to contact.
But, above-mentioned what is called " sensing action " refers to operation as follows: even manipulator 2 is with suitable position, posture is carried out weld job, sometimes also between the operation workpiece W information of reality and training data, produce error, therefore, make welding rod 3 be contacted with operation workpiece W actual before carrying out weld job, to being relevant to manipulator 2 on the computer 4 or shape or the configuration of the operation workpiece W on the computer 4 (being part model M), and then revise and even set again for the sensing location P on the part model M (position that the welding rod 3 of manipulator 2 contacts with part model M under the off line environment).
[problem points when generating the sensing action data]
The sensing action data that is used for making manipulator 2 carry out this sensing action is based on that the model (part model M) of the operation workpiece W on the computer 4 makes.
As shown in Figure 1, 2, the workpiece W of present embodiment erects the workpiece that cylinder-like part is set from the flat-sheet material (its upper surface is equivalent to datum level K described later) as benchmark, at this moment, the inner peripheral surface of cylinder-like part and outer peripheral face are the circular arc portion C of operation workpiece W.
Especially as shown in Figure 2, the part model M of operation workpiece W has the operation workpiece W of the reality of curved surface with polyhedron approximation, especially overlooks the middle approximate circular arc portion C of polygon (with reference to figure 2 (b)) that uses.This is for the high speed of the calculating of the lightweight that realizes the cad data on the computer 4 by simplifying part model M, interference checking etc.
In addition, shown in the right figure of Fig. 2 (b), part model M links between the point (discrete point D) that the upper devices spaced apart of actual operation workpiece W exists with straight line, is the circular arc portion C that the polygon on summit represents operation workpiece W in order to discrete point D.
(that is, being similar to take discrete point D) part model M that the upper discrete point D that exists of the operation workpiece W of so, utilization reality is similar to is as " discrete workpieces model DM ".In addition, even discrete workpieces model DM links discrete point D without straight line, also can link discrete point D with SPL etc.
Consider to utilize this discrete workpieces model DM, under the off line environment, generation makes touch sensor 3 be contacted with the situation of the training data of operation workpiece W.
Shown in Fig. 3 (a), on computer 4, set sensing location P at described discrete workpieces model DM.
At this, so-called sensing location P specifically welding rod 3 is contacted with the position of operation workpiece W (being discrete workpieces model DM at this moment), the vector (sensing vector SV) of the direction that welding rod 3 moves when also comprising simultaneously this contact action of expression, the pose information of the manipulator 2 of this moment.
At circular arc portion C (namely, between discrete point D) when setting this sensing location P, the inboard configuration sensing location P that leaves at the inner peripheral surface from the operation workpiece W of the reality that represents with imaginary line, or in the outside of the inner peripheral surface of the operation workpiece W of reality, i.e. the internal configurations sensing location P of the operation workpiece W of reality.
At this moment, if use discrete workpieces model DM, be created on the sensing action data of the position configuration sensing location P that departs from from the operation workpiece W of reality, mobile operation machine hand 2 real machines, when making welding rod 3 be contacted with actual operation workpiece W, shown in Fig. 3 (b), welding rod 3 does not arrive the inwall of operation workpiece W, perhaps, the part of touch sensor 3 or manipulator 2 and operation workpiece W interfere (operation workpiece W also is absorbed in from inwall).
Therefore, when the situation of this interference etc. occurs, need to revise again the sensing location P in the training data with the margin of error of the operation workpiece W information of reality and training data and set.
[the generation method of the sensing action data among the present invention: truly part model infers]
Consider this situation, utilize Fig. 6, Fig. 7, the sensing action generation method of manipulator 2 of the present invention is described.The processing that this sensing action generates is to be undertaken by the computer 4 that the off line teaching that is connected with control panel 11 is used.
In addition, sensing action generating apparatus 1 has be used to the computer program (sensing action generator) of carrying out sensing action generation method of the present invention.
Shown in the flow chart of Fig. 6, sensing action generator is in order to make computer 4 generate the processing of sensing action data, and the data of the form that can read as computer 4 are recorded in the recording medium (diagram is omitted).
In step S1 (data generation step), as shown in Figure 6, the sensing location P for welding rod 3 contacts with operation workpiece W at first specifies 3 points at discrete workpieces model DM.
In step S2, three sensing location P that judge all appointments whether with the discrete point D on the discrete workpieces model DM consistent (discrete point determining step).
Be judged as in all sensing location P and the inconsistent situation of discrete point D, processing entering step S3.In addition, if in consistent situation, end process.
In step S3 (model is inferred step), extract contact-making surface T that welding rod 3 contact with discrete workpieces model DM and the intersection (edge E) of datum level K (upper surface of flat-sheet material), the circular arc R C conduct of extracting all (six) the end points EP by this edge E is part model RM truly.
So-called this true part model RM is the part model M that the circular arc portion C of operation workpiece W is roughly enriched reproduction, is the model of setting at computer 4.The again setting that can carry out the sensing action data etc. is as the criterion with this true part model RM.
Then, in step S4 (setting again step), on the true part model RM that extracts, set again in advance sensing location P, again generate the sensing action data in the mode that comprises this sensing location P that sets again.
Below, describe step S1～step S4 in detail.
In step S1, at first, from manipulator 2 and the geometry shape of operation workpiece W and the geometry data of configuration, generate discrete workpieces model DM at computer 4.
Then, by sensing action Notified body M1 (data generate mechanism), specify the sensing location P of three welding rods 3 at the discrete workpieces model DM that generates.
These sensing locations P is by by the gainer on mouse or the keyboard designated computer 4, perhaps generates the sensing action data by searching database etc. based on the data of storage and appointed.
At this, there is the error (with reference to figure 2) of shape, position and the posture of training data and actual operation workpiece W, as mentioned above, need to making before welding rod 3 is contacted with actual operation workpiece W, the sensing action data be revised.
So in step S2, under the off line environment, judged by discrete point decision mechanism M2 whether three sensing location P of appointment are consistent with the discrete point D on the discrete workpieces model DM.
Be judged as in three sensing location P and the inconsistent situation of discrete point D at discrete point decision mechanism M2, process entering next step S3.
In addition, in three sensing location P situation consistent with discrete point D, namely, be contacted with in the situation that is positioned at the discrete point D on the actual operation workpiece W at welding rod 3, as long as calculate the circle by initial three sensing location P that set, then do not produce the error between training data and the actual operation workpiece W, even do not carry out inferring or the again setting of sensing location P of true part model RM shown below, owing to can not produce above-mentioned interference etc., so can generate suitable sensing action data yet.
In step S3, infer means M3 by model and extract the round RC of the end points EP on the edge E that passes through contact-making surface T and datum level K as true part model RM.
Shown in Fig. 4 (a), (b), by set three sensing location P (the initial sensing location P1 that sets) at discrete workpieces model DM, on computer 4, determine respectively the contact-making surface T that the welding rod corresponding with each sensing location P 3 contact (can with respect to the unique extraction of each sensing location P).And also can extract respectively these contact-making surfaces T and the intersection (edge E) that erects the datum level K (upper surface of flat-sheet material) that these contact-making surfaces T is set.
Below, shown in Fig. 4 (c), (d), the round RC of all (six) the end points EP by the edge E that extracts is extracted as true part model RM.
[the generation method of sensing action data of the present invention: based on the again setting of the sensing action data of true part model]
In step 4, on true part model RM, setting again sensing location P by set mechanism M4 again, generate the sensing action data that comprises the sensing location P2 after setting again.
Utilize the initial sensing location P1 that sets to carry out to the again setting of this sensing location P2.
For example shown in Fig. 5 (a), (b), set by initial sensing location P1, and from as the O of center of arc of the circle of the true part model RM straight line L along the outer direction extension in the footpath of circle.The point that the circle of this straight line L and true part model RM is crossing is set as new sensing location P2 again.
Initial sensing location P1 is owing to be provided with three at discrete workpieces model DM, thus the sensing location P2 that sets again also truer part model RM be provided with three.
At this, true part model RM with along the mode of the shape of the operation workpiece W of reality to carrying out interpolation between discrete point D, therefore the sensing location P2 on true part model RM is positioned on the actual operation workpiece W.
Therefore, even manipulator 2 real machines are not mobile, under the off line environment, also can set the sensing location P that welding rod 3 can be contacted with actual operation workpiece W, can automatically generate suitable sensing action data.
In addition, setting again of above-mentioned sensing location P2 also can be carried out according to order shown below.
Shown in Fig. 5 (a), (c), set by initial sensing location P1, and along moving direction (sensing vector SV) the straight line L ' that direction is extended outside the footpath of circle that sets again front welding rod 3.The point that this straight line L ' and true part model RM are intersected is as the sensing location P2 of setting again.
This moment, the sensing location P2 on the true part model RM was positioned on the actual operation workpiece W too.
Therefore, can under the off line environment, automatically generate suitable sensing action data.
As mentioned above, carry out step S1～step S4 by moving for sensing, can under the off line environment, generate the sensing action data of the suitable sensing location P of automatically indication, if this sensing action data is applicable to manipulator 2 real machines, then do not need operator's correction, set again, the compensating value of center that can reliably carry out the circular arc portion C of operation workpiece W detects, and also realizes alleviating of teaching homework burden simultaneously.
The present invention is not limited to aforesaid embodiment.Each structure of sensing action generating apparatus 1 grade or whole structure, shape, size etc. can suitably change in the scope that does not break away from purport of the present invention.
The sensing action generating apparatus 1 of manipulator 2 judges by discrete point decision mechanism M2 whether sensing location P is consistent with discrete point D, even if but do not have discrete point decision mechanism M2, namely no matter whether sensing location P is consistent with discrete point D, must carry out inferring of true part model RM.
Touch sensor 3 is not limited to the welding rod of the contact of the short-circuit condition when circulating current is observed contact in lead-in wire, also can be the loading detecting sensor that possesses load cell.
Sensing location P1 and the O of center of arc before set mechanism M4 will set again again link up, on true part model RM, set again sensing location P2, but also can be with the point on the true part model RM of the sensing location P1 before the most approaching again setting as the sensing location P2 that sets again.
Claims (16)
1. the sensing of manipulator action generation method generates the sensing action data that uses when manipulator carries out the sensing action, and described manipulator possesses the touch sensor that can contact with the operation workpiece with circular arc portion,
It is characterized in that,
Based on the discrete workpieces model of the circular arc portion that has been similar to described operation workpiece with discrete point, infer carrying out the true part model of interpolation between described discrete point,
Based on described true part model of inferring, generate the sensing action data of manipulator.
2. the sensing of manipulator as claimed in claim 1 action generation method is characterized in that,
When inferring described true part model, according to circular shape to carrying out interpolation between described discrete point.
3. the sensing of manipulator as claimed in claim 1 or 2 action generation method is characterized in that,
When inferring described true part model, extract the contact-making surface of touch sensor contact at described discrete workpieces model, the contact-making surface that extracts and the intersection that erects the datum level that this contact-making surface is set are extracted, and then the circular arc with the end points by the intersection that extracts extracts as described true part model.
4. the sensing of manipulator as claimed in claim 1 or 2 action generation method is characterized in that,
Described discrete workpieces model is made of the polygon take described discrete point as the summit.
5. the sensing of manipulator as claimed in claim 1 or 2 action generation method is characterized in that,
When generating described sensing action data, obtain the sensing location of touch sensor contact at described discrete workpieces model, on true part model, the sensing location of obtaining is set again, generated the sensing action data in the mode that comprises the described sensing location of setting again.
6. the sensing of manipulator as claimed in claim 5 action generation method is characterized in that,
When generating described sensing action data, be set as follows again the crossing point of such straight line and described true part model as sensing location, the sensing location of described straight-line pass before setting again, and from according to the center of arc radius vector outer direction extension of circular shape to the true part model that carried out interpolation between described discrete point.
7. the sensing of manipulator as claimed in claim 5 action generation method is characterized in that,
When generating described sensing action data, be set as follows again the crossing point of such straight line and described true part model as sensing location, front sensing location is set in described straight-line pass again, and overlaps with the moving direction of described touch sensor.
8. the sensing of manipulator as claimed in claim 1 or 2 action generation method is characterized in that,
Whether the sensing location of judgement touch sensor contact on described discrete workpieces model is consistent with discrete point,
Be judged as in the inconsistent situation of described sensing location and discrete point, inferring described true part model.
9. the sensing of manipulator action generating apparatus, it generates the sensing action data that uses when manipulator carries out the sensing action, and described manipulator possesses the touch sensor that can contact with the operation workpiece with circular arc portion,
It is characterized in that,
Described sensing action generating apparatus has:
The model estimating mechanism, it is inferred carrying out the true part model of interpolation between described discrete point based on the discrete workpieces model of the circular arc portion that has been similar to described operation workpiece with discrete point; And
Data generate mechanism, and it generates the sensing action data of manipulator based on described true part model of inferring.
10. the sensing of manipulator as claimed in claim 9 action generating apparatus is characterized in that,
Described model estimating mechanism constitutes according to circular shape carrying out interpolation between described discrete point.
11. the sensing action generating apparatus such as claim 9 or 10 described manipulators is characterized in that,
Described model estimating mechanism constitutes and extracts the contact-making surface that touch sensor contacts with described discrete workpieces model, the contact-making surface that extracts and the intersection that erects the datum level that this contact-making surface is set are extracted, and then the circular arc with the end points by the intersection that extracts extracts as described true part model.
12. the sensing action generating apparatus such as claim 9 or 10 described manipulators is characterized in that,
Described discrete workpieces model is made of the polygon take described discrete point as the summit.
13. the sensing action generating apparatus such as claim 9 or 10 described manipulators is characterized in that,
Described data generate mechanism and constitute and obtain the sensing location that touch sensor contacts with described discrete workpieces model, on true part model, the sensing location of obtaining is set again, generated the sensing action data in the mode that comprises the described sensing location of setting again.
14. the sensing of manipulator as claimed in claim 13 action generating apparatus is characterized in that,
Described data generate mechanism and constitute and be set as follows the crossing point of such straight line and described true part model as sensing location again, the sensing location of described straight-line pass before setting again, and from according to the center of arc radius vector outer direction extension of circular shape to the true part model that carried out interpolation between described discrete point.
15. the sensing of manipulator as claimed in claim 13 action generating apparatus is characterized in that,
Described data generate mechanism and constitute and be set as follows point that such straight line and described true part model intersect as sensing location again, and front sensing location is set in described straight-line pass again, and overlaps with the moving direction of described touch sensor.
16. the sensing action generating apparatus such as claim 9 or 10 described manipulators is characterized in that,
Described sensing action generating apparatus has the sensing location discrete point decision mechanism consistent with discrete point whether of judging touch sensor contact on described discrete workpieces model,
Described model estimating mechanism constitutes at described discrete point decision mechanism and is judged as in sensing location and the inconsistent situation of discrete point, infers described true part model.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2010-096066 | 2010-04-19 | ||
| JP2010096066A JP5495915B2 (en) | 2010-04-19 | 2010-04-19 | Sensing motion generation method and sensing motion generation device for work manipulator |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102218735A CN102218735A (en) | 2011-10-19 |
| CN102218735B true CN102218735B (en) | 2013-10-16 |
Family
ID=44775571
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN 201110094297 Active CN102218735B (en) | 2010-04-19 | 2011-04-12 | Sensing motion generating method of working manipulator and sensing motion generating device |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP5495915B2 (en) |
| CN (1) | CN102218735B (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104470687A (en) * | 2012-07-20 | 2015-03-25 | 株式会社安川电机 | Robot simulator, robot teaching device and robot teaching method |
| US10081109B2 (en) * | 2012-09-06 | 2018-09-25 | Fanuc America Corporation | Haptic teach pendant |
| CN103085072B (en) * | 2013-03-11 | 2014-10-29 | 南京埃斯顿机器人工程有限公司 | Method for achieving industrial robot off-line programming based on three-dimensional modeling software |
| CN108890666B (en) * | 2018-09-25 | 2021-02-19 | 刘悦吟 | Robot welding seam tracking method and system |
| CN109243284A (en) * | 2018-10-31 | 2019-01-18 | 西安长峰机电研究所 | A kind of aluminium alloy sheet welding weld seam teaching type autotracker |
| CN112149198B (en) | 2020-09-14 | 2022-05-17 | 贵州翰凯斯智能技术有限公司 | Arc fuse additive manufacturing path generation method |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4495588A (en) * | 1981-03-26 | 1985-01-22 | Kabushiki Kaisha Yaskawa Denki Seisakusho | Robot locus control system |
| JP2985336B2 (en) * | 1991-03-29 | 1999-11-29 | 株式会社 神戸製鋼所 | Work line correction control method for industrial robots |
| CN101282823A (en) * | 2005-10-06 | 2008-10-08 | 库卡罗伯特有限公司 | Method for determining a virtual tool center point |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS60132749A (en) * | 1983-12-21 | 1985-07-15 | 木村 吉宏 | Structure, surface thereof is processed |
| JPH0671691B2 (en) * | 1984-06-29 | 1994-09-14 | 日立精機株式会社 | Machining position coordinate system correction device |
| JP2913661B2 (en) * | 1989-04-12 | 1999-06-28 | 株式会社安川電機 | Robot control method |
| JPH083415B2 (en) * | 1989-06-09 | 1996-01-17 | 日産自動車株式会社 | Teaching method of shape measurement procedure |
| JP2539041B2 (en) * | 1989-06-09 | 1996-10-02 | 日産自動車株式会社 | Teaching method of shape measurement procedure |
| JP2802117B2 (en) * | 1989-09-28 | 1998-09-24 | 豊田工機株式会社 | Processing machine with teaching function |
| JP2000190168A (en) * | 1998-12-25 | 2000-07-11 | Toshiba Corp | Nc machining method and its device |
-
2010
- 2010-04-19 JP JP2010096066A patent/JP5495915B2/en active Active
-
2011
- 2011-04-12 CN CN 201110094297 patent/CN102218735B/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4495588A (en) * | 1981-03-26 | 1985-01-22 | Kabushiki Kaisha Yaskawa Denki Seisakusho | Robot locus control system |
| JP2985336B2 (en) * | 1991-03-29 | 1999-11-29 | 株式会社 神戸製鋼所 | Work line correction control method for industrial robots |
| CN101282823A (en) * | 2005-10-06 | 2008-10-08 | 库卡罗伯特有限公司 | Method for determining a virtual tool center point |
Non-Patent Citations (3)
| Title |
|---|
| JP平2-271405A 1990.11.06 |
| JP特公平6-71691B2 1994.09.14 |
| JP特开2000-190168A 2000.07.11 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2011224710A (en) | 2011-11-10 |
| CN102218735A (en) | 2011-10-19 |
| JP5495915B2 (en) | 2014-05-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102218735B (en) | Sensing motion generating method of working manipulator and sensing motion generating device | |
| JP7096288B2 (en) | How to control a robot | |
| CN103085067B (en) | Mechanical hand-knitted range device | |
| CN108235696B (en) | Robot control method and apparatus | |
| JP5939202B2 (en) | Robot teaching auxiliary device, robot system, and robot teaching method | |
| CN108687767B (en) | Offline programming device and offline programming method | |
| JP2001105359A (en) | Graphic display device for robot system | |
| JP2010142910A (en) | Robot system | |
| CN102161126B (en) | Sensing motion generating method, sensing motion generating device for operation manipulator | |
| CN104842347A (en) | Robot system for preventing accidental dropping of conveyed objects | |
| CN106493711A (en) | Control device, robot and robot system | |
| CN111515928B (en) | Mechanical arm motion control system | |
| CN109278063A (en) | Robot device, control method, assemble method and recording medium | |
| CN113634871A (en) | Robot friction stir welding track planning method based on offline programming | |
| JP4574580B2 (en) | Offline teaching device for work robots | |
| JP2023069253A (en) | Robot teaching system | |
| JP2009119589A (en) | Robot simulator | |
| JP5474739B2 (en) | Interference detection method and interference detection apparatus | |
| JP2017039184A (en) | robot | |
| CN116867618A (en) | Program evaluation device and teaching device | |
| JP4794937B2 (en) | Programming device for arc welding | |
| JP3937080B2 (en) | Robot interference determination method and control apparatus | |
| US20220355478A1 (en) | Robot slider position setting device, robot slider position setting method, and robot slider position setting program | |
| US20230398688A1 (en) | Motion trajectory generation method for robot, motion trajectory generation apparatus for robot, robot system, and program | |
| WO2021177313A1 (en) | Robot programming device and robot programming method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |