WO2021033743A1 - シーリングロボット - Google Patents

シーリングロボット Download PDF

Info

Publication number
WO2021033743A1
WO2021033743A1 PCT/JP2020/031440 JP2020031440W WO2021033743A1 WO 2021033743 A1 WO2021033743 A1 WO 2021033743A1 JP 2020031440 W JP2020031440 W JP 2020031440W WO 2021033743 A1 WO2021033743 A1 WO 2021033743A1
Authority
WO
WIPO (PCT)
Prior art keywords
sealing
coating
gun
sealing gun
shape
Prior art date
Application number
PCT/JP2020/031440
Other languages
English (en)
French (fr)
Inventor
晃 庄司
圭 渡邉
匡志 庄司
大 福田
友明 諸正
Original Assignee
川崎重工業株式会社
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 川崎重工業株式会社 filed Critical 川崎重工業株式会社
Priority to CN202080043601.4A priority Critical patent/CN114007761B/zh
Priority to US17/637,075 priority patent/US20220288625A1/en
Priority to EP20855430.3A priority patent/EP4019150A4/en
Publication of WO2021033743A1 publication Critical patent/WO2021033743A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B05SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05CAPPARATUS FOR APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05C5/00Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work
    • B05C5/02Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B05SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05CAPPARATUS FOR APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05C5/00Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work
    • B05C5/02Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work
    • B05C5/0208Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work for applying liquid or other fluent material to separate articles
    • B05C5/0212Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work for applying liquid or other fluent material to separate articles only at particular parts of the articles
    • B05C5/0216Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work for applying liquid or other fluent material to separate articles only at particular parts of the articles by relative movement of article and outlet according to a predetermined path
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B05SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05CAPPARATUS FOR APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05C11/00Component parts, details or accessories not specifically provided for in groups B05C1/00 - B05C9/00
    • B05C11/10Storage, supply or control of liquid or other fluent material; Recovery of excess liquid or other fluent material
    • B05C11/1002Means for controlling supply, i.e. flow or pressure, of liquid or other fluent material to the applying apparatus, e.g. valves
    • B05C11/1015Means for controlling supply, i.e. flow or pressure, of liquid or other fluent material to the applying apparatus, e.g. valves responsive to a conditions of ambient medium or target, e.g. humidity, temperature ; responsive to position or movement of the coating head relative to the target
    • B05C11/1021Means for controlling supply, i.e. flow or pressure, of liquid or other fluent material to the applying apparatus, e.g. valves responsive to a conditions of ambient medium or target, e.g. humidity, temperature ; responsive to position or movement of the coating head relative to the target responsive to presence or shape of target
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B05SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05CAPPARATUS FOR APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
    • B05C5/00Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work
    • B05C5/02Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work
    • B05C5/0225Apparatus in which liquid or other fluent material is projected, poured or allowed to flow on to the surface of the work the liquid or other fluent material being discharged through an outlet orifice by pressure, e.g. from an outlet device in contact or almost in contact, with the work characterised by flow controlling means, e.g. valves, located proximate the outlet
    • 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
    • B25J11/00Manipulators not otherwise provided for
    • B25J11/0075Manipulators for painting or coating
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/021Optical sensing devices
    • B25J19/022Optical sensing devices using lasers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45065Sealing, painting robot

