Multiaxial motion control device and method, in particular control device and method for a robot arm
20170348858 · 2017-12-07
Inventors
Cpc classification
G06F2203/0384
PHYSICS
B25J9/1694
PERFORMING OPERATIONS; TRANSPORTING
Y02P90/02
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
G06F3/017
PHYSICS
International classification
Abstract
A multiaxial motion control device, having a motion detector to be attached to a moveable object to detect multiple axial movement of the moveable object and to output detection results and a control device to convert said detection results into motion control commands for a multiaxial motion driving device, in particular motion control commands for a plurality of arm segments of a robot arm. A method to control motions of the multiaxial motion driving device, in particular the robot arm, using the control device are also provided.
Claims
1-23. (canceled)
24. A multiaxial motion control device, comprising: a motion detector for wearing on a movable object to successively detect an amount of motion of the movable object and output a detection result; and a control device for receiving the detection result of the motion detector and, based on the detection result, generating a motion control command for a multiaxial motion driving device comprising a plurality of motion actuators designated for each axial component of motion of the multiaxial motion driving device; wherein the motion detector comprises a multiaxial motion detector for detecting a motion of the motion detector and generating motion parameters defining axial motion components of the motion in at least three axes as the detection result of the motion detector; wherein the control device comprises a command interpreting circuit for converting a series of successive motion parameters of the motion detector into a series of motion control commands; wherein one motion control command comprises driving commands for the respective motion actuators; and wherein the series of successive motion control commands controls the motion actuators, so that they together move a reference point on the multiaxial motion driving device substantially along a motion trajectory of the motion detector.
25. The multiaxial motion control device of claim 24, wherein the multiaxial motion driving device is one selected from the group consisting of a robot arm having a plurality of arm segments wherein the motion control command comprises driving commands for respective motion actuators driving the respective arm segments of the robot arm, an automated guided vehicle (AGV) having a plurality of driving wheels wherein the motion control command comprises driving commands for the respective drive wheels that drive the AGV to move on a plane and a multiaxial motion driving device carried by a fluid wherein the motion control command comprises driving commands for a plurality of motion actuators driving the multiaxial motion driving device to move in three dimensions.
26. The multiaxial motion control device of claim 24, wherein the multiaxial motion driving device is provided with a motion drive capability independent of the motion of the device itself, in driving a motion of an auxiliary element and wherein the command interpreting circuit is configured to interpret a motion parameter of the motion detector into a motion control command for the auxiliary element.
27. The multiaxial motion control device of claim 24, wherein the multiaxial motion driving device is provided with an auxiliary operation capability other than a motion driving capability and the command interpreting circuit is configured to interpret a motion parameter of the motion detector into an operation command for the auxiliary operation.
28. The multiaxial motion control device of claim 27, wherein the auxiliary operation is at least one selected from the group consisting of generating a sound and emitting light.
29. The multiaxial motion control device of claim 24, wherein the motion control command further comprises at least one selected from the group consisting of starting motion, stopping motion, acceleration and deceleration.
30. The multiaxial motion control device of claim 24, wherein the motion detector is one selected from the group consisting of a triaxial motion detector, a six-axis motion detector and a nine-axis motion detector.
31. The multiaxial motion control device of claim 24, wherein the motion parameter generated by the motion detector comprises representative information of individual axial components of the motion in the at least three axes.
32. The multiaxial motion control device of claim 24, wherein a series of motion parameter generated by the motion detector comprises representative information of motion direction and motion amount of a motion in the three-dimensional space in a time sequence.
33. The multiaxial motion control device of claim 24, wherein the control device comprises a driving device for providing driving commands to the respective motion actuators of the multiaxial motion driving device based on the motion control command generated by the command interpreting circuit.
34. The multiaxial motion control device of claim 25, wherein the motion control command further comprises at least one selected from the group consisting of starting motion, stopping motion, acceleration and deceleration.
35. The multiaxial motion control device of claim 25, wherein the motion detector is one selected from the group consisting of a triaxial motion detector, a six-axis motion detector and a nine-axis motion detector.
36. The multiaxial motion control device of claim 25, wherein the motion parameter generated by the motion detector comprises representative information of individual axial components of the motion in the at least three axes.
37. The multiaxial motion control device of claim 25, wherein a series of motion parameter generated by the motion detector comprises representative information of motion direction and motion amount of a motion in the three-dimensional space in a time sequence.
38. The multiaxial motion control device of claim 25, wherein the control device comprises a driving device for providing driving commands to the respective motion actuators of the multiaxial motion driving device based on the motion control command generated by the command interpreting circuit.
39. A robot arm system comprising: a robot arm comprising a base, at least a first arm segment and a second arm segment, a first joint operatively connecting the first arm segment and the base and a second join operatively connecting the first and second arm segments, and a motion actuator to drive the first arm segment to move respectively to the base and a second motion actuator to drive the second arm segment to move respectively to the first arm segment; a motion detector for wearing on a movable object to successively detect an amount of motion of the movable object and output a detection result; and a control device for receiving the detection result of the motion detector and, based on the detection result, generating a motion control command for the robot arm; wherein the motion detector comprises a multiaxial motion detector for detecting a motion of the motion detector and generating motion parameters defining axial motion components of the motion in at least three axes as the detection result of the motion detector; wherein the control device comprises a command interpreting circuit for converting a series of successive motion parameters of the motion detector into a series of successive motion control commands; wherein one motion control command comprises driving commands for the respective motion actuators; and wherein the series of successive motion control commands controls the motion actuators, so that they together move a reference point on the robot arm substantially along a motion trajectory of the motion detector.
40. The robot arm system of claim 39, wherein the motion detector is one selected from the group consisting of a triaxial motion detector, a six-axis motion detector and a nine-axis motion detector.
41. The robot arm system of claim 39, wherein the motion parameter generated by the motion detector comprises representative information of individual axial components of the motion in the at least three axes.
42. The robot arm system of claim 39, wherein a series of motion parameter generated by the motion detector comprises representative information of motion direction and motion amount of a motion in the three-dimensional space in a time sequence.
43. The robot arm system of claim 39, wherein a series of motion parameter generated by the motion detector comprises representative information of positions in the three-dimensional space in a time sequence.
44. The robot arm system of claim 39, wherein the control device comprises a driving device for providing driving commands to the respective motion actuators of the multiaxial motion driving device based on the motion control command generated by the command interpreting circuit.
45. A method of controlling movement of the robot arm of the robot arm system using the motion detector of claim 39, comprising the steps of: generating a motion of the motion detector along a motion trajectory; the motion detector detecting the motion and generating a motion parameter representing the motion; the control device receiving the motion parameter and converting the motion parameter into a plurality of motion control commands for moving the arm segments of the robot arm; the control device providing the motion control commands to the respective motion actuators to drive the respective arm segments to move relatively to each other and/or to the base; wherein a series of motion control commands controls the motion actuators to jointly move the arm segments, such that a reference point on a free end of the second aim segment away from the base moves along a motion trajectory of the motion detector.
46. The method of claim 45, wherein the motion parameter comprises information representing axial components of the motion in at least three axes.
47. A method for controlling movement of the multiaxial motion driving device using the multiaxial motion control device of claim 24, comprising the steps of: generating a motion of the motion detector along a motion trajectory; the motion detector detecting the motion and generating motion parameters defining axial components of the motion in at least three axe; the control device of the multiaxial motion control device receiving the motion parameter and converting the motion parameter into a motion control command for the plurality of motion actuators of the multiaxial motion driving device; and the control device supplying the motion control command to the respective motion actuators, whereby a series of motion control commands controls the plurality of motion actuators, so that they together drive a reference point on the multiaxial motion driving device to move substantially along a motion trajectory of the motion detector.
48. The method of claim 47, wherein the motion parameter comprises information representing axial components of the motion in at least three axes.
49. The method of claim 47, wherein the motion parameter comprises information representing a motion trajectory of the motion in space.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0042]
[0043]
[0044]
[0045]
DETAILED DESCRIPTION OF THE INVENTION
[0046] Hereinafter, embodiments of the multiaxial motion control device and method of the present invention will be described by way of example with reference to the drawings. At first, a multiaxial motion control device according to the present invention, as well as a multiaxial motion control system including the invented control device and a multiaxial motion control method using the control device, will be described taking the robot arm system and the robot arm control device as an applicational example.
[0047]
[0048] The motion detector 10 shown in the figure is worn on the wrist of the user. However, in practical applications, the motion detector 10 may be held/attached to any movable object, such as the body, a limp, a finger etc. of a person or an animal. It may also be attached to a moving or marching object, such as a vehicle, an aircraft, a flying object etc. In the wearable application, the motion detector 10 may include a holding member, such as a ring like strap or a watch strap 11, while other forms of holding member, such as sticky tape, buckle, clip, chain, sucking cup, magnetic holder etc. are also applicable, as long as it can attach the motion detector 10 to the movable object, whereby moving along with the movements of the moveable object. The most easily conceivable application example is to form a motion detector 10 in the form of a wrest watch, worn on a user's wrist, or in the form of a ring, which is worn on a user's finger.
[0049] The robot arm system suitable for the present invention is configured to control the movement of its robot arm 20 so that a particular reference point (O) on the robot arm 20 is moved in response to the movement of the motion detector 10.
[0050] In the embodiment of
[0051] The robot arm 20 may additionally include a movable clamp 26. The movable clamp 26 is movably connected to the second arm segment 22 through a third joint. The two clamping pieces of the movable clamp 26 may also be provided with an actuator for clamping and releasing. However, the movable clamp 26 is not any focus of the present invention. Details thereof are thus omitted. In this example, the reference point O of the robot arm 20 is set at the joint of the two clamping pieces.
[0052] Although the robot arms 20 shown in
[0053] In addition,
[0054] The multi-joint robot arm as described above and its control method are well known in the art. The relative movement of the first arm segment 21 and the second arm segment 22 and of the first arm segment 21 and the base, for moving the reference point O to any point in the space within the reachable range of the robot arm 20, can be driven by a conventional controller that provides driving commands to the first motion actuator 27 and the second motion actuator 28. For details thereof, reference may be made to the relevant technical publications regarding the design and control of multi-joint robot arms.
[0055] Apart from the conventional art, the present invention provides a multiaxial motion control device and method for the purpose of making the reference point on the free end of the robot arm 20, i.e., the free end of the second arm segment 22, move following the motion of the motion detector 10, i.e., along a trajectory such as the trajectory of the reference point O, arrow B in
[0056]
[0057] The motion detector 10 in
[0058] The motion detection element 12 may be any type of motion detecting device, such as an accelerometer, a gyroscope, etc., but preferably has a multiaxial motion detection capability. In general, a triaxial accelerometer would be sufficient to provide all required functionalities in the present invention, while it is also possible to use, for example, a six-axis or nine-axis motion detecting device as the motion detection element 12 of the present invention. U.S. patent application Ser. No. 15/341,295 “Wrist Watch Embedded with a Wireless Control Module” provides a motion detection device that can detect the acceleration values in three directions, the angular velocity values in three directions, and the magnetic field values in three directions, all relating to a motion. The detector disclosed therein can be applied to the present invention. Other types or motion detecting devices of the same type or else are also applicable in the present invention.
[0059] As is known to those skilled in the art, a motion detecting device generally comprises a detector body that detects a motion and outputs its detection results from its electrodes and an arithmetic circuit that calculates the motion amount or motion components in specific directions using the detection results of the detector body. This arithmetic circuit can be realized by using a commercially available microprocessor circuit, supplemented by the necessary software. Related technologies are well known to those skilled in the art. The motion detection element 12 of the present invention may be provided with an arithmetic circuit (not shown) having a capacity for calculating a motion parameter, i.e., motion amount or motion components in particular directions, of a motion and directly outputting the resulted motion amount or motion components. In the preferred embodiments of the present invention, however, the detection results, i.e., the motion parameters, are the direct outputs of the electrodes of the motion detection element 12, with necessary preprocessing. As for the calculation of the motion amount or the motion components in a particular direction or a number of directions, and the subsequent processing, they are executed by the control device 30.
[0060] For this reason, the detection results of the motion detection element 12 is supplied directly to the control device 30 after necessary preprocessing such as A to D conversions. While the control device 30 is provided on the side of the robot arm 20, the detection results of the motion detection element 12 are first supplied to the wireless communication module 13 and then supplied to the control device 30 via a wireless communication channel. In this example, the wireless communication module 13 of the motion detector 10 is connected to the motion detection element 12 for receiving the detection results, i.e., the motion parameters, output from the motion detection element 12 and converting the motion parameters into a suitable format suitable for wireless transmission.
[0061] The wireless communication module 13 may comprise any commercially available wireless communication chip or circuit for establishing a communication channel with the control device 30 for exchange of data/information. In a preferred embodiment of the present invention, the wireless communication module 13 is configured to continuously transmit the detection results of the motion detector 10 at a predetermined transmission rate.
[0062] Depending on the type of the motion detection element 12, the content of the detection result, i.e., the motion parameter, is also different. In a preferred embodiment of the present invention, the motion detection element 12 is a nine-axis motion detecting device, such as the motion detector provided for the above-mentioned U.S. patent application Ser. No. 15/341,295. The motion detector includes a motion detecting device that can detect the acceleration values in three directions, the angular velocity values in three directions, and the magnetic field values in three directions, all pertaining to a motion. The detection results of this type of motion detecting device can be provided to an arithmetic circuit that converts the detection results into the absolute coordinates of the detector in space and outputs them as the motion parameters. The related operation method can be referred to the description of the patent specification, which is incorporated herein by reference. In such embodiments, the wireless communication module 13 simply continuously transmits the coordinate values of the calculation result to the control device 30.
[0063] However, in most applications of the present invention, it is not necessary to use such a precision motion detecting device. In general, a detector that can provide motion components of a motion in at least three directions, so to provide the amount of motion per detection/sampling/transmission cycle, would suffice. In such an embodiment, the motion detection element 12 may also include an arithmetic circuit for converting the signals output by the electrodes of the motion detection element 12 into motion components in three predetermined directions and supplying them to the wireless communication module 13. The motion detection element 12 may not include an arithmetic circuit. In this case, the motion detection element 12 directly supplies its detection results to the control device 30, and the desired results are calculated by an arithmetic circuit (not shown) provided on the side of the control device 30.
[0064] It is well known to those skilled in the art that the motion detection element 12 does not actually need to provide three sets of motion parameters when providing motion components of the at least three directions, for example, when providing motion components in three directions. For example, a two-axis accelerometer can only produce two sets of motion parameters representing the amount of motion in two directions. However, after conversion, the motion components in three directions can still be provided. This conversion technique is already a known technique. Details thereof are thus omitted.
[0065] As described above, in such embodiments, the motion detection element 12 may also include an arithmetic circuit for converting the detector electrode output values into motion components in three predetermined directions and providing them to the control device 30. Of course, it is also possible to provide only two sets of motion parameters to the control device 30, and the desired results are calculated by the command interpreting circuit 33 provided on the side of the control device 30.
[0066] Since the motion detector 10 is generally in the form of a wearable device and is attached to a movable object, it moves with the object. The motion detector 10 is preferably provided with a power supply 14 for supplying power to the motion detection element 12 (and the wireless communication module 13). The power supply 14 is preferably equipped with a chargeable battery and a necessary power management circuit, i.e., no external power supply is required when used. In a general application, the power supply 14 includes a battery and a power saving circuit (both not shown). The battery can store a considerable charge and be charged with, for example, a wireless charging technique. The power saving circuit controls the power supply of the battery and stops the battery power supply when no use is necessary. The power saving circuit may also control the wireless communication module 13 for its periodical transmission of the motion parameters. In a particular example, the power saving circuit may still receive an external wake-up signal to start the power supply of the battery. The structure, control, application and other details of the power supply 14 described above are all of the known technique. Details thereof are thus omitted.
[0067] The housing 15 of the motion detector 10 may be connected to a holding member 11, such as a watch strap or other forms of ring, belt, buckle, suction cup, magnetic holder etc., to be worn on a movable object such that the motion detector 10 moves with the movement of the object. In a preferred embodiment of the present invention, the motion detector 10 may be worn on the wrist or finger of a human arm and moves following a movement of the wrist or finger.
[0068] The function of the control device 30 is to receive the detection results of the motion detector 10 and to generate and output, based on the detection results, motion control commands for controlling the robot arm. If the control device 30 is provided on the side of the robot arm 20, the control device 30 is provided with a wireless receiving function for receiving the motion parameters provided by the motion detector 10. As shown in
[0069] In order to convert the detection parameter of the motion detector 10 into a motion control command of the robot arm, the control device 30 includes a command interpreting circuit 33 for converting the detection results, i.e., motion parameters of the motion detector 10 into a control command for controlling the motion of the plurality of arm segments of the robot arm 20. The control device 30 also includes a driving device 34 coupled to the command interpreting circuit 33 for driving the motion actuators 27, 28 of the arm segments 21, 22 of the robot arm 20 in accordance with the motion control commands generated by the command interpreting circuit 33.
[0070] As described above, in most embodiments of the present invention, the motion detector 30 produces motion parameters sufficient to represent the respective motion components in at least three axes of a motion. In addition, in application, the motion detector 30 generates the motion parameters successively, i.e., in a sequence along the time axis. Thus, a series of the motion parameters will include data representing the motion direction and motion amount of the motion detector 10 in the three-dimensional space at successive times; the series of motion parameters in combination will form a trajectory of the motion of the motion detector 10 in the space. In a particular example of the invention, the motion parameter is essentially the position or coordinates of the motion detector 10 in the space at successive points in time, and a motion trajectory will also be formed by the combination of the successive positions or coordinates.
[0071] If the motion parameter provided by the motion detector 10 is the direct detection result of the motion detection element 12, the command interpreting circuit 33 may be configured to convert the motion parameter into a motion defined by: a rotation angle θ of the first arm segment 21 in the base plane, i.e., an angle in the circle indicated by the double arrow Y in
[0072] It is already well known in the art how the detection results of the motion detection element 12 may be converted into a motion defined by a rectangular coordinate system or an axis coordinate system. The above-described various techniques for recognizing a position or motion by the optical image recognition technique, in order to control the movement of a robot arm can be applied to the present invention with necessarily minor modifications. Although in the example of
[0073] On the other hand, if the motion parameters provided by the motion detector 10 are data representing the triaxial motion components of a motion or other position change descriptions, the command interpreting circuit 33 should be configured to convert the motion components or position change information into a motion defined by a rotation angle θ of the first arm segment 21 and a pitch angle Δ of the second arm segment 22. The command interpreting circuit 33 may be further configured to generate motion control commands for the proper realization of the motion by the first motion actuator 27 and the second motion actuator 28 accordingly.
[0074] In a preferred embodiment of the present invention, the motion detector 10 generates the motion parameter successively, whereby a series of motion control commands generated by the control device 30 in response to the successive motion parameters controls the relative movement of the arm segments 21, 22 of the robot arm 20, such that the movement of the reference point O of the second arm segment 22 in space follows the motion trajectory of the motion detector 10. The robot arm 20, which is controlled in this manner, thus can simulate the movement of the movable object, for example, to mimic the human actions. Such a control method is quite worthwhile, because the user does not need to learn to familiarize himself with the control method. Such approach has a strong demand in the industry, yet there is no technology to achieve this purpose.
[0075] The command interpreting circuit 33 may be configured to successively generate the motion control commands and supply them to the driving device 34, whereby the driving device 34 generates corresponding drive commands and provide them via the signal line and/or power line 31 to the first motion actuator 27 and the second motion actuator 28, so they operate to drive the first arm segment 21 and the second arm segment 22 to move.
[0076]
[0077] The present invention provides a method for controlling the movement of a multiaxial motion driving device using the multiaxial motion control device of the invention. In the followings, a method for controlling the movement of the robot arm in a robot arm system using the multiaxial motion control device of the present invention will be described, serving as an example to illustrate the invented method.
[0078] In the preferred embodiments of the present invention, the motion actuators may cause hysteresis or pause when driven by the driving device. In order to smooth the movement of the robot arm 20 and to follow the motion detector 10 closely, necessary corrections or calibrations can be made by using the power control method of the conventional technique.
[0079] As described above, the multiaxial motion control device and method of the present invention can be applied to other types of multiaxial motion driving devices in addition to the robot arm. It will also be apparent from the above description of the application example of the robot arm system that the multiaxial motion detector used in the present invention provides other detection functions, in addition to simply achieving accurate detection results. For example, when applied to an AGV, the vehicle can only move on a plane or a substantial plane and cannot move vertically. However, the remaining direction of motion detectable by the multiaxial motion detector can be used to generate other motion commands or non-motion commands. For example, the user can move the motion detector upwardly to produce an “accelerate” command, and downward to produce a “decelerate” command. Other commands possibly generated including a “stop/start walking” command by turning the motion detector upside down, a “right turn” or “left turn” command by flipping the motion detector clockwise or counterclockwise, or other commands such as generating sound, light by swinging the motion detector up and down or left and right.
[0080] The multiaxial motion control device and method of the present invention can control a remote-control vehicle carried by a fluid, such as helicopter or submarine, using the control method as described above. By using the invented motion control device and method, the helicopter or submarine, or the like, moves in the three-dimensional space following the movement of the motion detector. The multiaxial motion control device and method of the present invention can also control an electric pet, such as an electric toy dog, to travel on a plane in a manner similar to the control method of the aforementioned AGV. In addition, the invented multiaxial motion driving device can generate additional commands, such as jump, rise, squat and other action commands. The multiaxial motion detector detects a motion operation that is independent of the motion command and is defined, for example, as an action command such as a command for making a sound, wagging, mouth opening and closing, eye opening and closing etc. All these applications can be realized by the appropriate settings in the command interpreting circuit 33.
[0081] It is also known from the above disclosure that in the present invention, the axes or axial components of a motion or the number of the axes or axial components detectable by the motion detector does not need to correspond to the motion driving axes or axial components, and numbers thereof, of the multiaxial motion driving device. In addition, the multiaxial motion driving device may also provide a motion drive capability independent of the motion of the device itself and may generate actions in response to the motion operation of the user.
[0082] Although the multiaxial motion driving device and method of the present invention, have been described with reference to specific embodiments regarding the robot arm system, this description is not meant to be construed in a limiting sense. Various modifications of the disclosed embodiments, as well as alternative embodiments, will be apparent to persons skilled in the art. It is, therefore, contemplated that the appended claims will cover all modifications that fall within the true scope of the invention.