TW201741100A - Detecting module for multi-axis mobile carriage, method for positioning correction of detecting module, and multi-axis mobile carriage device with detecting module comprises at least two displacement sensors and at least one image sensor to sense whether the position of the multi-axis mobile carriage is corrected - Google Patents

Abstract

A detecting module for a multi-axis mobile carriage mainly comprises a bracket, at least two displacement sensors and at least one image sensor mounting on the bracket. In the process of placing an inspection tool on a tool holder by the multi-axis mobile carriage, the displacement sensors are abutted against the inspection tool to sense whether the inspection tool is kept parallel to a reference plane of the bracket, and then the image sensor senses the positional deviation of the center point on the inspection tool relative to the position of the tool holder. Finally, the position of the multi-axis mobile carriage is corrected by compensation according to the result of sensing. Therefore the purpose of enabling the multi-axis mobile carriage to maintain good positioning accuracy is achieved and the multi-axis mobile carriage accurately takes and puts the blade tooling from the tool holder when the machine tool runs the actual cutting process.

Description

Detection module for multi-axis mobile vehicle, positioning correction method of the detection module, and multi-axis mobile vehicle device having the same

The invention relates to a multi-axis mobile load, in particular to a detection module for a multi-axis mobile vehicle, a positioning correction method for the detection module, and a multi-axis mobile carrier device having the detection module.

In general, multi-axis moving vehicles, such as robotic arms, are mainly used to handle highly repetitive tasks such as assembly, cutting or handling. Before starting the operation, the operator must first pass the teacher or manually. The analog coordinates are input to the multi-axis mobile vehicle so that the multi-axis mobile vehicle can perform the tasks planned beforehand based on the position of the simulated coordinates.

Since there is usually a positioning error between the simulated coordinates and the actual machining position, the positioning error needs to be calculated through a compensation mechanism during the pick-and-place process, and then the position of the multi-axis moving carrier is taken according to the obtained result. Further corrections. In view of this, the applicant of the present invention provides a detection module capable of maintaining a good positioning accuracy of the multi-axis moving carrier applied during operation.

The main object of the present invention is to provide a detection module for a multi-axis moving carrier, which has a simple structure and convenient operation, and can maintain a good positioning accuracy of the multi-axis moving carrier applied.

In order to achieve the above object, the detection module provided by the present invention comprises a bracket, at least two displacement sensors, and an image sensor. The bracket has a reference surface; the displacement sensor has a body disposed on the bracket and a telescopic rod axially displaceably disposed on the body, the axial direction of the telescopic rod being perpendicular to the reference of the bracket And the telescopic rod has a measuring end, and when the multi-axis moving carrier places a moving member (checking tool) in a positioning groove (tool slot) of a fixing member (tool holder), The telescopic rod abuts against the receiving surface of the detecting tool by the measuring end, so that the displacement sensor can sense whether the receiving surface of the detecting tool is parallel to the resisting rod by the moving distance of the telescopic rod a reference surface of the bracket; the image sensor is disposed under the tool slot of the tool holder for sensing a positional deviation of a center point of the tool holder relative to a center point of the tool slot.

A second object of the present invention is to provide a positioning correction method for the aforementioned detection module, which can sense the coordinate error of the multi-axis moving carrier in a simple and quick manner. Firstly, the multi-axis moving carrier is moved to move the moving member toward the positioning groove of the fixing member, and then the displacement sensor is used to abut the receiving surface of the moving member for sensing the receiving member. Whether the abutting surface is parallel to the reference surface of the bracket, and adjusting the angle of the multi-axis moving carrier according to the sensing result, so that the two planes can be parallel to each other, and then the moving object is captured by the image sensor and/or Or an image of the fixing member for sensing a position deviation of a center point of the inspection tool relative to a center point of the tool slot, and adjusting a position of the multi-axis moving carrier according to the sensing result to make two center points The plurality of moving carriers can be placed in the positioning groove after the adjustment is completed.

It is still another object of the present invention to provide a multi-axis mobile carrier device having the above-described detection module, which mainly mounts the bracket of the detection module on the multi-axis moving carrier, so that The multi-axis moving carrier can simultaneously correct the position of the multi-axis moving carrier during the process of picking up and displacing the moving member, thereby reducing the number of configurations of the detecting module and achieving the effect of reducing cost.