Definitions

  • the present invention relates to a sealing robot that applies a sealing material to a work application site.
  • Patent Document 1 discloses a viscous material coating device applied to an automobile manufacturing site.
  • the device comprises a mixing head attached to the robot hand.
  • the mixing head discharges the sealing material while moving along a predetermined trajectory, and applies the sealing material to the application site of the work.
  • the sealing material may come off from the coating site even if it is moved along a predetermined trajectory. Increasing the amount of the sealing material applied per unit length of the coated part so that the sealing material does not come off leads to an increase in the cost of the product.
  • an object of the present invention is to provide a sealing robot capable of applying a sealing material to an application site while saving an application amount.
  • the sealing robot according to the present invention is A sealing robot that applies a sealing material to the application site of a work that extends linearly.
  • Base and A robot arm connected to the base at its base and A sealing gun attached to the tip of the robot arm and discharging the sealing material,
  • a control device that controls the operation of the robot arm according to a predetermined motion plan that defines the path of the sealing gun, and moves the sealing gun in the extending direction of the coating portion while facing the coating portion.
  • the coating site is perpendicular to the moving direction with respect to the sealing gun at a position separated from the arbitrary position by a predetermined distance in the moving direction of the sealing.
  • the control device is configured to correct the path of the sealing gun from that defined in the motion plan based on the shape of the coating site measured at the measurement point at the first position. ..
  • the shape of the coating site is measured before the sealing gun, and the path of the sealing gun is corrected based on the measurement result. Even if the position of the work with respect to the robot is displaced, the sealing gun can maintain the state of facing the application site. The sealing material can be applied to the application site even if the application amount is saved.
  • the control device corrects the path based on the measurement result by the sensor when the sealing gun is in the "first position" on the path.
  • the "first position” is a position on the path that is separated from the sealing gun by a predetermined distance and the coating site is within the allowable dimension in the direction perpendicular to the moving direction with respect to the sealing gun. .. Examples of cases where the dimensions deviate from the permissible dimensions include cases where the sensor makes an erroneous measurement, or cases where the application site has a sharp curve, or is bent at a right angle or an acute angle. At the part where the coating part is bent, the coating part may not fit in the scanning range of the sensor and the measurement result may not be obtained.
  • the correction is performed when the size falls within the permissible dimension, it is possible to suppress the possibility that the sealing material will come off the coating site due to erroneous measurement, and it is possible to prevent the coating material from coming out of the scanning range of the sensor.
  • the calculation load for correction can be reduced, which contributes to the high-speed movement of the sealing gun.
  • the present invention it is possible to provide a sealing robot capable of applying a sealing material to a coating member even if the coating amount is saved.
  • FIG. 1 is a schematic view of the sealing robot 1 according to the first embodiment.
  • the sealing robot 1 applies the sealing material 90 to the application sites 93 of the works 91 and 92.
  • the sealing robot 1 includes a base 2, a robot arm 3, a sealing gun 4, and a sensor 5.
  • the base 2 is installed at the manufacturing site where the coating work is performed. It may be stationary on the floor, wall or ceiling, or it may be runnable and supported.
  • the base end portion of the robot arm 3 is connected to the base 2.
  • the sealing gun 4 is removably attached to the tip of the robot arm 3.
  • the robot arm 3 is configured by sequentially connecting a plurality of link members 11 to 16 from the base 2 via joints.
  • the sealing robot 1 is a 6-axis robot.
  • the robot arm 3 includes a swivel table 11, upper and lower arms 12, 13 and first to third wrist portions 14 to 16 as six link members.
  • the swivel table 11 forms the base end portion of the robot arm 3, and the tip end portion of the third wrist portion 16 forms the tip end portion of the robot arm 3.
  • the swivel 11 is rotatably connected to the base 2 around the first axis A1, the lower arm 12 is rotatably connected to the swivel 11 around the second axis A2, and the upper arm 13 is rotatably connected to the lower arm 12.
  • the first wrist portion 14 is rotatably connected to the upper arm 13 around the fourth axis A4, the second wrist portion 15 is rotatably connected to the first wrist portion 14 around the fifth axis A5, and the third wrist portion is connected.
  • 16 is rotatably connected to the second wrist portion 15 around the sixth axis A6.
  • the sealing robot 1 or the robot arm 3 is a vertical articulated type.
  • the first axis A1 is perpendicular to the support surface of the base 2
  • the second axis A2 is perpendicular to the first axis A1
  • the third axis A3 is parallel to the second axis A2.
  • the fourth axis A4 is perpendicular to the third axis A3, the fifth axis A5 is perpendicular to the fourth axis A4, and the sixth axis A6 is perpendicular to the fifth axis A5.
  • the number of link members is not limited to 6.
  • the robot arm 3 may be a horizontal articulated type.
  • the sealing gun 4 is directly or indirectly attached to the tip of the robot arm 3 so as to be removable.
  • the base end portion of the sealing gun 4 is fixed to the front surface of the flat plate-shaped holding member 6, and the back surface of the holding member 6 is attached to the tip end portion of the robot arm 3.
  • the sealing gun 4 is detachably attached to the robot arm 3 via the holding member 6.
  • the sealing gun 4 has a storage unit 21 and a nozzle 22.
  • the storage unit 21 is formed in a tubular shape and stores the sealing material 90.
  • the nozzle 22 has a thin tubular shape, communicates with the storage portion 21 at the base end portion, and is open to the outside at the tip end portion.
  • the storage unit 21 is connected to a supply source (not shown) in the manufacturing site via a hose 23.
  • the nozzle 22 discharges the sealing material 90 stored in the storage unit 21 to the outside. In parallel with the discharge of the sealing material 90, the sealing material 90 is supplied from the supply source to the storage unit 21.
  • the discharge actuator 49 see FIG.
  • discharges the sealing material 90 is particularly limited as long as it is configured so that the operating state (discharge) and the stopped state (non-discharge) can be switched by the control device 7 (see FIG. 3). Not done. It may be a pump provided in the supply source or a plunger provided in the storage unit 21.
  • the sealing material 90 discharged from the nozzle 22 is applied to the application site 93.
  • the coating portion 93 is a mating portion formed by superimposing two plate-shaped workpieces 91 and 92.
  • the nozzle 22 substantially faces the coating portion 93 in the plate thickness direction of the works 91 and 92, and the sealing material 90 is discharged in the facing direction.
  • the gap between the mating portions is sealed by the sealing material 90 applied to the coating portion 93.
  • the first work 91 is deeper than the second work 92 when viewed from the nozzle 22.
  • the coating portion 93 is composed of the surface of the first work 91, the side end surface of the second work 92, and the surface of the second work 92, and extends along the side end surface of the second work 92.
  • the coating portion 93 when viewed from the plate thickness direction of the workpieces 91 and 92, the coating portion 93 extends linearly. "Linear” includes straight lines, curves and continuations thereof.
  • the coating portion 93 includes a first straight line portion 93a, a bent line portion 93b, a sharp curved portion 93c, a second straight portion 93d, a bent portion 93e, an S-shaped portion 93f, and a third straight portion 93g. These portions 93a to 93g form a continuous line in this order.
  • the coating portion 93 may be formed in an endless shape.
  • reference numeral CB represents a base coordinate system in which the origin is set on the base 2.
  • the symbol CT represents a tool coordinate system in which the origin is set on the sealing gun 4.
  • FIG. 1 the case where the origin of the tool coordinate system CT is set to the tip of the nozzle 22 is illustrated, but it is arbitrary on the sealing gun 4 or a portion that does not displace relative to the sealing gun 4 (for example, the holding member 6 or the sensor 5). Can be set to position. The same applies to the origin of the base coordinate system CB.
  • the sealing gun 4 moves in the extending direction of the coating portion 93 with the sealing gun 4 facing the coating portion 93 by controlling the operation of the robot arm 3 by the control device 7 (see FIG. 3).
  • the path of the sealing gun 4 follows the shape (shape seen from the plate thickness direction) of the coating portion 93 as illustrated in FIG.
  • the sensor 5 measures the shape of the coating site 93 on the path of the sealing gun 4 before the sealing gun 4 while the sealing gun 4 is being moved along the path.
  • the sensor 5 is, for example, a laser sensor, which irradiates the workpieces 91 and 92 with linear inspection light L, and measures the shape of the coating portion 93 based on the reflected light.
  • the sensor 5 is held by the holding member 6 together with the sealing gun 4, and is not displaced relative to the sealing gun 4 regardless of the operation of the robot arm 3.
  • the inspection light L of the sensor 5 is located away from the sealing gun 4 in one direction (for example, the Y direction) of the three orthogonal axes forming the tool coordinate system CB, among the three orthogonal axes forming the tool coordinate system CB. Is irradiated so as to extend linearly in another direction (for example, the X direction). As a result, the inspection light L is irradiated so as to cross the coating portion 93 in the direction (for example, the X direction).
  • the coating portion 93 includes a polygonal line portion and an S-shaped portion.
  • each component of XYZ in the path of the sealing gun 4 differs depending on the location of the coating portion 93, but the tool coordinate system is controlled by controlling the movement of the robot arm 3 (for example, controlling the rotation angle of the third wrist portion 16).
  • CT the Y-axis continues to point in the direction of movement of the sealing gun 4.
  • the nozzle 22 of the sealing gun 4 extends in another direction (for example, the Z direction) of the three orthogonal axes forming the tool coordinate system CB, and the sealing material 90 is discharged in that direction.
  • the discharge direction of the sealing material 90, the facing direction between the sealing material 90 and the coating portion 93, and the plate thickness direction of the workpieces 90 and 91 are all directed to the relevant direction, and the tip of the nozzle 22 is the relevant direction from the coating portion 93. It is kept separated by a predetermined interval in the direction.
  • the sensor 5 can measure the cross-sectional shape of the coating portion 93 at the position where the inspection light L is irradiated, based on the reflected light of the inspection light L.
  • This cross section is a cross section perpendicular to the moving direction of the sealing gun 4. In this example, it is a ZX cross section of the tool coordinate system CT.
  • the shape measured by the sensor 5 is defined as the coordinate value of the tool coordinate system CT.
  • the sensor 5 measures the data indicating the position of the coating portion 93 in the tool coordinate system CT as the cross-sectional shape of the coating portion 93.
  • the sensor 5 has the coordinates of the coating portion 93 at the measurement position in the Z direction (corresponding to the nozzle extending direction, the nozzle facing direction, the sealing material discharging direction, or the work plate thickness direction) as the coordinate values of the tool coordinate system CT representing the cross-sectional shape.
  • the value zp and the coordinate value xp in the X direction of the coating portion 93 at the measurement position are measured.
  • the coordinate value xp in the X direction of the coating portion 93 is the step in the coating portion 93 or the position of the side end surface of the second work 92 on the front side when viewed from the nozzle 22 in the X direction.
  • the coordinate value zp in the Z direction of the coating portion 93 is shown as the z position on the surface of the first work 91 on the back side when viewed from the nozzle 22, but this is only an example.
  • the sensor 5 may measure the z position on the surface of the second work 92 and the difference between the z positions on the surfaces of the two works 91 and 92 (step height of the coating portion 93). ..
  • FIG. 3 is a block diagram showing the configuration of the sealing robot 1.
  • the sealing robot 1 controls the operation of the robot arm 3 according to a predetermined motion plan that defines the path of the sealing gun 4, and moves in the extending direction of the coating portion 93 with the sealing gun 4 facing the coating portion 93.
  • the control device 7 is provided. Through this control, a coating operation of applying the sealing material 90 to the coating portion 93 in a bead shape is performed.
  • the control device 7 includes a storage unit 31 such as RAM and ROM, a calculation unit 32 such as a CPU, a sensor 5, and an interface 33 connected to various actuators 41 to 46, 49.
  • the control device 7 is realized by a robot controller including a computer such as a microcontroller.
  • the control device 7 may be composed of a single control device for centralized control, or may be composed of a plurality of control devices for distributed control in cooperation with each other.
  • the various actuators include the above-mentioned discharge actuator 49.
  • the various actuators include a plurality of actuators 41 to 46 that rotationally drive a plurality of links 11 to 16 constituting the robot arm 3, respectively. By the operation of these actuators 41 to 46, the positions and postures of the links 11 to 16 are changed, and the sealing gun 4 moves together with the sensor 5.
  • These actuators 41 to 46 are electric motors as an example.
  • the calculation unit 32 controls the operation of the sealing robot 1 by reading and executing software such as a basic program stored in the storage unit 31.
  • the data stored in the storage unit 31 includes data indicating the teaching position.
  • the teaching positions are acquired at a plurality of points along the shape of the coating portion 93 at the coating operation site before the coating operation is performed.
  • the calculation unit 32 generates an operation plan based on the teaching position data stored in the storage unit 31 during the coating operation.
  • a motion plan is a set of position data that interpolates between two adjacent teaching positions.
  • the teaching position and the motion plan are defined as the coordinate values of the base coordinate system CB and define the path of the sealing gun 4. Further, as described above, when the sealing gun 4 is moved along the path, the nozzle 22 faces the coating portion 93 in the Z direction of the tool coordinate system CT, and the moving direction as seen from the current position of the sealing gun 4.
  • the posture of the sealing gun 4 is defined by the motion plan so that is in the Y direction of the tool coordinate system CT.
  • the data stored in advance in the storage unit 31 includes measurement point data 51 indicating a plurality of measurement points set on the path of the sealing gun 4 and reference shape data indicating the reference shape of the coating site 93. 50 is included.
  • FIG. 5A and 5B are explanatory views of the first position and the second position.
  • the coating site at the position where the inspection light L of the sensor 5 is irradiated is also in the X direction when viewed from the position of the sealing gun 4. Is in the same position.
  • the application site at the measurement position is separated from the current position of the sealing gun 4 in the X direction.
  • the sharp curve portion 93c has a larger curvature than the S-shaped portion 93f, the amount of separation from the sealing gun 4 in the X direction is also large.
  • the coating portion fits within the allowable dimension ⁇ x, and in the sharp curved portion 93c having a relatively tight curvature, the coating portion 93 deviates from the allowable dimension ⁇ x.
  • the coating portion 93 is within the allowable dimension ⁇ x, and in the bent portion 93e (see FIG. 2) in which the angle formed by the two lines is relatively small. , The coating site 93 deviates from the permissible dimension ⁇ x.
  • the coating portion 93 is the moving direction with reference to the sealing gun 4 at a position separated from the arbitrary position by a predetermined distance in the moving direction of the sealing gun 4.
  • the position that falls within the predetermined allowable dimension ⁇ x in the vertical direction is defined as the “first position”.
  • the position where the coating portion 93 deviates from the allowable dimension ⁇ x is defined as the “second position”.
  • the positions on the route are the first positions.
  • the bent portion or the portion immediately before the curved portion all or most of the positions on the path are the second positions.
  • Each of the plurality of measurement points indicated by the measurement point data 51 is preset at the first position.
  • a plurality of measurement points are selected in advance before the coating operation is performed, and all of them are set to the first position.
  • the storage unit 31 stores a data group showing a plurality of reference shapes corresponding to each of the plurality of measurement points selected in advance. This reference shape is contrasted with the shape measured by the sensor 5 during the coating operation. Therefore, the reference shape data 50 is also defined as the coordinate values (particularly, Z coordinate and X coordinate) of the tool coordinate system CT, like the data that can be measured by the sensor 5.
  • the reference shape corresponding to the measurement point is the shape of the coating portion at a position first away from the measurement point where the sealing gun 4 should be located in the moving direction of the sealing gun 4 by a predetermined distance, and this predetermined distance is the sealing. Corresponds to the distance from the gun 4 to the inspection light L.
  • the reference shape data 50 may be generated by using the design data.
  • the reference shape data 50 may be acquired by actual measurement using the sensor 5 and the sample workpieces 91 and 92 after the teaching position is generated and before the coating operation is performed.
  • the actual measurement can be performed without discharging the sealing material 90.
  • the measurement point may correspond to the first teaching position among the teaching positions, or may be a position between two adjacent teaching positions.
  • FIG. 4 is a flowchart showing an example of the coating process executed by the control device.
  • the robot arm 3 is operated to move the sealing gun 4 to the starting point of the path (S1).
  • the sealing gun 4 moves so that the nozzle 22 of the sealing gun 4 faces the end of the first straight line portion 93a (see FIG. 2).
  • the operation of the discharge actuator 49 is controlled while controlling the operation of the robot arm 3 and moving the sealing gun 4 along the path defined by the operation plan, and the sealing material 90 is applied from the sealing gun 4. Discharge toward the site 93 (S2). Further, the sensor 5 is operated to irradiate the inspection light L at a position on the path ahead of the current position of the sealing gun 4 (S3). Then, when the sealing gun 4 reaches the measurement point set and stored in advance as described above, the shape of the coating portion is measured by the sensor 5 (S4).
  • the path of the sealing gun 4 from the current position (measurement point) of the sealing gun 4 to the position where the shape is measured is corrected from the one specified in the operation plan ( S6).
  • the reference shape data 50 is used for this correction.
  • the difference between the shape of the reference shape data 50 and the measured shape is derived as a correction amount.
  • this "shape" is represented by the Z coordinate and the X coordinate of the tool coordinate system.
  • correction amounts There are two types of correction amounts, a correction amount ⁇ z for the Z-direction component and a correction amount ⁇ x for the X-direction component.
  • the correction amount ⁇ z of the Z-direction component is derived from the difference between the measured value zp of the Z coordinate and the reference value
  • the correction amount ⁇ x of the X-direction component is derived from the difference between the measured value xp of the X coordinate and the reference value. ..
  • the control device 7 When the sealing gun 4 reaches the position where the shape is measured, the control device 7 has a correction amount ⁇ x for the X-direction component in the X direction and a correction amount ⁇ x for the Z-direction component in the Z direction from the initially defined position.
  • the path of the sealing gun 4 is corrected so that the sealing gun 4 is positioned at the position shifted by.
  • the sealing gun 4 can be opposed to the coating portion 93 at an appropriate distance in the Z direction without deviation in the X direction. Therefore, even if the discharge amount of the sealing material 90 per unit time is saved, the sealing material 90 can be applied to the coating portion 93, and the bead width of the sealing material 90 becomes small.
  • FIG. 7 is a flowchart showing the coating process according to the second embodiment.
  • the number of measurement points is set to be larger than that in the first embodiment in which it is necessary to store the reference shape data for each measurement position.
  • the measurement points are set according to each position data defined by the operation plan, but the number may be set to a smaller number in consideration of the calculation load and the like.
  • the coating site at the measurement position is perpendicular to the extending direction of the coating site with reference to the current position of the sealing gun 4. It is determined whether or not it is within the predetermined allowable dimension ⁇ x in any direction (S5). That is, it is determined whether the measurement point is the first position or the second position.
  • the extending direction of the coating portion is the Y direction of the tool coordinate system CT, and the direction perpendicular to this is the X direction of the tool coordinate system CT.
  • the control device 7 determines whether or not the coating site at the measurement position ahead of the sealing gun 4 on the path is separated from the sealing gun 4 by a predetermined dimension or more in the X direction.
  • the shape data obtained as the coordinate value of the tool coordinate system CT is converted into the coordinate value of the base coordinate system CB. This is because the motion plan is defined by the coordinate values of the base coordinate system CB.
  • the coordinate value indicating the position on the motion plan corresponding to the position where the shape is measured is compared with the coordinate value obtained by the conversion.
  • the correction amount is derived based on the difference in the coordinate values.
  • the derivation of this correction amount is the same as in the first embodiment, and as the correction amount, the correction amount of the Z direction component of the tool coordinate system CT and the correction amount of the X direction component are derived.
  • the sealing gun 4 is moved to the position where the shape is measured reflecting the correction amount.
  • the measurement result of S5 is not referred to, and the sealing gun 4 is moved to the position where the shape is measured according to a predetermined operation plan (S7).
  • the distance between the sealing gun 4 and the coating portion 93 may be larger or smaller from the appropriate value in the Z direction, or the sealing gun 4 may be displaced from the coating portion 93 in the X direction at the measurement position. Therefore, the operation of the discharge actuator 49 may be controlled, and the discharge amount of the sealing material 90 per unit time may be increased as compared with the case where it is determined that the discharge actuator 49 is within the allowable dimension ⁇ x. As a result, it is possible to prevent the sealing material 90 from coming off from the coating portion 93.
  • the sealing material 90 can be applied to the coating member 93 while saving the discharge amount of the sealing gun 4. Further, since the correction process is omitted in the portion having a large curvature that deviates from the permissible range, the calculation load can be reduced, which contributes to speeding up the movement of the sealing gun 4.

