Passive six-axis parallel feedback control machine with compensation function and its compensation method

By using passive linear elastic elements and linear sensors in a passive six-axis parallel robot, and combining them with a controller to calculate equivalent force and displacement, the problem of passive robots being unable to measure external force and displacement during assembly processes is solved. This achieves adaptive motion and path compensation, improving practicality.

CN123103581APending Publication Date: 2026-11-17DELTA ELECTRONICS INC(CN)
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202510623484.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-05-15
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Passive six-axis parallel robots cannot independently measure external forces and displacements during assembly processes, leading to damage to the assembled objects and an inability to perform compliant movements to avoid collisions or interference.

Method used

By combining passive linear elastic elements with linear sensors, and using a controller to calculate the equivalent force, equivalent torque, and displacement, compensation for external forces can be achieved.

Benefits of technology

This enhances the practicality of passive robots in assembly processes, enabling them to measure external forces and displacement, and avoid damage through path compensation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123103581A_ABST
    Figure CN123103581A_ABST
Patent Text Reader

Abstract

A six-axis parallel feedback control robot includes a mobile platform, a base platform, a controller, and six linear elastic elements connected between the mobile platform and the base platform via multiple joints. The mobile platform has an initial pose determined by the free lengths of the six linear elastic elements. The controller performs the following actions: calculating the compression of each linear elastic element and the corresponding support force when the mobile platform receives an external force; calculating the forward kinematics based on the compression to obtain the current pose of the mobile platform; calculating the equivalent force and equivalent moment of the mobile platform relative to the external force based on the current pose and the support forces of each linear elastic element; comparing the current pose with the initial pose to calculate the displacement of the mobile platform; and generating path compensation for the transfer platform cooperating with the six-axis parallel robot based on the equivalent force, equivalent moment, and displacement.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to a six-axis parallel feedback control machine, and more particularly to a passive six-axis parallel feedback control machine, and a compensation method used in the passive six-axis parallel feedback control machine. Background Technology

[0002] In the assembly process of automated production lines, six-axis (or six degrees of freedom) parallel robots are often used to assist in assembly. These robots generally include active robots and passive devices (also known as feedback control machines).

[0003] Active robots, equipped with active motors, can provide active compensation, and are therefore more commonly used in assembly processes compared to passive devices. Passive devices can only compensate passively upon contact, and they generally cannot measure external forces or the displacement of moving platforms, thus they are less commonly used in assembly processes.

[0004] However, due to their high rigidity, active robots cannot independently perform compliant motion when subjected to external forces. During assembly processes (such as parts assembly), collisions or interferences are inevitable. If the robot cannot provide timely compliant force feedback when collisions or interferences occur, the assembled part and the workpiece to be assembled will collide directly, causing damage to the assembled part. Therefore, there is a real need in the market to improve passive devices, enabling them to achieve both low cost and compliant motion, while also allowing for force and displacement measurement, thereby enhancing the practicality of passive robots in assembly processes. Summary of the Invention

[0005] This application discloses a passive six-axis parallel feedback control machine with compensation function and its compensation method. Under the premise that the passive feedback control machine itself has supporting force and can perform compliant motion, the passive robot can also realize the measurement of equivalent force / equivalent torque and displacement of the moving platform, and control compensation can be performed based on the measurement results.

[0006] In one embodiment, the passive six-axis parallel robot of this application includes:

[0007] A mobile platform having a first surface;

[0008] A base platform having a second surface;

[0009] Multiple first joint elements are respectively disposed on the first surface;

[0010] Multiple second joint elements are respectively disposed on the second surface;

[0011] Six passive linear elastic elements are respectively disposed between the moving platform and the base platform via the plurality of first joint elements and the plurality of second joint elements. Each passive linear elastic element has a passive elastic element and a linear sensor. Each passive elastic element has a free length, and the moving platform has an initial pose determined by the free length of each passive elastic element.

[0012] A controller is connected to the six passive linear elastic elements and performs the following actions:

[0013] Action a) When the mobile platform receives an external force, receive the compression amount of each passive elastic element measured by each of the linear sensors, and calculate a supporting force of each passive elastic element relative to the external force based on the compression amount;

[0014] Action b) Calculate a positive kinematics based on the compression of each passive elastic element to obtain the current pose of the mobile platform;

[0015] Action c) Calculate the first-order force and first-order force moment of the moving platform relative to the external force based on the current pose and the supporting force of each of the passive elastic elements;

[0016] Action d) Compare the initial pose and the current pose of the mobile platform to obtain a displacement; and

[0017] Action e) Based on the effectiveness, the effectiveness moment, and the displacement, a path compensation amount is generated for a transfer platform that cooperates with the passive six-axis parallel feedback control machine.

[0018] In one embodiment, the compensation method of this application is applied to the above-mentioned passive six-axis parallel feedback control machine, and includes the following steps:

[0019] Step a) When the mobile platform receives an external force, each of the linear sensors measures the compression of each passive elastic element, and the controller calculates the supporting force of each passive elastic element relative to the external force based on the compression.

[0020] Step b) The controller calculates a positive kinematics based on the compression of each of the passive elastic elements to obtain a current pose of the mobile platform;

[0021] Step c) The controller calculates the first-order force and first-order force moment of the moving platform relative to the external force based on the current pose and the support force of each of the passive elastic elements;

[0022] Step d) The controller compares the initial pose and the current pose of the mobile platform to obtain a displacement; and

[0023] Step e) The controller generates a path compensation amount required by a transfer platform to cooperate with the passive six-axis parallel feedback control machine based on the equivalent power, the equivalent power torque and the displacement.