The detailed construction, features, assembly or use of the detection module provided by the present invention will be described in the detailed description of the following embodiments. However, it should be understood by those of ordinary skill in the art that the present invention is not limited by the scope of the invention.

10‧‧‧Multi-axis mobile vehicle

12‧‧‧ Controller

14‧‧‧Checkers

P2‧‧‧

16‧‧‧Tool holder

18‧‧‧Tool slot

20‧‧‧Test module

30‧‧‧ bracket

31‧‧‧First support wall

P1‧‧‧ datum

32‧‧‧Second support wall

33‧‧‧ third support wall

34‧‧‧Image hole

35‧‧‧Mounting holes

40‧‧‧ Displacement Sensor

41‧‧‧Ontology

42‧‧‧ Telescopic rod

43‧‧‧Measurement end

50‧‧‧Image sensor

60‧‧‧Multi-axis mobile vehicle device

Fig. 1 is a schematic view showing the structure of a first embodiment of the present invention.

Fig. 2 is a partial bottom view of the first embodiment of the present invention, mainly showing the arrangement relationship of the displacement sensors.

Figures 3a-3c are flow diagrams of the operation of the present invention.

Figure 4 is a block diagram of the present invention.

Fig. 5 is a schematic structural view showing a second embodiment of the present invention.

Figure 6 is a schematic view showing the structure of a second embodiment of the present invention.

FIG. 7A is a schematic view showing the assembly of the detecting module in the third embodiment of the present invention.

Fig. 7B is a bottom view of the detecting module in the third embodiment of the present invention.

Please refer to FIG. 1 and FIG. 3a first. The multi-axis moving carrier 10 shown in the figure is a mechanical arm, which is mainly used for placing a inspection tool 14 (moving member) on a holder 16 (fixing member). Inside a cutter groove 18 (positioning groove).

A detecting module 20 provided by the first embodiment of the present invention includes a bracket 30. A three-displacement sensor 40, and an image sensor 50.

The bracket 30 has a first supporting wall 31, a second supporting wall 32 opposite to the first supporting wall 31, and a third supporting wall 33 connecting the first and second supporting walls 32, wherein the first supporting wall 31 has a reference plane P1. In this embodiment, the bracket 30 is in close contact with the blade holder 16 by the reference surface P1 of the first support wall 31. Further, as shown in FIG. 2, the first support wall 31 has a The image-receiving hole 34 and the three-mounting hole 35 are located directly under one of the cutter grooves 18 of the blade holder 16, and the three mounting holes 35 are arranged at equal angles centering on the image-receiving hole 34.

The displacement sensor 40 has a body 41 and a telescopic rod 42. The body 41 is disposed in the mounting hole 35 of the first support wall 31 of the bracket 30. The telescopic rod 42 is axially displaceably disposed in the body 41. The axial direction of the rod 42 is perpendicular to the reference plane P1 of the bracket 30. Further, the telescopic rod 42 has a measuring end 43 located outside the body 41. It should be additionally noted that the number of the displacement sensors 40 does not have to be configured in three groups, as long as at least two groups can achieve the desired effect, but the three groups are the best implementation.

The image sensor 50 (herein, taking the photosensitive coupling element as an example) is located directly under the tool slot 18 of the blade holder 16. In the embodiment, the image sensor 50 is mounted on the second support wall 32 of the bracket 30, The image sensor 50 is caused to capture an image through the image taking hole 34 of the first support wall 31 of the bracket 30. It should be noted that the number of image sensors 50 may be more than one single, that is, a plurality of image sensors 50 may be configured, but the single image sensor 50 is a better implementation cost and performance. Aspect.

The above is the configuration of the detection module 20 according to the first embodiment of the present invention. The positioning correction method of the detection module 20 according to the first embodiment of the present invention will be described below with reference to Figs. 3a to 3c and Fig. 4 .

Step a): Operating the multi-axis moving carrier 10 moves the gage 14 in the direction of the tool slot 18 of the holder 16.