Abstract

シーリングガンの経路上の任意位置のうち、当該任意位置からシーリングの移動方向において所定距離だけ先に離れた位置で、塗布部位がシーリングガンを基準にして移動方向と垂直な方向に所定の許容寸法内に入るものを第1位置とし、塗布部位が許容寸法から外れるものを第2位置とする。制御装置は、第1位置にある測定点で測定された塗布部位の形状に基づいて、シーリングガンの経路を動作計画で規定されるものから補正するように構成されている。

Description

シーリングロボット
 本発明は、ワークの塗布部位にシール材を塗布するシーリングロボットに関する。
 特許文献1は、自動車の製造現場に適用される粘性材料塗布装置を開示している。この装置は、ロボットハンドに取り付けられたミキシングヘッドを備える。ミキシングヘッドは、所定軌跡に沿って移動しながらシール材を吐出し、ワークの塗布部位にシール材を塗布する。
特開平6-269720号公報
 ワークが公差の範囲内に製造あるいは位置決めされていても、ロボットに対するワークの位置はばらつく。位置ずれ量によっては、所定軌跡に沿って移動させても、シール材が塗布部位から外れる可能性がある。シール材が外れないように、塗布部位の単位長さ当たりのシール材の塗布量を多くすると、製品の高コスト化を招く。
 そこで本発明は、塗布量を節約してシール材を塗布部位に塗布できるシーリングロボットを提供することを目的とする。
 本発明に係るシーリングロボットは、
 線状に延びるワークの塗布部位にシール材を塗布するシーリングロボットであって、
 基台と、
 その基端部にて前記基台に連結されたロボットアームと、
 前記ロボットアームの先端部に装着され、シール材を吐出するシーリングガンと、
 前記シーリングガンの経路を規定する所定の動作計画に従って、前記ロボットアームの動作を制御し、前記シーリングガンを前記塗布部位と対向させた状態で前記塗布部位の延在方向に移動させる制御装置と、
 前記シーリングガンの前記経路上の任意位置のうち、当該任意位置から前記シーリングの前記移動方向において所定距離だけ先に離れた位置で、前記塗布部位が前記シーリングガンを基準にして前記移動方向と垂直な方向に所定の許容寸法内に入るものを第1位置とし、前記塗布部位が前記許容寸法から外れるものを第2位置とした場合において、
 前記制御装置が、前記第1位置にある前記測定点で測定された前記塗布部位の形状に基づいて、前記シーリングガンの経路を前記動作計画で規定されるものから補正するように構成されている。
 前記構成によれば、塗布作業中に、シーリングガンよりも先で塗布部位の形状を測定し、測定結果に基づきシーリングガンの経路が補正される。ロボットに対するワークの位置にずれが生じていても、シーリングガンが塗布部位と対向する状態を維持できる。塗布量を節約してもシール材を塗布部位に塗布できる。
 制御装置は、シーリングガンが経路上の「第1位置」にあるときにセンサによる測定結果に基づいて経路を補正する。「第1位置」とは、シーリングガンから所定距離だけ先に離れた位置で、シーリングガンを基準にして塗布部位が移動方向と垂直な方向に許容寸法内に入るような経路上の位置である。許容寸法から外れる場合としては、センサが誤測定した場合、あるいは、塗布部位が急曲線であったり、直角あるいは鋭角に折れ曲がっていたりする場合を例示できる。塗布部位が折れ曲がる箇所では、塗布部位がセンサの走査範囲に収まらず測定結果を得られなくなる可能性がある。許容寸法内に入るときに補正をするので、誤測定に起因してシール材が塗布部位から外れるおそれを抑制でき、また、塗布部位がセンサの走査範囲から外れるのを未然防止できる。補正のための演算負荷を軽減でき、シーリングガンの高速移動に資する。
 本発明によれば、塗布量を節約しても塗布部材にシール材を塗布できるシーリングロボットを提供できる。