[0024] Compared to existing technologies, the passive feedback control machine of this application, in addition to providing support and enabling compliant movement, can also measure the equivalent force / equivalent torque of external forces and the displacement of the moving platform caused by external forces, and perform compensation based on the measurement results. This improves the practicality of the passive feedback control machine in assembly processes. Attached Figure Description

[0025] Figure 1 This is an embodiment of the feedback control machine of this application;

[0026] Figure 2 This is a block diagram embodiment of the passive linear elastic element of this application;

[0027] Figure 3 This is an embodiment of the compensation architecture of this application;

[0028] Figure 4 This is an embodiment of the compensation flowchart of this application;

[0029] Figure 5 This is an embodiment of the external force calculation diagram of this application;

[0030] Figure 6 This is an embodiment of a schematic diagram illustrating the forward kinematics calculation of this application;

[0031] Figure 7 This is an example illustrating the measurement results of this application.

[0032] Explanation of icon numbers

[0033] 1: Feedback control machine

[0034] 2: Mobile Platform

[0035] 21: First Surface

[0036] 3: Base Platform

[0037] 31: Second Surface

[0038] 41: First joint element

[0039] 42: Second joint element

[0040] 5: Passive linear elastic element

[0041] 51: Linear Sensor

[0042] 52: Passive elastic element

[0043] 6: Controller

[0044] 7: Transfer Platform

[0045] 71: Host Controller

[0046] 72: Robotic Arm

[0047] S40~S50: Measurement Procedures

[0048] B1~B6: The coordinate positions of the first joint represented by the base platform coordinate system.

[0049] T1~T6: The coordinate positions of the second joint represented by the base platform coordinate system.

[0050] ra: First distance

[0051] rb: Second distance

[0052] α: First included angle

[0053] β: Second included angle

[0054] Current position

[0055] Target linear displacement

[0056] Current linear displacement

[0057] Linear displacement velocity array of passive linear elastic element

[0058] The second linear displacement velocity array at the center point of the moving platform

[0059] C1: First Request Command

[0060] C2: Second Request Command Detailed Implementation

[0061] This application discloses a passive six-axis parallel feedback control machine with compensation function (hereinafter referred to as the feedback control machine). The difference from an active six-axis parallel robot is that the feedback control machine of this application modifies the active actuator into a passive linear elastic element, allowing the passive linear elastic element to yield and achieve compliant motion when subjected to external forces. During compliant motion, the feedback control machine can also calculate the equivalent force / equivalent torque of the moving platform relative to the external force based on the length change of the passive linear elastic element, and calculate the displacement of the moving platform caused by the external force. Therefore, the feedback control machine of this application can have the measurement functions of a six-axis force gauge and a displacement / attitude meter.

[0062] Furthermore, this application can also request a transfer platform, which works in conjunction with the feedback control machine, to compensate for external forces on the feedback control machine based on the calculated equivalent force / equivalent moment and displacement. Thus, the transfer platform can keep the center point of the moving platform on the feedback control machine in its initial pose, unaffected by external forces.

[0063] Six-axis generally refers to a machine that achieves operation in six degrees of freedom (DoF) through the coordinated movement of six drive elements (six passive linear elastic elements in this application). Therefore, the six-axis parallel feedback control machine of this application can also be called a six-DOF parallel feedback control machine. The purpose of this application is to allow the feedback control machine itself to support the moving platform, and through its passive characteristics, enable the moving platform to avoid external force interference and achieve compliant motion. Furthermore, the feedback control machine of this application can measure the length change (i.e., displacement change) of each foot (i.e., each passive linear elastic element), thereby calculating the equivalent force and equivalent torque relative to the external force, and thus compensating for the external force.

[0064] Please see Figure 1 This is an embodiment of the feedback control machine of this application. Figure 1 A schematic diagram illustrating the structure of the feedback control machine 1 of this application is shown. Figure 1As shown, the feedback control machine 1 of this application includes at least a moving platform 2, a base platform 3, a plurality of first joint elements 41, a plurality of second joint elements 42, and six passive linear elastic elements 5. The moving platform 2 is disposed relative to the base platform 3. The moving platform 2 has a first surface 21 in the direction toward the base platform 3, and the base platform 3 has a second surface 31 in the direction toward the moving platform 2. The number of the plurality of first joint elements 41 is six, and they are respectively disposed on the first surface 21 of the moving platform 2. The number of the plurality of second joint elements 42 is six, and they are respectively disposed on the first surface 21 of the base platform 3. In one embodiment, the plurality of first joint elements 41 and the plurality of second joint elements 42 are universal joints or ball joints.

[0065] The passive linear elastic element 5 is elongated. One end of each of the six passive linear elastic elements 5 is connected to a first joint element 41, and the other end is connected to a second joint element 42. Thus, the six passive linear elastic elements 5 are respectively arranged between the moving platform 2 and the base platform 3 through the six first joint elements 41 and the six second joint elements 42, and with the base platform 3 as the base, they support the moving platform 2 in the same direction.

[0066] In one embodiment, the base platform 3 is positioned in a relatively stable location (e.g., fixed to the ground, other supporting structures, or the end effector of a robotic arm in a transfer platform). The moving platform 2 is a movable component on the feedback control machine 1, for example, it can be used to mount an end effector. When the feedback control machine 1 performs a contact-type assembly process, the moving platform 2 may be subjected to external forces. As mentioned above, the feedback control machine of this application uses a passive linear elastic element 5, so when the moving platform 2 is subjected to external forces, the passive linear elastic element 5 is pushed and compressed by the external forces, thereby achieving compliant movement of the feedback control machine 1. Furthermore, this application uses a controller (such as...) Figure 2 The controller 6 shown calculates the equivalent force / equivalent torque of the external force received by the moving platform 2, as well as the displacement of the moving platform 2 caused by the external force, through an algorithm when the passive linear elastic element 5 is compressed. Based on the calculation results, the controller 6 can request the transfer platform and / or robotic arm corresponding to the feedback control machine 1 to compensate for the external force.

