This application claims priority to Taiwan Application Serial Number 105134128, filed Oct. 21, 2016, which is herein incorporated by reference.
The present invention relates to a mechanical arm positioning method. More particularly, the present invention relates to a mechanical arm positioning method applied to three degrees of freedom or six degrees of freedom.
With the progress of science and technology, mechanical arms that never get tired and work continuously have been gradually introduced into production lines requiring a large amount of repetitive actuation to replace the traditional manpower on the production line. However, due to the spatial errors probably accumulated during the continuous actuating processes of the mechanical arms, the mechanical arms gradually deviate from predetermined strokes in which the mechanical arms are preset to move and actuate between various fixed points. Therefore, after the mechanical arms have operated for a period of time, the operators need to re-adjust the positioning of the mechanical arms. However, not only does the adjustment consume manpower, but it also takes a longer working time to ensure the positioning accuracy of the mechanical arms during the fine-tuning process. The waste of time and manpower is thus caused. Even more, the adjustment work carried out by manpower is still easy such that omissions or generate errors, which in turn affect subsequent actuations of the mechanical arms. In addition, it can not cope with the adjustment work of the mechanical arms on heavier, faster production lines.
For the foregoing reasons, there is a need to solve the above-mentioned problems by providing a mechanical arm positioning method and a system adopting the same, which is also an objective that the industry is eager to achieve.
One aspect or the present invention is related to a mechanical arm positioning method that uses the image-capturing module to capture the positioning pattern so as to generate the comparison image with an image of the positioning pattern. In addition, distance relationships between the mechanical arm and the fixed point along various axes in the space are determined through comparing the relative position and relative area between the image of the positioning pattern and the comparison image so as to adjust the mechanical arm to the fixed point. As a result, the mechanical arm can be more accurately positioned at the fixed point, and the amount of computation and computation time required for adjusting the mechanical arm are reduced to reduce the burden of the computing device and the length of the computation time.
A mechanical arm positioning method configured to position a mechanical arm at a fixed point is provided. The mechanical arm positioning method comprises: capturing a positioning pattern through utilizing a image-capturing module disposed on the mechanical arm to obtain a comparison image with a positioning image, the positioning image corresponding to the positioning pattern; determining whether a center of the positioning image is located at a center of the comparison image; adjusting a position of the mechanical arm in parallel with a plane where the positioning pattern is located such that the center of the positioning image to be located at the center of the comparison image if the center of the positioning image is not located at the center of the comparison image; determining whether an area of the positioning image is substantially equal to a predetermined area; and adjusting a position of the mechanical arm perpendicular to the plane where the positioning pattern is located to change a distance between the image-capturing module and the positioning pattern if the area of the positioning image is not equal to the predetermined area such that the area of the positioning image to be substantially equal to the predetermined area.
In the foregoing, the mechanical arm positioning method further comprises: determining whether an acute angle between an edge of the positioning image and an edge of the comparison image is substantially equal to a predetermined angle; and rotating the mechanical arm in parallel with the plane where the positioning pattern is located if the acute angle is not equal to the predetermined angle such that the acute angle to be equal to the predetermined angle. The predetermined angle is generated by using the image-capturing module to capture the positioning pattern when the mechanical arm is located at the fixed point.
In the foregoing, the step of determining whether the area of the positioning image is substantially equal to a predetermined area comprises: determining a magnitude relationship between the area of the positioning image and the predetermined area; adjusting the mechanical arm such that the mechanical arm to move away from the positioning pattern along a direction perpendicular to the plane where the positioning pattern is located if the area of the positioning image is larger than the predetermined area; and adjusting the mechanical arm such that the mechanical arm to move closer to the positioning pattern along the direction perpendicular to the plane where the positioning pattern is located if the area of the positioning image is smaller than the predetermined area.
In the foregoing, the mechanical arm positioning method further comprises: utilizing the image-capturing module to capture the positioning pattern so as to generate a standard image with a standard positioning image when the mechanical arm is located at the fixed point; and generating the predetermined area based on an area of the standard positioning image.
In the foregoing, the mechanical arm further comprises a three-axis gravitational acceleration measurement module having a three-axis gravitational acceleration value disposed on the mechanical arm. The three-axis gravitational acceleration value corresponds to degrees of rotation of the mechanical arm. The mechanical arm positioning method further comprises: determining whether the three-axis gravitational acceleration value is substantially equal to a predetermined three-axis gravitational acceleration values; and rotating the mechanical arm such that the three-axis gravitational acceleration value of the three-axis gravitational acceleration measurement module to be substantially equal to the predetermined three-axis gravitational acceleration value if the three-axis gravitational acceleration value is not equal to the predetermined three-axis gravitational acceleration value.
In the foregoing, the mechanical arm positioning method further comprises: capturing the three-axis gravitational acceleration value of the three-axis gravitational acceleration measurement module to generate standard gravity sensing data when the mechanical arm is located at the fixed point; and generating the predetermined three-axis gravitational acceleration value based on values of the standard gravity sensing data.
Another aspect of the present invention is related to a mechanical arm system that utilizes the image-capturing module disposed at the movable end of the mechanical arm to capture the positioning pattern so as to generate the comparison image with the image of the positioning pattern. In addition, distance relationships between movable end and the fixed point along various axes in the space are determined through comparing the relative position and relative area between the image of the positioning pattern and the comparison image so as to drive the driving member to adjust the movable end to the fixed point. As a result, the movable end of the mechanical arm can be more accurately positioned at the fixed point, and the amount of computation and computation time required for adjusting the mechanical arm are reduced to reduce the burden of the computing device and the length of the computation time. At the same time, the time required for repositioning is reduced.
The invention provides a mechanical arm system. The mechanical arm system comprises a mechanical arm, an image-capturing module, and a computing device. The mechanical arm comprises a movable end and at least one driving member. The driving member is configured to move the movable end to a fixed point. The image-capturing module is fixed to the movable end. The image-capturing module is configured to capture a positioning pattern at a moving point so as to generate a comparison image with a positioning image. The positioning image corresponds to the positioning pattern. The computing device is configured to determine whether a center of the positioning image is located at a center of the comparison image. If not, the driving member is driven to adjust a position of the movable end in parallel with a plane where the positioning pattern is located such that the center of the positioning image to be located at the center of the comparison image. The computing device is further configured to determine whether an area of the positioning image is substantially equal to a predetermined area. If not, the driving member is driven to adjust a position of the movable end along a direction perpendicular to the plane where the positioning pattern is located to change a distance between the image-capturing module and the positioning pattern so as such that the area of the positioning image to be substantially equal to the predetermined area.
In the foregoing, the computing device is further configured to determine a magnitude relationship between the area of the positioning image and the predetermined area. The driving member is driven such that the movable end to move away from the positioning pattern along the direction perpendicular to the plane where the positioning pattern is located if the area of the positioning image is larger than the predetermined area. The driving member is driven to adjust the mechanical arm such that the movable end to move closer to the positioning pattern along the direction perpendicular to the plane where the positioning pattern is located if the area of the positioning is smaller than the predetermined area.
In the foregoing, the image-capturing module is further configured to utilize the image-capturing module to capture the positioning pattern so as to generate a standard image with a standard positioning image when the movable end of the mechanical arm is located at the fixed point, and generate the predetermined area based on the standard positioning image.
In the foregoing, the driving member is further configured to rotate the movable end. The computing device is further configured to determine whether an acute angle between an edge of the positioning image and an edge of the comparison image is substantially equal to a predetermined angle. If not, the driving member is driven to rotate the movable end in parallel with the plane where the positioning pattern is located such that the acute angle between the edge of positioning image and the edge of the comparison image to be substantially equal to the predetermined angle.
In the foregoing, the driving member is further configured to rotate the movable end. The mechanical arm system further comprises a three-axis gravitational acceleration measurement module disposed on the mechanical arm. The three-axis gravitational acceleration measurement module is configured to measure a three-axis gravitational acceleration value corresponding to degrees of rotation of the movable end of the mechanical arm. The computing device is further configured to determine whether the three-axis gravitational acceleration value is substantially equal to a predetermined three-axis gravitational acceleration value. If not, the driving member is driven to rotate the movable end so as such that the three-axis gravitational acceleration value of the three-axis gravitational acceleration measurement module to be substantially equal to the predetermined three-axis gravitational acceleration value.
In the foregoing, the three-axis gravitational acceleration measurement module is further configured to capture the three-axis gravitational acceleration value of the three-axis gravitational acceleration measurement module to generate standard gravity sensing data when the movable end of the mechanical arm is located at the fixed point, and generate the predetermined three-axis gravitational acceleration value based on the standard gravity sensing data.
It is to be understood that both the foregoing general description and the following detailed description are by examples, and are intended to provide further explanation of the invention as claimed.
Aspects of the present disclosure are best understood from the following detailed description when read with the accompanying figures. It is noted that, in accordance with the standard practice in the industry, various features are not drawn to scale. In fact, the dimensions of the various features may be arbitrarily increased or reduced for clarity of discussion.
In the following detailed description, for purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. It will be apparent, however, that one or more embodiments may be practiced without these specific details. In other instances, well-known structures and components are schematically depicted in order to simplify the drawings.
It will be understood that, although the terms first, second, third etc. may be used herein to describe various elements, components, regions, layers and/or sections, these elements, components, regions, layers and/or sections should not be limited by these terms. These terms are only used to distinguish one element, component, region, layer or section from another element, component, region, layer or section. Thus, a first element, component, region, layer or section discussed below could be termed a second element, component, region, layer or section without departing from the teachings of the present invention.
A description is provided with reference to
A description is provided with reference to
A description is provided with reference to
A description is provided with reference to
A description is provided with reference to
Since the mechanical arm positioning method 600 first adjusts the movable end 114 to position the center point of the positioning image at the image center of the comparison image, for example, the center point 822B of the positioning image 820B is overlapped with the image center 802B of the comparison image 800B so that the movable end 114 is collinear with the fixed point A along the direction Z1 perpendicular to the plane of the positioning pattern 400. After that, the movable end 114 is adjusted along the direction Z1 such that the area of the positioning image to be substantially equal to the predetermined area, for example, such that the area A2 of the positioning image 920A′ to be substantially equal to the predetermined area A0. As a result, the movable end 114 can be adjusted to the fixed point A from the other moving points P1, P2, P3 in the space with the assistance of the image-capturing module 200. Even more, the computing device 300 can further perform the mechanical arm positioning method 600 automatically to achieve full automation of the positioning of the mechanical arm system 100 through judging the comparison image captured by the image-capturing module 200 to actuate the mechanical arm 110 correspondingly.
In addition, distortion at an edge of the comparison image can be avoided by positioning the positioning pattern 400 at a center of the field of view 220 such that the area of the positioning image to be better corresponded to the positioning pattern 400 in the field of view 220. The positioning accuracy of the movable end 114 is thus increased. In other embodiments, the comparison image captured by the image-capturing module 200 may be pre-processed, such as processed by a flat field correcting, etc., such that the area of the positioning image to be better corresponded to the positioning pattern 400 in the field of view 220.
In one embodiment, when the movable end 114 of the mechanical arm 114 is located at the fixed point A, standard gravity sensing data can be generated through capturing gravitational acceleration values of the three-axis gravitational acceleration measurement module 500 on the W-axis, the V-axis, and the U-axis. The computing device 300 can generate predetermined three-axis gravitational acceleration values gW0, gV0 based on the standard gravity sensing data, and store the predetermined three-axis gravitational acceleration values gW0, gV0 in the storage module 320. In other embodiments, the predetermined three-axis gravitational acceleration values gW0, gV0 may have initial values stored in the storage module 320.
A description is provided with reference to
As shown in
A description is provided with reference to
A description is provided with reference to
Since the mechanical arm positioning method 1000 first adjusts the rotation angles of the movable end 114 on the W axis the V axis, the Z axis of the movable end 114 can thus be substantially in parallel with a Z1 axis of the positioning pattern 400. Then, the center point of the positioning image is positioned at the image center of the comparison image in parallel with a plane constituted by an X1 axis and a Y1 axis of the positioning pattern 400 so that the movable end 114 is collinear with the fixed point A along the direction Z1 perpendicular to a plane of the positioning pattern 400. After that, the movable end 114 is adjusted along the direction Z1 such that the area of the positioning image to be substantially equal to the predetermined area. In addition, the movable end 114 is rotated along the U axis such that the X axis and the Y axis of the movable end 114 to be in parallel with the X1 axis and the Y1 axis of the positioning pattern 400. As a result, the movable end 114 can be adjusted to the fixed point A from the other moving points P1, P2, P3 in the space by using a predetermined rotation angle with the assistance of the image-capturing module 200. Even more, the computing device 300 can further perform the mechanical arm positioning method 1000 automatically to achieve full automation of the positioning of the mechanical arm system 100 through judging the three-axis gravitational acceleration values of the three-axis gravitational acceleration measurement module 500 and the comparison image captured by the image-capturing module 200 to actuate the mechanical arm 110 with six degrees of freedom correspondingly. The use of manpower is reduced.
It is noted that the description of a value of the area A2 being substantially equal to the value of the predetermined area A0, the three-axis gravitational acceleration values gW1′, gV1′ being substantially equal to the predetermined three-axis gravitational acceleration values gW0, gV0, and a value of the acute angle θ1′ being substantially equal to the value of the predetermined angle θ0 in the present disclosure is not intended to limit the present invention. For example, the area A2 may be an area in the pixel space, and a unit conversion is necessary to correspond the area A2 to the predetermined area A0 that uses the area in the real space as the value. For example, the area A2 and the predetermined area A0 may be regarded as substantially equal within an allowable error range, such as within an error of ±1%, but the present invention is not limited in this regard. It should be understood that those of ordinary skill in the art to which this invention pertains may flexibly make selections depending on practical needs without departing from the spirit and scope of the present invention, as long as the area, the three-axis gravitational acceleration values, and the predetermined angle can be used to accurately position the mechanical arm 110 at the fixed point A.
In summary, the present invention provides a mechanical arm positioning method that uses the image-capturing module to capture the positioning pattern so as to generate the comparison image with an image of the positioning pattern. In addition, distance relationships between the mechanical arm and the fixed point along various axes in the space are determined through comparing the relative position and relative area between the image of the positioning pattern and the comparison image so as to adjust the mechanical arm to the fixed point. As a result, the mechanical arm can be more accurately positioned at the fixed point, and the amount of computation and computation time required for adjusting the mechanical arm are reduced to reduce the burden of the computing device and the length of the computation time.
The present invention further provides a mechanical arm system that utilizes the image-capturing module disposed at the movable end of the mechanical arm to capture the positioning pattern so as to generate the comparison image with the image of the positioning pattern. In addition, distance relationships between movable end and the fixed point along various axes in the space are determined through comparing the relative position and relative area between the image of the positioning pattern and the comparison image so as to drive the driving member to adjust the movable end to the fixed point. As a result, the movable end of the mechanical arm can be more accurately positioned at the fixed point, and the amount of computation and computation time required for adjusting the mechanical arm are reduced to reduce the burden of the computing device and the length of the computation time. At the same time, the time required for repositioning is reduced.
Although the present invention has been described in considerable detail with reference to certain embodiments thereof, other embodiments are possible. Therefore, the spirit and scope of the appended claims should not be limited to the description of the embodiments contained herein.
It will be apparent to those skilled in the art that various modifications and variations can be made to the structure of the present invention without departing from the scope or spirit of the invention. In view of the foregoing, it is intended that the present invention cover modifications and variations of this invention provided they fall within the scope of the following claims and their equivalents.
Number | Date | Country | Kind |
---|---|---|---|
105134128 | Oct 2016 | TW | national |