第1実施形態に係るシーリングロボットの概要図である。 塗布部位の一例を示す平面図である。 第1実施形態に係るシーリングロボットの構成を示すブロック図である。 第1実施形態に係る塗布処理を示すフローチャートである。 図5Aおよび5Bは、第1位置および第2位置の説明図である。 補正量を導出する処理の説明図である。 第2実施形態に係る塗布処理を示すフローチャートである。
 以下、図面を参照しながら実施形態について説明する。
 図1は、第1実施形態に係るシーリングロボット1の概要図である。シーリングロボット1は、ワーク91,92の塗布部位93にシール材90を塗布する。シーリングロボット1は、基台2、ロボットアーム3、シーリングガン4、およびセンサ5を備えている。基台2は、塗布作業を行う製造現場に設置される。床、壁または天井に定置されてもよく、走行可能に支持されていてもよい。ロボットアーム3の基端部は、基台2に連結される。シーリングガン4は、ロボットアーム3の先端部に取外し可能に装着される。
 ロボットアーム3は、複数のリンク部材11~16を基台2から順次に関節を介して連結することによって構成されている。本実施形態では、一例として、シーリングロボット1が6軸ロボットである。ロボットアーム3は、6つのリンク部材として、旋回台11、上下アーム12,13および第1~第3手首部14~16を備えている。旋回台11がロボットアーム3の基端部を成し、第3手首部16の先端部がロボットアーム3の先端部を成している。旋回台11は基台2に第1軸A1周りに回転可能に連結され、下アーム12は旋回台11に第2軸A2周りに回転可能に連結され、上アーム13は下アーム12に第3軸A3周りに回転可能に連結されている。第1手首部14は上アーム13に第4軸A4周りに回転可能に連結され、第2手首部15は第1手首部14に第5軸A5周りに回転可能に連結され、第3手首部16は第2手首部15に第6軸A6周りに回転可能に連結されている。本実施形態では、一例として、シーリングロボット1またはロボットアーム3が、垂直多関節型である。第1軸A1は基台2の支持面に垂直であり、第2軸A2は第1軸A1に垂直であり、第3軸A3は第2軸A2に平行である。第4軸A4は第3軸A3に垂直であり、第5軸A5は第4軸A4に垂直であり、第6軸A6は第5軸A5に垂直である。ただし、リンク部材(あるいは関節、回転軸)の個数は6に限定されない。ロボットアーム3は水平多関節型でもよい。
 シーリングガン4は、ロボットアーム3の先端部に、直接的あるいは間接的に、取外し可能に装着される。本実施形態では、シーリングガン4の基端部が平板状の保持部材6の表面に固定され、保持部材6の裏面がロボットアーム3の先端部に装着される。シーリングガン4は、保持部材6を介してロボットアーム3に取外し可能に装着される。
 シーリングガン4は、貯留部21およびノズル22を有する。貯留部21は、筒状に形成され、シール材90を貯留する。ノズル22は、細管状であり、基端部で貯留部21と連通し、先端部で外に開放されている。一例として、貯留部21は、ホース23を介して製造現場内の供給源(図示せず)と接続されている。ノズル22は、貯留部21に貯留されているシール材90を外に吐出する。シール材90の吐出と並行して、シール材90が供給源から貯留部21に補給される。シール材90を吐出させる吐出アクチュエータ49(図3参照)は、制御装置7(図3参照)によって作動状態(吐出)と停止状態(非吐出)とを切換可能に構成されていれば、特に限定されない。供給源に設けたポンプでもよいし、貯留部21に設けたプランジャでもよい。
 ノズル22から吐出されたシール材90は、塗布部位93に塗布される。一例として、塗布部位93は、2つの板状のワーク91,92の重ね合わせによって形成された合わせ部である。ノズル22は、概略的にワーク91,92の板厚方向において塗布部位93と対向し、この対向方向にシール材90が吐出される。塗布部位93に塗布されたシール材90によって、合わせ部の間隙が封止される。第1ワーク91は、ノズル22から見て、第2ワーク92よりも奥にある。塗布部位93は、第1ワーク91の表面、第2ワーク92の側端面および第2ワーク92の表面とで構成され、第2ワーク92の側端面に沿って延びている。
 図2に示すように、ワーク91,92の板厚方向から見ると、塗布部位93は線状に延びる。「線状」は、直線、曲線およびこれらの連続を含む。図2の例示では、塗布部位93が、第1直線部分93a、折れ線部分93b、急曲線部分93c、第2直線部分93d、折曲部分93e、S字部分93fおよび第3直線部分93gを含み、これら部分93a~gがこの順に連続して1本の線を形成する。ただし、塗布部位93は無端状に形成されていてもよい。
 図1に戻り、符号CBは、原点を基台2上に設定したベース座標系を表す。符号CTは、原点をシーリングガン4上に設定したツール座標系を表す。図1では、ツール座標系CTの原点をノズル22の先端に設定した場合を例示するが、シーリングガン4あるいはこれに対して相対変位しない部分(例えば、保持部材6あるいはセンサ5)上の任意の位置に設定できる。ベース座標系CBの原点も同様である。
 シーリングガン4は、制御装置7(図3参照)によるロボットアーム3の動作の制御により、シーリングガン4を塗布部位93と対向させた状態で塗布部位93の延在方向に移動する。シーリングガン4の経路は、図2に例示したような塗布部位93の形状(板厚方向から見た形状)に倣ったものとなる。
 センサ5は、シーリングガン4を経路に沿って移動させている間に、シーリングガン4の経路上でシーリングガン4よりも先で、塗布部位93の形状を測定する。センサ5は、一例として、レーザセンサであり、直線状の検査光Lをワーク91,92に照射し、その反射光に基づいて塗布部位93の形状を測定する。
 センサ5は、保持部材6にシーリングガン4と共に保持され、ロボットアーム3の動作によらずシーリングガン4に対して相対変位しない。センサ5の検査光Lは、シーリングガン4から、ツール座標系CBを成す直交3軸のうちの1つの方向(例えばY方向)に離れた箇所に、ツール座標系CBを成す直交3軸のうちの別の方向(例えばX方向)に直線的に延びるようにして、照射される。これにより、検査光Lが塗布部位93を当該方向(例えばX方向)に横切るように照射される。塗布部位93は折れ線部やS字部を含んでいる。ベース座標系CBではシーリングガン4の経路のXYZ各成分が塗布部位93の箇所によって異なるが、ロボットアーム3の動作の制御(例えば、第3手首部16の回転角の制御)により、ツール座標系CTでは、Y軸がシーリングガン4の移動方向に向け続けられる。これにより、塗布部位93が複雑に曲がりくねっていても、シーリングガン4の移動方向においてシーリングガン4よりも先で、検査光Lを照射できる。
 なお、シーリングガン4のノズル22はツール座標系CBを成す直交3軸のうちの別の方向(例えば、Z方向)に延び、シール材90は当該方向に吐出される。シール材90の吐出方向、シール材90と塗布部位93との対向方向、ワーク90,91の板厚方向は、いずれも当該方向に向けられており、ノズル22の先端は、塗布部位93から当該方向において所定の間隔だけ離れた状態に保たれる。
 センサ5は、検査光Lの反射光に基づいて、検査光Lが照射された位置における塗布部位93の断面形状を測定できる。この断面は、シーリングガン4の移動方向に対して垂直な断面である。本例では、ツール座標系CTのZX断面である。センサ5により測定される形状は、ツール座標系CTの座標値として定義される。センサ5は、塗布部位93の断面形状として、塗布部位93のツール座標系CTにおける位置を示すデータを測定する。センサ5は、断面形状を表すツール座標系CTの座標値として、測定位置における塗布部位93のZ方向(ノズル延在方向、ノズル対向方向、シール材吐出方向あるいはワーク板厚方向に相当)の座標値zpと、測定位置における塗布部位93のX方向(塗布部位93の延在方向あるいはシーリングガン4の移動方向に対して垂直な方向に相当)の座標値xpとを測定する。
 図1に略示するとおり、塗布部位93のX方向の座標値xpとは、塗布部位93の段差、あるいは、ノズル22から見て手前側にある第2ワーク92の側端面のX方向の位置である。図1では、塗布部位93のZ方向の座標値zpが、ノズル22から見て奥側にある第1ワーク91の表面のz位置として示されているが、これは単なる一例である。センサ5は、これに代えてまたは加えて、第2ワーク92の表面のz位置や、2つのワーク91,92の表面のz位置の差分(塗布部位93の段差高)を測定してもよい。以下では、説明の便宜のため、図示される座標値zp,xpが取得されるものとする。
 図3は、シーリングロボット1の構成を示すブロック図である。シーリングロボット1は、シーリングガン4の経路を規定する所定の動作計画に従って、ロボットアーム3の動作を制御し、シーリングガン4を塗布部位93と対向させた状態で塗布部位93の延在方向に移動させる制御装置7を備えている。この制御を通じて、シール材90を塗布部位93にビード状に塗布する塗布作業が行われる。
 制御装置7は、RAM、ROM等の記憶部31、CPU等の演算部32、センサ5および各種アクチュエータ41~46,49と接続されるインターフェイス33を備える。制御装置7は、例えば、マイクロコントローラ等のコンピュータを備えたロボットコントローラにより実現される。制御装置7は、集中制御する単独の制御装置で構成されてもよいし、互いに協働して分散制御する複数の制御装置で構成されてもよい。
 各種アクチュエータには、前述した吐出アクチュエータ49が含まれる。各種アクチュエータには、ロボットアーム3を構成する複数のリンク11~16をそれぞれ回転駆動する複数のアクチュエータ41~46が含まれる。これらアクチュエータ41~46の動作により、各リンク11~16の位置および姿勢が変わり、シーリングガン4がセンサ5と共に移動する。これらアクチュエータ41~46は、一例として電気モータである。
 記憶部31には、ロボットコントローラとしての基本プログラム、各種固定データ等の情報が記憶されている。演算部32は、記憶部31に記憶された基本プログラム等のソフトウェアを読み出して実行することにより、シーリングロボット1の動作を制御する。
 記憶部31に記憶されるデータには、教示位置を示すデータが含まれる。教示位置は、塗布作業の実施前に、塗布作業の現場で塗布部位93の形状に沿った複数点で取得される。演算部32は、塗布作業中、記憶部31に記憶される教示位置データに基づいて動作計画を生成する。動作計画は、隣接する2つの教示位置の間を補間する位置データの集合である。教示位置および動作計画は、ベース座標系CBの座標値として定義され、シーリングガン4の経路を規定する。また、上記のとおり、当該経路に沿ってシーリングガン4を移動させるに際し、ノズル22がツール座標系CTのZ方向に塗布部位93と対向し、また、シーリングガン4の現在位置から見た移動方向がツール座標系CTのY方向となるように、シーリングガン4の姿勢が動作計画によって規定される。
 本実施形態では、記憶部31に予め記憶されるデータに、シーリングガン4の経路上に設定される複数の測定点を示す測定点データ51、および、塗布部位93の基準形状を示す基準形状データ50が含まれる。
 図5AおよびBは、第1位置および第2位置の説明図である。図5Aに示すように、シーリングガン4が直線経路上にあるときには、本来的には、センサ5の検査光Lが照射さ