[0067] In one embodiment, the end effector of the robotic arm is equipped with a base platform 3 of a feedback control machine 1, and the tools required for the assembly process are installed via a moving platform 2 of the feedback control machine 1. During the assembly process, the robotic arm moves the feedback control machine 1 based on a preset movement path, using the moving platform 2 (and the tools thereon) on the feedback control machine 1 for assembly and to withstand external forces. When the external force causes displacement of the moving platform 2 on the feedback control machine 1, the robotic arm modifies its path based on this displacement to compensate for the external force (described in detail later).

[0068] Please also refer to Figure 2 This is a block diagram embodiment of the passive linear elastic element of this application. Figure 2 As shown, each passive linear elastic element 5 in this application has a linear sensor 51 and a passive elastic element 52. The passive elastic element 52 can be, for example, a spring. The linear sensor 51 is, for example, an optical ruler or a laser rangefinder, used to measure the length change of the passive elastic element 52. The two ends of the passive elastic element 52 are respectively connected to a first joint element 41 and a second joint element 42 at the two ends of the passive linear elastic element 5. In this application, each passive linear elastic element 52 has a free length determined after manufacturing (i.e., the length of the passive elastic element 52 when it is not subjected to any external force). The moving platform 2 is supported by six passive linear elastic elements 5 and has an initial pose determined by the free lengths of the six passive linear elastic elements 5. This initial pose is determined after the feedback control machine 1 is assembled and will not change.

[0069] When the length of any passive elastic element 52 changes (e.g., due to external force or elastic fatigue from long-term use), the positions (i.e., coordinates in the Caliber coordinate system) of each first joint element 41 and / or second joint element 42 also change accordingly. At this time, the moving platform 2 will leave the initial pose (i.e., the center point will shift). A key feature of this application is that each linear sensor 51 can sense the change in length of the corresponding passive elastic element 52, and the controller 6 can then request compensation from the transfer platform. This ensures that the center point of the moving platform 2 remains in the initial pose at all times. When the external force disappears, the moving platform 2 will be pushed back to the initial pose based on the inertia of each passive elastic element 52. At this time, the controller 6 can cancel the compensation request.

[0070] As described above, after the feedback control machine 1 is assembled, each passive linear elastic element 5 provides a corresponding supporting force to the mobile platform 2 to support the mobile platform 2 in the initial pose. In one embodiment, when the mobile platform 2 is in the initial pose, the center point of the mobile platform 2 can be regarded as the exact center of the feedback control machine 1. That is, when the center point deviates from the exact center of the feedback control machine 1, it is considered that the mobile platform 2 has left the initial pose.

[0071] In one embodiment, when the mobile platform 2 receives the external force, the feedback control machine 1, controlled by the controller 6, performs the analysis and calculation of the external force as described in the following paragraphs. It is worth noting that the feedback control machine 1 in this application uses a passive linear elastic element 5, while neither the linear sensor 51 nor the passive elastic element 52 has active control functionality. After analyzing and calculating the external force, the controller 6 cannot compensate for the external force by controlling the passive linear elastic element 5. Instead, when the feedback control machine 1 is configured to operate together with the transfer platform, the controller 6 can send a request to the transfer platform based on the analysis and calculation results, so that the transfer platform can compensate for the external force.

[0072] Please see Figure 3 This is a schematic diagram of an embodiment of the compensation architecture of this application. Figure 3 As shown, the transfer platform 7 of this application includes a host controller 71 and a robotic arm 72. The host controller 71 is connected to the controller 6 of the feedback control machine 1 to receive requests issued by the controller 6, and the host controller 71 is connected to the robotic arm 72 to generate or adjust motion commands based on the requests, and control the operation of the robotic arm 72 with the motion commands. In one embodiment, the feedback control machine 1 is disposed at the end of the robotic arm 72 via a base platform 3, thereby allowing the robotic arm 72 to control the feedback control machine 1 to perform the assembly process.

[0073] In this application, the feedback control machine 1 measures the length change of each passive linear elastic element 52 through the linear sensors 51 of each passive linear elastic element 5. The controller 6 is connected to the six passive linear elastic elements 5, receives the length changes from the six passive linear elastic elements 5, and calculates the corresponding path compensation amount. The host controller 71 of the transfer platform 7 receives this path compensation amount and adjusts the motion command used to control the movement of the robotic arm 72 according to this path compensation amount. Finally, it controls the movement of the robotic arm 72 according to this motion command to perform the assembly process. Since the feedback control machine 1 is located at the end of the robotic arm, when the robotic arm moves based on the adjusted motion command, the moving platform 2 of the feedback control machine 1 can maintain its initial pose (i.e., the center point remains in the exact center).

[0074] Please refer to the following as well. Figure 4This is an embodiment of the compensation flowchart of this application. As mentioned above, after the feedback control machine 1 is assembled, the mobile platform 2 will be in its initial pose based on the free length of the passive elastic element 52 among the six passive linear elastic elements 5. Therefore, unlike active robots, the feedback control machine of this application does not require setting the initial pose of the mobile platform 2 through a human-machine interface.

[0075] In this application, the feedback control machine 1 receives external force through the moving platform 2 (step S40), at which time each passive linear elastic element 5 is pushed by the external force and performs compliant movement (step S41). When each passive linear elastic element 5 is pushed by the external force, each passive elastic element 52 is compressed, and each linear sensor 51 measures the compression amount of each passive elastic element 52 (step S42). The controller 6 obtains the compression amount of each passive elastic element 52 from each linear sensor 51, and calculates the supporting force of each passive elastic element 52 relative to the external force based on the compression amount (step S43).