Step b): During the process of placing the inspection tool 14, the measuring end 43 of the telescopic rod 42 of the displacement sensor 40 is abutted against one of the receiving surfaces P2 of the inspection tool 14, so that the displacement sensor 40 can be used by the displacement sensor 40 The moving distance of the telescopic rod 42 senses whether or not the receiving surface P2 of the gauge 14 is parallel to the reference plane P1 of the carriage 30, and transmits the sensing result to the controller 12 of the multi-axis moving carrier 10 for analysis processing. If the telescopic rods 42 of the three sets of displacement sensors 40 have the same moving distance, it means that the abutting surface P2 of the gage 14 is parallel to the reference plane P1 of the bracket 30, and there is no need to adjust the multi-axis moving carrier 10 at this time. The angle, conversely, if the moving distance of the telescopic rod 42 of the three sets of displacement sensors 40 is not the same, the resisting surface P2 representing the gauge 14 is inclined and not parallel to the reference plane P1 of the bracket 30, which The controller 12 adjusts the angle and/or height of the multi-axis moving carrier 10 until the receiving surface P2 of the gauge 14 is parallel to the reference plane P1 of the carriage 30. If necessary, a circular mark may be preset in the mounting position of the inspection tool, and then the image captured by the image sensor 50 determines whether the mark is a perfect circle, and the acceptance surface of the inspection tool 14 is repeatedly confirmed. Whether P2 is parallel to the reference plane P1 of the carriage 30.

Step c): After the angle adjustment of the multi-axis moving carrier 10 is completed, the image sensor 50 is used to capture the image of the bottom surface of the inspection tool 14 through the image capturing hole 34 of the bracket 30 for sensing the inspection tool 14 The positional deviation of the center point with respect to the center point of the cutter groove 18, and transmits the sensing result to the controller 12 of the multi-axis moving carrier 10 for analysis processing. If the two center points are overlapped, it means that the gage 14 is in the correct position, and there is no need to move the multi-axis moving carrier 10, if the two center points are not overlapped, the position of the gage 14 is The deviation, at this time the controller 12 will adjust the horizontal position of the multi-axis moving carrier 10 until two The center dotted lines are coincident. Step d): After completing the compensation correction of the multi-axis moving carrier 10 at the first position, operating the multi-axis moving carrier 10 to place the first inspection tool 14 in the tool slot 18 of the holder 16, and then The next gage 14 performs steps b) to c) until the detection and positioning correction of all positions is completed.

On the other hand, the bracket 30 of the detecting module 20 does not have to be mounted on the holder 16, as shown in Figs. 5 and 6, in the second embodiment of the present invention, the first supporting wall 31 of the bracket 30 is directly Mounted on the multi-axis moving carrier 10, the displacement sensor 40 is mounted to the first support wall 31 of the bracket 30 in a reverse manner, so that the entire detection module 20 and the multi-axis moving carrier 10 together form a multi-axis movement. The carrier device 60 can be operated synchronously, and the detecting module 20 can sense whether the position of the multi-axis moving carrier 10 needs to be compensated during the process of picking up the detecting tool 14 with the multi-axis moving carrier 10. Instead of providing the reference surface with the bracket 30, the reference surface required for the displacement sensor 50 is provided instead of the blade holder 16 or the face parallel to the holder 16.