れる位置での塗布部位も、シーリングガン4の位置から見てX方向に同じ位置にある。S字経路上にあるときには、測定位置での塗布部位がシーリングガン4の現在位置から見てX方向に離れる。図5Bに示すように、折れ線部93bおよび急曲線部93cでも同様である。しかし、急曲線部93cは、S字部分93fと比べて曲率が大きいので、シーリングガン4からのX方向の離隔量も大きい。曲率が比較的に緩やかなS字部分93cでは、塗布部位が許容寸法Δx内に収まり、曲率が比較的にきつい急曲線部93cでは、塗布部位93が許容寸法Δxから外れる。また、連続する2線が成す角度が比較的に大きい折れ線部93bでは、塗布部位93が許容寸法Δx内に収まり、2線が成す角度が比較的に小さい折曲部93e(図2参照)では、塗布部位93が許容寸法Δxから外れる。
 ここで、シーリングガン4の経路上の任意位置のうち、当該任意位置からシーリングガン4の移動方向において所定距離だけ先に離れた位置で、シーリングガン4を基準にして塗布部位93が移動方向と垂直な方向に所定の許容寸法Δx内に入るものを「第1位置」とする。逆に、塗布部位93が許容寸法Δxから外れるものを「第2位置」とする。図5Aおよび5Bの例では、直線部、折れ線部あるいはS字部分では、経路上の全部または殆どの位置が第1位置となる。急曲線部、折曲部あるいはその直前の部分では、経路上の全部または殆どの位置が第2位置となる。測定点データ51で示される複数の測定点はいずれも、第1位置に予め設定されている。
 なお、シーリングガン4が直線経路上にあったとしても、測定環境その他の条件により、検査光Lに基づく測定結果が実際を反映しない、誤測定を生じる可能性がある。このような誤測定を生じた場合には、塗布部位93が許容寸法Δxから外れる可能性がある。
 このように、本実施形態では、複数の測定点が、塗布作業の実施前に予め選択されており、全て第1位置に設定されている。記憶部31は、予め選択された複数の測定点それぞれに対応する複数の基準形状を示すデータ群を記憶する。この基準形状は、塗布作業の実施中にセンサ5により測定される形状と対比される。そのため、基準形状データ50も、センサ5により測定可能なデータと同様、ツール座標系CTの座標値(特に、Z座標およびX座標)として定義されるものである。また、測定点に対応する基準形状は、シーリングガン4が位置すべき測定点から所定距離だけシーリングガン4の移動方向において先に離れた位置での塗布部位の形状であり、この所定距離はシーリングガン4から検査光Lまでの距離と対応する。
 基準形状データ50は、設計データを援用して生成されてもよい。基準形状データ50は、教示位置の生成後、塗布作業の実施前に、センサ5とサンプルのワーク91,92を用いた実測によって取得されてもよい。実測は、シール材90の吐出を伴わずに実行できる。測定点は、教示位置のうち第1位置であるものと対応していてもよく、隣接する2つの教示位置の間の位置でもよい。
 図4は、制御装置により実行される塗布処理の一例を示すフローチャートである。図4に示すように、まず、ロボットアーム3を作動させ、経路の始点にシーリングガン4を移動させる(S1)。本例では、シーリングガン4のノズル22が第1直線部93a(図2参照)の端部と対向する状態となるように、シーリングガン4が移動する。
 次に、ロボットアーム3の動作を制御して、動作計画によって規定される経路に沿ってシーリングガン4を移動させながら、吐出アクチュエータ49の動作を制御して、シール材90をシーリングガン4より塗布部位93に向けて吐出する(S2)。また、センサ5を動作させ、シーリングガン4の現在位置よりも経路上の先の位置に検査光Lを照射する(S3)。そして、シーリングガン4が前述のように予め設定および記憶された測定点に到達したときに、センサ5によって塗布部位の形状を測定する(S4)。
 次に、S4の測定結果に基づいて、シーリングガン4の現在位置(測定点)から形状が測定された位置に至るまでのシーリングガン4の経路を動作計画で規定されていたものから補正する(S6)。本実施形態では、この補正に基準形状データ50を利用する。
 図6に示すように、基準形状データ50の形状と測定された形状との差を補正量として導出する。この「形状」は、前述したとおり、ツール座標系のZ座標およびX座標で表される。補正量は、Z方向成分の補正量δzとX方向成分の補正量δxの2種ある。Z方向成分の補正量δzは、Z座標の測定値zpと基準値との差によって導出され、X方向成分の補正量δxは、X座標の測定値xpと基準値との差によって導出される。
 制御装置7は、シーリングガン4が形状を測定した位置に到達したときに、当初の規定される位置から、X方向にX方向成分の補正量δxだけ、Z方向にZ方向成分の補正量δxだけシフトした位置にシーリングガン4が位置づけられるように、シーリングガン4の経路を補正する。これにより、シーリングガン4が形状を測定した位置に到達したとき、シーリングガン4を塗布部位93とZ方向に適正な間隔をおいてX方向にずれなく対向させることができる。このため、シール材90の単位時間当たり吐出量を節約しても、シール材90を塗布部位93に塗布することができ、シール材90のビード幅が小さくなる。
 シーリングガン4の移動中(S8:NO)、上記処理が繰り返し実行される。シーリングガン4が経路の終点に到達すると(S8:YES)、塗布作業の処理が終了する。
 次に、第2実施形態について説明する。第2実施形態では、基準形状データを要さず、シーリングガン4の経路を第1実施形態とは異なる手法で補正する。図7は、第2実施形態に係る塗布処理を示すフローチャートである。
 本実施形態では、測定点の個数が、測定位置ごとに基準形状データを記憶する必要があった第1実施形態と比べて多く設定されている。一例として、測定点が動作計画によって規定される位置データそれぞれに応じて設定されるが、演算負荷等を考慮して、それよりも少ない個数に設定されてもよい。
 図7に示すように、本実施形態では、S4での測定結果を参照して、当該測定位置での塗布部位が、シーリングガン4の現在位置を基準にして、塗布部位の延在方向と垂直な方向に所定の許容寸法Δx内にあるか否かを判断する(S5)。すなわち、測定点が第1位置であるか第2位置であるか判断する。本例では、塗布部位の延在方向はツール座標系CTのY方向であり、これに垂直な方向はツール座標系CTのX方向である。制御装置7は、経路上においてシーリングガン4よりも先にある測定位置での塗布部位が、シーリングガン4から見てX方向に所定寸法以上離れているか否かを判断する。
 塗布部位が許容寸法Δx内にあると判断すると(S5:YES)、次に、S4の測定結果に基づいて、シーリングガン4の現在位置(測定点)から形状が測定された位置に至るまでのシーリングガン4の経路を動作計画で規定されていたものから補正する(S6A)。
 本実施形態の補正の処理S6Aでは、ツール座標系CTの座標値として得られた形状のデータを、ベース座標系CBの座標値に変換する。これは、動作計画がベース座標系CBの座標値によって定義されているためである。次に、形状を測定した位置に対応した動作計画上の位置を示す座標値を、変換により得られた座標値と対比する。座標値の差に基づいて、補正量を導出する。この補正量の導出は、第1実施形態と同様であり、補正量として、ツール座標系CTのZ方向成分の補正量と、X方向成分の補正量とが導出される。第1実施形態と同様にして、補正量を反映して形状を測定した位置までシーリングガン4を移動させる。
 塗布部位が許容寸法Δx外にあると判断すると(S5:NO)、S5の測定結果は参照されず、予め定められた動作計画に従ってシーリングガン4を形状を測定した位置まで移動させる(S7)。このとき、シーリングガン4と塗布部位93との間隔がZ方向に適正値から大きくまたは小さくなったり、シーリングガン4が測定位置において塗布部位93からX方向にずれたりする可能性がある。そこで、吐出アクチュエータ49の動作を制御し、許容寸法Δx内にあると判断されたときと比べてシール材90の単位時間当たり吐出量を多くしてもよい。これにより、シール材90が塗布部位93から外れるのを抑止できる。
 本実施形態においても、第1実施形態と同様にして、シーリングガン4の吐出量を節約してシール材90を塗布部材93に塗布することができる。また、許容範囲から外れるような大曲率の部分では補正処理を省略するので、演算負荷を軽減でき、シーリングガン4の移動の高速化に資する。
 これまで実施形態について説明したが、上記構成は一例であり、本発明の範囲内で適宜変更、削除および/または追加可能である。