[0076] In one embodiment, each passive elastic element 52 has a stiffness coefficient, and the controller 6 records the initial free length and stiffness coefficient of each passive elastic element 52. In step S42, the controller 6 receives the current length of each passive elastic element 52 measured by each linear sensor 51, calculates the difference between the current length and the free length of each passive elastic element 52, and obtains the compression amount of each passive elastic element 52. In step S43, the controller 6 calculates the supporting force of each passive elastic element 52 based on Hooke's law, according to the compression amount and stiffness coefficient of each passive elastic element 52.

[0077] It is worth mentioning that each passive elastic element 52 may experience elastic fatigue due to long-term use. In this case, even without external force, the length of each passive elastic element 52 may still differ from its initial free length. In this situation, each linear sensor 51 can still measure the length difference of each passive elastic element 52, and the controller 6 can still calculate the compression and support force of each passive elastic element 52, but this compression and support force corresponds to elastic fatigue (because there is no external force interference).

[0078] On the other hand, after receiving an external force, the mobile platform 2 will be pushed away from its initial pose. At this time, the controller 6 can calculate the forward kinematics based on the compression of each passive elastic element 52 to obtain the current pose of the mobile platform 2 after being pushed (step S44). After step S44, the controller 6 obtains the current length and support force of each passive elastic element 52, as well as the current pose of the mobile platform 2. Next, the controller 6 uses an algorithm to calculate the equivalent force and equivalent moment of the mobile platform 2 relative to the external force based on the current pose of the mobile platform 2 and the support force of each passive elastic element 52 (step S45). At the same time, the controller 6 calculates the displacement of the mobile platform 2 caused by the external force using the initial pose and current pose of the mobile platform 2 (step S46). Finally, the controller 6 generates the path compensation amount required for the transfer platform 7 to cooperate with the feedback control machine 1 based on the equivalent force, equivalent moment, and displacement (step S47).

[0079] Please also refer to Figure 5 This is an embodiment of the external force calculation diagram of this application. The following is in conjunction with... Figure 5 This paper explains how the controller 6 of this application calculates the equivalent force and equivalent moment in step S45.

[0080] In this application, in order to calculate the equivalent force and equivalent torque, the controller 6 must calculate the inverse kinematics, and in order to calculate the inverse kinematics, the structure of the feedback control machine 1 must first be defined. For example... Figure 5 As shown, this definition includes the initial pose of the mobile platform 2 based on the base platform coordinate system used by the base platform (i.e., the pose determined based on the free lengths of the six passive linear elastic elements 5), and the first distance r between the center point of the mobile platform 2 and each of the first joint elements 41. a The second distance r between the center point of the base platform 3 and each of the second joint elements 42 b A first included angle α represents half the value of the included angle between two relatively close first joint elements 41 on the mobile platform 2, and a second included angle β represents half the value of the included angle between two relatively close second joint elements 42 on the base platform 3.

[0081] Based on inverse kinematics, controller 6 determines the second distance r. b The second coordinate positions B1 to B6 of each second joint element 42 in the base platform coordinate system are calculated using the second included angle β, and the calculation formula is as follows:

[0082] B1 = [r] b cos(β),r b sin(β), 0];

[0083] B2 = [r b cos(-β),r b sin(-β), 0];

[0084]

[0085] Next, controller 6 determines the distance based on the first distance r. a The first coordinate positions T1 to T6 of each first joint element 41 in the base platform coordinate system are calculated using the first included angle α. It should be noted that the calculated first coordinate positions T1 to T6 have not undergone a coordinate transformation process and therefore are not the actual positions of each first joint element 41. The formulas for calculating the first coordinate positions T1 to T6 are as follows:

[0086]

[0087] T3 = [r a cos(-π+α),r a sin(-π+α),0];

[0088] T4 = [r a cos(-π-α),r a sin(-π-α),0];

[0089]

[0090] Next, based on the initial pose of the mobile platform 2 relative to the base platform coordinate system, the controller 6 sequentially performs coordinate transformation matrix multiplication on the first coordinate positions T1 to T6 of each first joint element 41, and takes the Euclidean distance between the transformed coordinate positions of each first joint element 41 and the corresponding second joint element 42 to obtain the length of each passive linear elastic element 5 (i.e., the current length of each passive elastic element 52). The specific formula is described as follows:

[0091] for i = 0 to 5 do:

[0092]

[0093] Among them, H 4x4 The target pose is [XYZABC]. T The homogeneous transformation matrix, T[i] represents the first coordinate position of each first joint element 41 in the base platform coordinate system, l leg The lengths of each passive linear elastic element 5 are given. It is the set of lengths of the six passive linear elastic elements 5.

[0094] Having explained the definitions of feedback control machine 1 and inverse kinematics, the following describes how controller 6 calculates the equivalent force and equivalent torque of the external force. Specifically, when the moving platform 2 receives an external force, controller 6 obtains the linear thrust vector matrix of each passive elastic element 52 from each linear sensor 51 of each passive linear elastic element 5. This thrust vector matrix can be calculated based on the length change of each passive elastic element 52. Specifically, to resist the external force, the passive elastic element 52 will provide a corresponding thrust towards the moving platform 3, and this thrust will cause a change in length, so controller 6 can calculate the linear thrust vector matrix.