Referring again to FIGS. 7A and 7B, the gauge 14 is held by the multi-axis moving carrier 10. At this time, the bracket 30 of the detecting module 20 can also be directly mounted on the bottom surface of the inspection tool 14, so that the telescopic rod 42 of the displacement sensor 40 is changed to face downward (that is, toward the blade holder 16), and the image sensor is simultaneously 50 is also disposed on the bottom surface of the inspection tool 14 so that the image sensor 50 is also oriented downward (ie, toward the blade holder 16), and the top surface of the holder 16 can be used as the receiving surface, and the cutter groove 18 of the holder 16 ( In this embodiment, the circular shape is used as the aligned image, and the horizontal position of the multi-axis moving carrier 10 is confirmed.

In summary, the detection module 20 of the present invention uses the simple combination of the displacement sensor 40 and the image sensor 50 to sense whether the position of the multi-axis moving carrier 10 during operation exceeds the allowable error range. The compensation correction can be performed immediately when the tolerance range is allowed, so that the multi-axis moving carrier 10 can maintain good positioning accuracy during the operation, thereby achieving the present invention. The purpose of Ming.

It should be noted that, in the embodiment in which the detecting module 20 is mounted on the multi-axis moving carrier 10, the position of the image sensor can be adjusted to suit different use situations.

16‧‧‧Tool holder

18‧‧‧Tool slot

20‧‧‧Test module

30‧‧‧ bracket

31‧‧‧First support wall

P1‧‧‧ datum

32‧‧‧Second support wall

33‧‧‧ third support wall

40‧‧‧ Displacement Sensor

41‧‧‧Ontology

42‧‧‧ Telescopic rod

43‧‧‧Measurement end

50‧‧‧Image sensor

Claims (13)

A detection module for a multi-axis mobile vehicle includes: a bracket; at least two displacement sensors respectively having a body disposed on the bracket and an axially displaceable passage through the body a telescopic rod, the telescopic rods are disposed in parallel with the bracket; and at least one image sensor is disposed on the bracket and the displacement sensors and the at least one image sensor are both facing a fixing member. The detecting module for a multi-axis moving carrier according to claim 1, wherein the fixing member is a tool holder, and the multi-axis moving carrier is used for placing a gage in a tool slot of the tool holder. The detecting tool has a receiving surface, and the telescopic rod has a measuring end, and the telescopic rod abuts against the receiving surface of the detecting tool by the measuring end, so that the displacement sensor can be used by the telescopic rod The moving distance is to sense whether the contact surface of the gage has a reference plane parallel to the bracket. The detecting module for a multi-axis moving carrier according to claim 1 or 2, wherein the bracket has a first supporting wall, a second supporting wall with respect to the first supporting wall, and a connection a third support wall of the first and second support walls, the first support wall has a reference surface and is disposed on the body of the displacement sensor, and the at least one image sensor is disposed on the second of the bracket Support wall. The detection module for a multi-axis moving carrier according to claim 2, wherein the at least one image sensor is disposed under the tool slot of the tool holder for sensing a center point of the tool relative to The amount of positional deviation of the center point of the tool slot. The detecting module for the multi-axis moving carrier of claim 3, wherein the first supporting wall of the bracket has an image taking hole and at least two mounting holes, and the two mounting holes are centered on the image capturing hole And arranged at equal angles; the body of the displacement sensor is disposed in the mounting hole. The detecting module for multi-axis moving carrier according to claim 1, wherein the fixing member is a tool holder, and the multi-axis moving carrier is used for clamping a tool and placing it in a tool slot of the tool holder. The bracket is mounted to the gauge. A positioning correction method for a detection module according to claim 1, comprising the steps of: a) operating the multi-axis moving carrier to move a moving member toward a tool slot of a fixing member; b) utilizing the two The displacement sensor abuts against one of the receiving surfaces of the moving member for sensing whether the receiving surface of the moving member is parallel to the reference surface of the bracket, and adjusting the multi-axis moving carrier according to the sensing result The angle of the moving member is parallel to the reference surface of the bracket; c) capturing the image of the moving member and/or the fixing member by using the at least one image sensor to sense the movement The position deviation of the center point of the piece relative to the center point of the positioning groove, and adjusting the position of the multi-axis moving carrier according to the sensing result, so that the center point of the moving piece coincides with the center point of the positioning groove; and d The multi-axis moving carrier is operated to place the moving member in the positioning groove of the fixing member. The positioning correction method of claim 7, wherein the moving member is a inspection tool, and the fixing member is a holder. The positioning correction method of claim 8, wherein the bracket is mounted to the seat or the multi-axis moving carrier. A multi-axis mobile carrier device comprising: a multi-axis mobile carrier; and the detection module of claim 1, wherein the bracket is disposed on the multi-axis mobile carrier. The multi-axis moving carrier device of claim 10, wherein the multi-axis moving carrier device is for placing a gage in a tool slot of a tool holder. The multi-axis moving carrier device of claim 11, wherein the bracket has a first supporting wall, a second supporting wall opposite to the first supporting wall, and a connecting the first and second supporting walls a third supporting wall, the first supporting wall is disposed on the multi-axis moving carrier and has the reference surface; the body of the displacement sensor is disposed on the first supporting wall of the bracket, the at least one image sensor Provided on the second support wall of the bracket. The multi-axis moving carrier device of claim 12, wherein the multi-axis moving carrier device holds the tool, the bracket is mounted on the detecting device, and the displacement sensor and the image sensor are Both face the holder.