Claims (6)

  1.  線状に延びるワークの塗布部位にシール材を塗布するシーリングロボットであって、
     基台と、
     その基端部にて前記基台に連結されたロボットアームと、
     前記ロボットアームの先端部に装着され、シール材を吐出するシーリングガンと、
     前記シーリングガンの経路を規定する所定の動作計画に従って、前記ロボットアームの動作を制御し、前記シーリングガンを前記塗布部位と対向させた状態で前記塗布部位の延在方向に移動させる制御装置と、
     前記シーリングガンが前記経路上に設定される複数の測定点の各々に位置するときに、前記シーリングガンの移動方向において前記測定点の各々よりも先で、前記塗布部位の形状を測定するセンサと、を備え、
     前記シーリングガンの前記経路上の任意位置のうち、当該任意位置から前記シーリングの前記移動方向において所定距離だけ先に離れた位置で、前記塗布部位が前記シーリングガンを基準にして前記移動方向と垂直な方向に所定の許容寸法内に入るものを第1位置とし、前記塗布部位が前記許容寸法から外れるものを第2位置とした場合において、
     前記制御装置が、前記第1位置にある前記測定点で測定された前記塗布部位の形状に基づいて、前記シーリングガンの経路を前記動作計画で規定されるものから補正するように構成されている、
     シーリングロボット。
  2.  前記制御装置が、前記第1位置に設定された前記複数の測定点をそれぞれ示す測定点データと、前記複数の測定点それぞれに対応した前記塗布部位の基準形状を示す基準形状データを記憶する記憶部を備え、
     前記制御装置は、前記測定点で測定された前記塗布部位の形状と、当該測定点に対応する基準形状とを比較し、形状の差に基づいて前記シーリングガンの前記経路を補正するように構成されている、
     請求項1に記載のシーリングロボット。
  3.  前記センサが前記シーリングガンに取り付けられ、前記センサにより測定される前記塗布部位の形状が前記シーリングガン上に原点を設定したツール座標系の座標値によって定義され、前記動作計画が前記基台上に原点を設定したベース座標系の座標値によって定義され、
     前記制御装置は、
      前記センサの測定結果に基づいて、前記測定点が前記第1位置であるか前記第2位置であるか判断し、
      前記測定点が前記第1位置であると判断すると、当該測定点で測定された前記塗布部位の形状を示す座標値を前記ベース座標系の座標値に変換し、変換された座標値と前記動作計画として定義された座標値とを比較し、座標値の差に基づいて前記シーリングガンの前記経路を補正し、
      前記測定点が前記第2位置であると判断すると、前記動作計画に従って前記シーリングガンを移動させるように構成されている、
     請求項1に記載のシーリングロボット。
  4.  前記制御装置は、前記測定点が前記第2位置であると判断すると、前記測定点が前記第1位置であると判断したときと比べ、前記シーリングガンのシール材の吐出量を多くする、
     請求項3に記載のシーリングロボット。
  5.  前記塗布部位が、2つの板状ワークの重ね合わせによって形成される合わせ部であり、
     前記センサが、前記塗布部位の前記形状を示すパラメータとして、前記ワークの板厚方向における前記塗布部位の位置と、前記移動方向と垂直な方向における前記塗布部位の位置とを測定する、
     請求項1ないし4のいずれか1項に記載のシーリングロボット。
  6.  前記センサが、前記移動方向と垂直な方向に前記塗布部位を横切るように、レーザ光を前記ワークに照射するレーザセンサである、
     請求項5に記載のシーリングロボット。