[0095] Next, the controller 6 calculates the first coordinate position T of each first joint element 41 in the base platform coordinate system used by the base platform 3 using the aforementioned inverse kinematics. i and the second coordinate position B of each second joint element 42 expressed in the base platform coordinate system. i The base platform 3 is positioned in a relatively stable location (e.g., fixed to the ground or located at the end of the robotic arm 72), therefore the second coordinate position B of each second joint element 42 is... i It can be considered fixed; in contrast, the first coordinate position T of each first joint element 41 i It will change its current position after the mobile platform 2 receives an external force.

[0096] In one embodiment, the initial coordinate position T of each first joint element 41 i,init It can be represented as follows:

[0097]

[0098] T 3,init =[r a cos(-π+α),r a sin(-π+α),0];

[0099] T 4,init =[r a cos(-π-α),r a sin(-π-α),0];

[0100]

[0101] Among them, the controller 6 sets the initial coordinate position T of each first joint element 41 i,init Multiply by the homogeneous transformation matrix of the current pose of the mobile platform 2 to obtain the first coordinate position T of each first joint element 41. i That is: Ti =H 4x4 ·T i,init H 4x4 Let be the homogeneous transformation matrix of the current pose of mobile platform 2.

[0102] Next, controller 6, based on these first coordinate positions T i and these second coordinate positions B i Calculate the Euclidean distance between the lines connecting each second joint element 42 and its corresponding first joint element 41.

[0103] Leave And based on these Euclidean distances Calculate the unit vector of the line connecting each second joint element 42 to its corresponding first joint element 41. Next, the controller 6, based on the linear thrust vector f of each passive linear elastic element 5, i and the unit vector Calculate the equivalent force F of the mobile platform 2 relative to the external force it receives.

[0104] On the other hand, the controller 6 further calculates the line vector connecting the center position of the base platform 3 to each of the second joint elements 42, as the lever arm required for calculating the torque. And based on the lever arm And the equivalent moment T of the mobile platform 2 relative to the external force is calculated using the equivalent force F.

[0105] In one embodiment, the controller 6 can calculate the unit vector, equivalent force, and equivalent moment according to the following first to third formulas:

[0106]

[0107] The formula described above, where The unit vector is the line connecting each second joint element 42 to its corresponding first joint element 41. F is the Euclidean distance between the lines connecting each second joint element 42 and its corresponding first joint element 41, where F is the equivalent force. i Here, T represents the linear thrust vector matrix of each passive linear elastic element 5, and T is the equivalent torque. The vector (i.e., lever arm) connecting the center position of the base platform 3 to each of the second joint elements 42.

[0108] Using the above formula, the controller 6, after obtaining the supporting force of each passive linear elastic element 5 and the current pose of the moving platform 2, can... Figure 4 In step S45 shown, the equivalent force and equivalent moment of the moving platform 2 relative to the external force are calculated.

[0109] Please refer to the following for further details. Figure 6 This is an embodiment of the forward kinematics calculation schematic diagram of this application. As mentioned above, this application measures the length change of each passive elastic element 52 by each linear sensor 51 when the mobile platform 2 is pushed by an external force, and... Figure 4 In step S44, the controller 6 calculates the current pose of the mobile platform 2 after receiving external force through positive kinematics calculation.

[0110] like Figure 6 As shown, when the controller 6 performs forward kinematics, it calculates iteratively until the target result converges, and then outputs the final pose. The input to the iterative calculation is the current length of the six passive linear elastic elements 5, and the output is the current pose of the mobile platform 2. More specifically, the iterative calculation in this application is a virtual movement process in which the six passive linear elastic elements 5 gradually move from their initial free length (i.e., the free length before receiving an external force) to their length after receiving an external force. During this virtual movement, the Jacobian matrix is ​​calculated based on the speed of movement (i.e., the change in length) to obtain a small change in position. The estimated pose of the mobile platform 2 is adjusted based on this small change in position, and then feedback is performed. Finally, the iterative calculation ends and the final estimated pose of the mobile platform 2 is output when the entire result converges. Because the length of the six passive linear elastic elements 5 gets closer and closer to the target length after receiving an external force during the feedback process, the final output estimated pose can be close to or equal to the true pose of the mobile platform 2 after receiving an external force.

[0111] First, controller 6 calculates and obtains the current pose of the moving platform 2. And based on the current pose Perform inverse kinematics calculations to obtain the current length of each passive elastic element 52. The method for calculating inverse kinematics is as described above and will not be repeated here.

[0112] Next, the controller 6 calculates the current length of each passive elastic element 52. And the target length caused by external forces Length error value And based on this length error value The time constant (time_coefficient) of the iterative algorithm is used to calculate the linear displacement velocity array required for each passive linear elastic element 5. Next, controller 6 uses the current pose of mobile platform 2. Calculate the Jacobian matrix and use it to represent the linear displacement-velocity array. The second linear displacement velocity array required to convert to the center point of the mobile platform 2

[0113] Furthermore, the controller 6 will input the second linear displacement velocity array required for the center point of the moving platform 2. Add the current pose of the center point of mobile platform 2 during the iteration process To generate the updated current pose during the iteration process (i.e., ).in, Figure 6 As shown That is, to execute and In other words, the equation will eventually become Figure 6 The physical phenomena shown are calculated to represent Therefore, the attitude change of feedback control machine 1 during the iteration process can be obtained.

[0114] During the iteration process, controller 6 further adjusts the current pose based on the updated settings. The inverse kinematics calculation is performed to update the current length of each passive elastic element 52 during the iteration process. Furthermore, the controller 6 repeats the above actions to perform iterative update calculations until the length error values ​​of each passive elastic element 52 converge. up to the preset accuracy criteria accuracy The iteration calculation ends here. At the end of the iteration calculation, controller 6 outputs the current pose after the last update. This is taken as the current pose of the mobile platform 2 (i.e., the estimated pose).

[0115] Specifically, the calculation steps for the above-mentioned positive kinematics can be represented by the following pseudo code:

[0116]

[0117] As shown in the above code, this application iteratively calculates the current length of each passive linear elastic element 5.

[0118] Spend Up to the current length Target length caused by external forces Error value between lengths leg Less than the preset accuracy value criteria accuracy At this point, convergence is considered complete. Furthermore, controller 6 calculates the current pose based on the last update calculated before convergence. To serve as the estimated pose of the mobile platform 2 after receiving external forces. (That is, the current pose of the final output).

[0119] In one embodiment, the controller 6 determines the position of the mobile platform 2 based on the following steps. To generate the Jacobian matrix.

[0120] In this application, the Jacobian matrix is ​​defined as [XYZABC]. T As a 6x6 matrix arranged as first-order partial derivatives. Assuming J is a Jacobian matrix, then we can define... in The linear velocity Cassette coordinate system represents the mobile platform 2 (end effector); This represents the linear velocity of each passive linear elastic element 5. In the Jacobian matrix, X, Y, and Z represent the positions of the endpoints of the mobile platform 2 in the Calibre coordinate system, including X along the X-axis, Y along the Y-axis, and Z along the Z-axis; A, B, and C represent the orientation of the endpoints of the mobile platform 2, for example, A, B, and C represent roll, pitch, and yaw in Euler angles, respectively. T represents transpose.

[0121] First, the controller 6 inputs the current pose of the mobile platform 2. And input a preset small gain change (Increment) small This tiny gain change can be, for example, 0.1, 0.2, etc., and is not limited. Next, controller 6 establishes a pose array [XYZABC]. T Furthermore, the controller 6 assigns any value in the pose array as the small gain change. For example, the controller 6 establishes a pose array such as [0 0 0 0 0 0]. T Furthermore, a preset small gain change (e.g., 0.1) is assigned to the value of any matrix element (e.g., the first element) in this pose array to obtain [0.1 0 0 0 0 0]. T The pose array. Where 0.1 is the matrix element of the i-th term (i = 1 to 6). The value.

[0122] Next, controller 6 calculates the current pose using inverse kinematics. The lengths of each passive linear elastic element 5 before their change (i.e., ), and the current pose After adding a small gain change, the changed pose is generated. Then, the changed length of each passive linear elastic element 5 under the changed pose is calculated (i.e., Next, controller 6 calculates the difference between the length before and after the change (i.e., in (This is the change difference). Finally, using this change difference and the values ​​of the matrix elements of the pose array after adding the small gain change, the final value of the corresponding matrix element in the Jacobian matrix is ​​calculated. Taking the above Jacobian matrix J as an example, for:

[0123] J 1(1X6) The values ​​of the matrix elements of the pose matrix are the result of adding a small gain change.

[0124] Finally, controller 6 repeats the above action six times until the final values ​​of the six matrix elements in the Jacobian matrix are obtained. Specifically, controller 6 performs the above action once to obtain a 1x6 matrix element (i.e., J). 1(1X6) After repeating the above steps six times, six sets of 1x6 matrix elements are obtained. Stacking these six sets of matrix elements yields a complete 6x6 Jacobian matrix. Using the Jacobian matrix, the controller 6 can obtain the force distribution of each passive linear elastic element 5. Therefore, in the next step, the Jacobian matrix can be multiplied by the linear displacement velocity array of each passive linear elastic element 5. To obtain the second linear displacement velocity array of the center point of the mobile platform 2

[0125] Back Figure 4 After calculating the path compensation amount in step S47, the controller 6 generates a first request command C1 based on the path compensation amount and transmits the first request command C1 to the host controller 71 of the transfer platform 7, which cooperates with the feedback control machine 1. Thus, the host controller 71 generates or adjusts motion commands for controlling the robotic arm 72 of the transfer platform 7 based on the path compensation amount in the first request command C1 (step S48), and then controls the robotic arm 72 to move according to the motion commands (step S49).

[0126] As mentioned above, when the mobile platform 2 is not subjected to external force, or when the passive elastic elements 52 do not experience elastic fatigue, the center point of the mobile platform 2 is located precisely in the center of the feedback control machine 1. If the center point of the mobile platform 2 shifts due to external force or elastic fatigue of the passive elastic elements 52, the controller 6 can generate a first request command C1 with the path compensation amount through the calculations described above. The path compensation amount is used to request the upper controller 71 to adjust the movement path of the robotic arm 72 for the purpose of compensating for the shift. In this way, when the feedback control machine 1 is positioned at the end of the robotic arm 72 and moves with the robotic arm 72, the mobile platform 2 can compensate by modifying the movement path of the robotic arm 72 to maintain its initial pose (i.e., keep the center point precisely in the center).

[0127] It is worth mentioning that once the feedback control machine 1 receives an external force, it will cause a change in the length of the passive linear elastic element 5 and a change in the pose of the moving platform 2. However, if the external force is too large, it may cause damage to the passive linear elastic element 5 and / or the moving platform 2. In order to avoid damage caused by unrestricted compliant movement, after calculating the displacement of the moving platform 2 in step S46, the controller 6 can further determine whether at least one of the passive elastic elements 52 among the multiple passive actuators 5 is close to or has reached its structural limit based on the displacement (step S50). If it is determined that any passive elastic element 52 is close to or has reached its structural limit, the controller 6 generates a second request command C2 requesting the transfer platform 7 to stop moving and transmits the second request command C2 to the upper controller 71 of the transfer platform 7.

[0128] In this application, the host controller 71 continuously receives the first request command C1 from the controller 6 and continuously adjusts the motion command used to control the movement of the robotic arm 72 according to the path compensation amount in the first request command C1. Furthermore, when the host controller 71 receives the second request command C2, it immediately controls the robotic arm 72 to stop moving, thereby preventing damage to the mechanism caused by excessive compliant movement of the feedback control machine 1.

[0129] Please refer to the following for further details. Figure 7 This is an embodiment illustrating the measurement results of this application. Figure 7 The display screen of the human-machine interface corresponding to the feedback control machine 1 of this application is shown. For example... Figure 7 As shown, the control system of the feedback control machine 1 (not shown in the figure, but could be a host controller 71, for example) can have a simulation model of the feedback control machine 1, which reflects all the changes that occur when the feedback control machine 1 receives an external force. For example, Figure 7The human-machine interface shown displays a simulation model corresponding to the feedback control machine 1, and displays the six-dimensional spatial pose (6D Pose) of the mobile platform 2 after receiving an external force, showing the displacement and angle change as: [0.55-1.24 28 0.69 0.02-0.05-0.99]. It also displays the estimated force as: [0.01-0.05 0.2] (kg), and the move increment of the mobile platform in the current pose and the initial pose as: [0.55-1.24 0.69 0.0.0]. However, Figure 7 This is merely one specific embodiment of this application, but the control system can present the calculated equivalent force, equivalent moment, and displacement and angular changes of the platform in any different form, without using... Figure 7 The human-computer interface shown is limited to this.

[0130] Through the aforementioned technical means of this application, in addition to providing support force and measuring the equivalent force / equivalent torque relative to the external force and the displacement of the moving platform, the feedback control machine can also compensate for the external force through the cooperating transfer platform, thereby improving the practicality of the feedback control machine in contact assembly processes.

Claims

1. A passive six-axis parallel feedback control machine with compensation function, comprising: The mobile platform has a first surface; The base platform has a second surface; Multiple first joint elements are respectively disposed on the first surface; Multiple second joint elements are respectively disposed on the second surface; Six passive linear elastic elements are respectively disposed between the mobile platform and the base platform via the plurality of first joint elements and the plurality of second joint elements, and each passive linear elastic element has a passive elastic element and a linear sensor, wherein each passive elastic element has a free length, and the mobile platform has an initial pose determined by the free length of each passive elastic element; and The controller is connected to the six passive linear elastic elements and performs the following actions: Action a) When the mobile platform receives an external force, receive the compression amount of each of the passive elastic elements measured by each of the linear sensors, and calculate the supporting force of each of the passive elastic elements relative to the external force based on the compression amount; Action b) Calculate the positive kinematics based on the compression of each of the passive elastic elements to obtain the current pose of the mobile platform; Action c) Calculate the equivalent force and equivalent moment of the moving platform relative to the external force based on the current pose and the supporting force of each of the passive elastic elements; Action d) Compare the initial pose and the current pose of the mobile platform to obtain a displacement; and Action e) Based on the equivalent force, the equivalent moment, and the displacement, generate the path compensation amount required for the transfer platform to cooperate with the passive six-axis parallel feedback control machine.

2. The passive six-axis parallel feedback control machine according to claim 1, wherein the linear sensor is an optical ruler or a laser rangefinder.

3. The passive six-axis parallel feedback control machine according to claim 1, wherein each of the passive elastic elements has a stiffness coefficient, and the controller is configured to calculate the compression amount in the action a) based on the difference between the current length and the free length of each of the passive elastic elements, and to calculate the support force of each of the passive elastic elements based on the compression amount and the stiffness coefficient of each of the passive elastic elements according to Hooke's law.

4. The passive six-axis parallel feedback control machine according to claim 1, wherein the controller is further configured to determine, based on the displacement, whether at least one of the plurality of passive elastic elements is approaching or has reached a structural limit, and to issue a request command to the transfer platform to stop moving when any of the passive elastic elements approaches or reaches the structural limit.

5. The passive six-axis parallel feedback control machine according to claim 1, wherein the transfer platform comprises: The host controller is connected to the controller and receives the path compensation amount; and A robotic arm is connected to the host controller and is mounted on the base platform; The host controller adjusts the motion command used to control the movement of the robotic arm based on the path compensation amount, so that the center point of the mobile platform remains in the initial pose when the robotic arm moves.

6. The passive six-axis parallel feedback control machine according to claim 1, wherein the controller is configured to iteratively perform the following actions to achieve action b): Obtain the current pose of the mobile platform, and calculate the inverse kinematics based on the current pose to obtain the current length of each of the passive elastic elements; Calculate the length error between the current length of each passive elastic element and the target length caused by the external force; Calculate the required linear displacement velocity array for each passive elastic element based on the length error value and the time constant of the iterative algorithm; The Jacobian matrix is ​​calculated based on the current pose of the mobile platform, and the linear displacement velocity array is converted into a second linear displacement velocity array required by the mobile platform using the Jacobian matrix. The second linear displacement velocity array is added to the current pose of the moving platform to generate the updated current pose during the iteration process; The inverse kinematics are calculated based on the updated current pose to obtain the current length of each of the passive elastic elements during the iteration process; and The above actions are repeated to perform iterative update calculations until the length error value of each passive elastic element converges to a preset accurate value, at which point the calculation ends and the updated current pose is output as the current pose of the mobile platform.

7. The passive six-axis parallel feedback control machine according to claim 1, wherein the controller is configured to iteratively perform the following actions to achieve action c): The linear thrust vector matrix of each passive elastic element is obtained from each of the linear sensors; The first coordinate position of each of the first joint elements, expressed in the base platform coordinate system, and the second coordinate position of each of the second joint elements, expressed in the base platform coordinate system, are calculated by inverse kinematics. Calculate the Euclidean distance between each second joint element and the corresponding first joint element based on the plurality of first coordinate positions and the plurality of second coordinate positions; Calculate the unit vector of the line connecting each second joint element and the corresponding first joint element based on the plurality of Euclidean distances; The equivalent force of the mobile platform relative to the external force is calculated based on the plurality of linear thrust vector matrices and the plurality of unit vectors. Calculate the line vector connecting the center position of the base platform to each of the second joint elements to serve as the lever arm; and The equivalent moment of the moving platform relative to the external force is calculated based on the lever arm and the equivalent force.