PCT/JP2020/031440 2019-08-22 2020-08-20 シーリングロボット WO2021033743A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN202080043601.4A CN114007761B (zh) 2019-08-22 2020-08-20 密封机器人
US17/637,075 US20220288625A1 (en) 2019-08-22 2020-08-20 Sealing robot
EP20855430.3A EP4019150A4 (en) 2019-08-22 2020-08-20 SEALING ROBOT

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019151812A JP7249242B2 (ja) 2019-08-22 2019-08-22 シーリングロボット
JP2019-151812 2019-08-22

Publications (1)

Publication Number Publication Date
WO2021033743A1 true WO2021033743A1 (ja) 2021-02-25

Family

ID=74661158

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/031440 WO2021033743A1 (ja) 2019-08-22 2020-08-20 シーリングロボット

Country Status (5)

Country Link
US (1) US20220288625A1 (ja)
EP (1) EP4019150A4 (ja)
JP (1) JP7249242B2 (ja)
CN (1) CN114007761B (ja)
WO (1) WO2021033743A1 (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210237116A1 (en) * 2020-02-03 2021-08-05 Ross-Hime Designs, Inc. Robotic marking system
MX2023005835A (es) 2021-02-26 2023-06-02 Nippon Steel Corp Lamina de acero y metodo de fabricacion de la misma.

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06269720A (ja) 1993-03-19 1994-09-27 Toyota Motor Corp 粘性材料塗布装置
JPH07332927A (ja) * 1994-06-13 1995-12-22 Komatsu Ltd ワークの位置検出装置
JP2003019451A (ja) * 2001-07-09 2003-01-21 Kansai Paint Co Ltd 塗布方法、及ぶ塗布装置

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07104692B2 (ja) * 1986-10-02 1995-11-13 トヨタ自動車株式会社 予見追跡制御型ロボツト
JPH01184066A (ja) * 1988-01-14 1989-07-21 Nissan Motor Co Ltd 追従移動装置
JP3831462B2 (ja) * 1997-01-28 2006-10-11 本田技研工業株式会社 ウインドガラスへのシーラー塗布装置
JP3315094B2 (ja) 1999-05-17 2002-08-19 川崎重工業株式会社 シール装置および塗装装置
JP4302830B2 (ja) 1999-08-09 2009-07-29 川崎重工業株式会社 ロボットのキャリブレーション方法及び装置
EP1613138A1 (de) * 2004-06-30 2006-01-04 Unaxis International Trading Ltd Vorrichtung zum Auftragen von Klebstoff auf ein Substrat
JP4339290B2 (ja) 2005-07-29 2009-10-07 アンリツ株式会社 変位測定装置
DE102006004919A1 (de) * 2006-02-01 2007-08-16 Thyssenkrupp Steel Ag Laserstrahlschweißkopf
CN103021918A (zh) * 2008-08-28 2013-04-03 东京应化工业株式会社 输送装置
US20100180711A1 (en) 2009-01-19 2010-07-22 Comau, Inc. Robotic end effector system and method
US9849637B2 (en) * 2013-10-22 2017-12-26 The Boeing Company Self-centering sealant applicator
ITUA20164436A1 (it) * 2016-06-16 2017-12-16 Comau Spa "Cella di robot"

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06269720A (ja) 1993-03-19 1994-09-27 Toyota Motor Corp 粘性材料塗布装置
JPH07332927A (ja) * 1994-06-13 1995-12-22 Komatsu Ltd ワークの位置検出装置
JP2003019451A (ja) * 2001-07-09 2003-01-21 Kansai Paint Co Ltd 塗布方法、及ぶ塗布装置

Also Published As

Publication number Publication date
JP2021030350A (ja) 2021-03-01
JP7249242B2 (ja) 2023-03-30
EP4019150A1 (en) 2022-06-29
CN114007761B (zh) 2023-06-13
US20220288625A1 (en) 2022-09-15
EP4019150A4 (en) 2023-09-13
CN114007761A (zh) 2022-02-01

Similar Documents

Publication Publication Date Title
WO2021033743A1 (ja) シーリングロボット
EP2375298B1 (en) Programming method for a robot, programming apparatus for a robot, and robot control system
JP5118821B2 (ja) ロボットの制御装置
US20200016759A1 (en) Robot system for assembling component and control method thereof
JP2004261878A (ja) 作業ロボットを用いた制御システムおよびこの制御システムによるワーク加工方法
EP2584419B1 (en) CNC machine for cutting with plasma, oxygen and water jet used as a cutting tool with automatic setting up a precise position of a cutting tool in a cutting head by autocalibration and method thereof
JP5549223B2 (ja) ロボットの制御装置および制御方法、ロボットシステム
US10987742B2 (en) Method of controlling positioning control apparatus and positioning control apparatus
WO2020066102A1 (ja) ロボットの教示作業支援システム及び教示作業支援方法
JP6091826B2 (ja) 加工装置の制御装置、加工装置、及び加工データの補正方法
CN111452047A (zh) 机器人工具偏差的修正方法、机器人控制装置及系统
CN110154043B (zh) 基于加工结果进行学习控制的机器人系统及其控制方法
JP2011138275A (ja) アーク溶接ロボットの制御装置及びプログラム
JP4396553B2 (ja) ロボット制御装置,コンピュータプログラム
KR102034541B1 (ko) 부품 조립용 로봇 시스템의 제어방법
JP7040932B2 (ja) 溶接位置検出装置、溶接位置検出方法及び溶接ロボットシステム
EP3680070A1 (en) Robot system and operating method thereof
JP6705017B2 (ja) 作業ロボットの目的位置補正方法
LT6304B (lt) Automobilio kėbulo padengto užpildu apdirbimo įrenginys ir būdas
JP2019166578A (ja) ロボットの動作プログラムの設定装置、ロボット、およびロボットの制御方法
WO2021111759A1 (ja) リペア溶接装置およびリペア溶接方法
KR100214675B1 (ko) 산업용 로봇의 기준 자세 및 위치 교정 장치 및 그 방법
JP6705173B2 (ja) 溶接方法および溶接装置
JP6566516B2 (ja) シーラ塗布方法
Bickendorf Automatic welding robot offline programming with adaptive automation level

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20855430

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2020855430

Country of ref document: EP

Effective date: 20220322