8. The passive six-axis parallel feedback controlled machine of claim 7, wherein the controller calculates the unit vector based on a first formula, the equivalent force based on a second formula, and the equivalent moment based on a third formula, the first formula being: the second formula being: the third formula being: wherein is the unit vector, is the Euclidean distance, F is the equivalent force, f i is the linear thrust vector matrix, T is the equivalent moment, is the connecting vector.

9. A compensation method for a passive six-axis parallel feedback control machine, applied to a passive six-axis parallel feedback control machine having a moving platform, a base platform, a plurality of first joint elements respectively disposed on a first surface of the moving platform, a plurality of second joint elements respectively disposed on a second surface of the base platform, six passive linear elastic elements disposed between the moving platform and the base platform respectively through the plurality of first joint elements and the plurality of second joint elements, and a controller connected to the six passive linear elastic elements, wherein each of the passive linear elastic elements has a passive elastic element and a linear sensor, the moving platform has an initial pose determined by the free length of each of the passive elastic elements, and the compensation method includes the following steps: Step a) When the mobile platform receives an external force, each of the linear sensors measures the compression of each of the passive elastic elements, and the controller calculates the supporting force of each of the passive elastic elements relative to the external force based on the compression. Step b) The controller calculates the positive kinematics based on the compression of each of the passive elastic elements to obtain the current pose of the mobile platform; Step c) The controller calculates the equivalent force and equivalent moment of the moving platform relative to the external force based on the current pose and the supporting force of each of the passive elastic elements; Step d) The controller compares the initial pose and the current pose of the mobile platform to obtain the displacement. and Step e) The controller generates the path compensation amount required by the transfer platform to cooperate with the passive six-axis parallel feedback control machine based on the equivalent force, the equivalent torque and the displacement.

10. The compensation method according to claim 9, wherein each of the passive elastic elements has a stiffness coefficient, and step a) comprises: The controller calculates the compression amount based on the difference between the current length and the free length of each of the passive elastic elements; and The supporting force of each passive elastic element is calculated based on Hooke's Law, taking into account the compression amount and the stiffness coefficient of each passive elastic element.

11. The compensation method according to claim 9, further comprising: Step f) The controller determines, based on the displacement, whether at least one of the plurality of passive elastic elements is close to or has reached the structural limit; and Step g) When any of the passive elastic elements approaches or reaches the structural limit, a request command is issued to request the transfer platform to stop moving.

12. The compensation method according to claim 9, wherein the transfer platform includes a host controller connected to the controller and receiving the path compensation amount, and a robotic arm connected to the host controller and disposed on the base platform, and further includes: Step h) The host controller adjusts the motion command based on the path compensation amount; and Step i) The host controller controls the movement of the robotic arm based on the adjusted motion command, wherein the center point of the mobile platform remains in the initial pose when the robotic arm moves.

13. The compensation method according to claim 9, wherein step b) comprises: Step b1) Obtain the current pose of the mobile platform and calculate the inverse kinematics based on the current pose to obtain the current length of each passive elastic element; Step b2) Calculate the current length of each of the passive elastic elements and the length error between the target length caused by the external force; Step b3) Calculate the required linear displacement velocity array for each of the passive elastic elements based on the length error value and the time constant of the iterative algorithm; Step b4) Calculate the Jacobian matrix based on the current pose of the mobile platform, and use the Jacobian matrix to convert the linear displacement velocity array into a second linear displacement velocity array required by the mobile platform; Step b5) Add the second linear displacement velocity array to the current pose of the moving platform to generate the updated current pose during the iteration process; Step b6) Calculate the inverse kinematics based on the updated current pose to obtain the current length of each of the passive elastic elements in the iteration process; and Step b7) Repeat the above steps to perform iterative update calculations until the length error value of each passive elastic element converges to a preset accurate value, and then output the updated current pose as the current pose of the mobile platform.

14. The compensation method according to claim 9, wherein step c) comprises: Step c1) Obtain the linear thrust vector matrix of each passive elastic element from each of the linear sensors; Step c2) Calculate the first coordinate position of each of the first joint elements in the base platform coordinate system and the second coordinate position of each of the second joint elements in the base platform coordinate system by inverse kinematics; Step c3) Calculate the Euclidean distance between each second joint element and the corresponding first joint element based on the plurality of first coordinate positions and the plurality of second coordinate positions; Step c4) Calculate the unit vector of the line connecting each second joint element and the corresponding first joint element based on the plurality of Euclidean distances; Step c5) Calculate the equivalent force of the mobile platform relative to the external force based on the plurality of linear thrust vector matrices and the plurality of unit vectors; Step c6) Calculate the line vector connecting the center position of the base platform and each of the second joint elements as the lever arm; and Step c7) Calculate the equivalent moment of the moving platform relative to the external force based on the lever arm and the equivalent force.

15. The compensation method according to claim 14, wherein said step c4) comprises calculating said unit vector based on a first formula, said step c5) comprises calculating said equivalent force based on a second formula, said step c7) comprises calculating said equivalent moment based on a third formula, wherein said first formula is: said second formula is: said third formula is: T = F x r wherein is said unit vector, is said Euclidean distance, F is said equivalent force, f i is said linear thrust vector matrix, T is said equivalent moment, is said connecting vector.