CN110175409B - Gravity feedback compensation method - Google Patents

Gravity feedback compensation method Download PDF

Info

Publication number
CN110175409B
CN110175409B CN201910452629.2A CN201910452629A CN110175409B CN 110175409 B CN110175409 B CN 110175409B CN 201910452629 A CN201910452629 A CN 201910452629A CN 110175409 B CN110175409 B CN 110175409B
Authority
CN
China
Prior art keywords
rod
force
gravity
floating platform
active
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910452629.2A
Other languages
Chinese (zh)
Other versions
CN110175409A (en
Inventor
吴书传
许辉勇
章兴石
白钢印
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Puresis Testing Technology Co ltd
Original Assignee
Sunwoda Electronic Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sunwoda Electronic Co Ltd filed Critical Sunwoda Electronic Co Ltd
Priority to CN201910452629.2A priority Critical patent/CN110175409B/en
Publication of CN110175409A publication Critical patent/CN110175409A/en
Application granted granted Critical
Publication of CN110175409B publication Critical patent/CN110175409B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/06Power analysis or power optimisation

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)
  • Transmission Devices (AREA)

Abstract

The invention relates to the technical field of virtual reality, and discloses a gravity feedback compensation method, which comprises the following steps: a world coordinate system { O } is arranged at the center point of the fixed platform, and a movable coordinate system { O' }isarranged at the center point of the floating platform; when the parallel mechanism reaches a gravity balance state, the floating platform reaches a stress balance state, and the stress of the floating platform is analyzed; calculating the moment generated on the joint by the resultant force of the force on the passive rod and the force distributed to the active rod; calculating the moment applied to the active joint by the motor; and calculating the input current of the motor. The gravity feedback compensation method adopts a Newton-Euler method to analyze the stress on each rod piece and the moment on each joint in the force feedback equipment mechanism, thereby establishing the relationship between the equipment dead weight and the motor moment of the force feedback equipment at any position and any posture in a motion space, leading the force feedback equipment to reach a dynamic balance state and improving the transparency of the force feedback equipment.

Description

Gravity feedback compensation method
Technical Field
The invention relates to the technical field of virtual technology, in particular to a gravity feedback compensation method.
Background
The Virtual Reality (VR) technology is a virtual environment simulating reality constructed in a computer through a series of input and output devices, and a user can roam in the virtual environment through the input devices and interact with objects in the virtual environment; and the output equipment can feed back the visual sensation, the touch sensation and other five senses in the virtual environment to the user, so that the user can achieve an immersive experience.
The force/touch interaction is based on the unique interaction mode with a bidirectional information communication channel of a human body, so that the force feedback device is an important interaction tool in virtual reality force/touch interaction. An excellent force feedback device must have the characteristics of high transparency, high rigidity, high control bandwidth, low inertia, low friction, and the like, wherein the transparency is the perception of the presence of the force feedback device by a user when interacting with a virtual reality environment. In the virtual reality interaction process, the more transparent the force feedback equipment, the more difficult the user can feel the existence of the force feedback equipment, and the better the experience of being personally on the scene. Among the factors affecting the transparency of the force feedback device, one of the main factors is derived from the self weight of the device, and therefore, gravity compensation of the force feedback device is a key method for improving the transparency of the force feedback device.
In the prior art, passive gravity compensation and active gravity compensation are commonly used as gravity compensation methods. The passive gravity compensation is to offset the moment generated by the self weight of the equipment on the joint by using energy storage devices such as a balancing weight, a spring and the like. Active gravity compensation is that the motor outputs reverse torque to balance the torque generated by the self weight of the equipment on the joint, so that the equipment reaches a balanced state.
In the passive gravity compensation method, the method of balancing the self weight of the equipment by the balancing weight can reduce the influence of the self weight of the equipment on an operator, but increases the inertia of the equipment, reduces the dynamic performance of the equipment, and the weight of the balancing weight is constant, so that complete gravity compensation cannot be realized for force feedback in any pose. The method for compensating the gravity force by the spring has the advantages that the spring is light in weight, and the weight and the inertia of the force feedback equipment are not increased basically, so that the operation performance of the force feedback equipment is influenced. However, several methods of spring gravity compensation have certain disadvantages. The patent No. 201610015837.2 discloses an optimal spring gravity compensation method for force feedback devices, which is designed to use a simple spring as a gravity compensation machine, but no matter how the mounting position, free length and stiffness of the spring are optimized, in practical engineering, a linear spring is used to replace a nonlinear spring, so that complete gravity compensation cannot be realized at any position of the working space of the force feedback devices, and the spring is easy to interfere with the mechanism of the force feedback devices, thereby further limiting the working space of the force feedback devices. Patent No. 201610028353.1 proposes a zero free length spring gravity compensation method based on force feedback equipment, which includes a fixed pulley and a steel wire rope, in addition to a spring, the spring and the fixed pulley are mounted on a fixed platform, one end of the steel wire rope is connected with the spring, and the other end of the steel wire rope is connected with a driven wheel of a speed reduction mechanism of the force feedback equipment after bypassing the steel wire rope. This method eliminates the interference of the spring with the force feedback device mechanism, but in practical engineering, since the fixed pulley radius and the fixed position length of the pulley cannot be zero, the theoretically complete realization of gravity compensation still produces compensation deviation in practical engineering. Patent No. 201711049846.4 proposes a cam tension spring mechanism for gravity compensation of a mechanical arm, wherein a disc cam is mounted at a joint end at the tail end of the mechanical arm, one end of a steel wire rope is fixed on the edge of the disc cam, and the other end of the steel wire rope is connected with a tension spring. However, when the force feedback device is in rapid motion, the steel wire rope connecting the cam and the spring is not always kept on the same plane, which causes the spring and the steel wire rope to generate a tension gap, introduces a delay amount, easily causes the spring and the steel wire rope to slide, and also reduces the stability of the force feedback system.
In active compensation, the existing force feedback equipment often adopts a virtual displacement method to establish a gravity compensation model based on an angle of energy conservation, but the compensation torque value calculated by the method is easy to generate sudden change in certain positions in a motion space of a parallel mechanism (Delta mechanism), so that gravity compensation is invalid.
Disclosure of Invention
The invention aims to provide a gravity feedback compensation method, and aims to solve the problem that in the prior art, gravity compensation failure is easy to occur in force feedback of virtual reality equipment, so that the transparency of the force feedback equipment is low.
The gravity feedback compensation method is realized in the way, and is used for a parallel mechanism, wherein the parallel mechanism comprises a fixed platform, three groups of branched chains and a floating platform, and each branched chain comprises a driving rod and a driven rod group;
the driven rod group comprises four connecting rods in a parallelogram shape, each end point is provided with a rotating hinge, one short edge is hinged with one end of the driving rod, and the other short edge is hinged with the floating platform; one end of the driving rod is hinged to the fixed platform; the gravity feedback compensation method comprises the following steps:
a world coordinate system { O } is arranged at the center point of the fixed platform, and a movable coordinate system { O' } is arranged at the center point of the floating platform; when the parallel mechanism reaches a gravity balance state, the floating platform reaches a stress balance state, and the stress of the floating platform is analyzed; calculating the moment generated on the joint by the resultant force of the force on the passive rod and the force distributed to the active rod; calculating the moment applied to the active joint by the motor; calculating an input current of the motor.
Further, the X axis of the world coordinate system { O } is horizontally leftward, the Y axis is vertically upward, and the Z axis is perpendicular to the fixed platform and points to the floating platform; the X 'axis of the moving coordinate system (O') is horizontally leftward, the Y 'axis is vertically upward, and the Z' axis is perpendicular to the floating platform and outward; the included angles between the connecting line of the central point of the fixed platform and the hinged point of the driving rod and the X axis are eta respectivelyi(i ═ 1, 2, 3); the length of the driving rod is LaWeight is G1The included angle between the straight line and the horizontal direction is thetai(i ═ 1, 2, 3); the length of the driving rod is LbWeight is G2The weight of the floating platform is G3(ii) a The hinge point of the driving rod and the fixed platform is Ai(i ═ 1, 2, 3), and the hinge point with the passive rod is Ci(i is 1, 2, 3), thenThe hinged point of the passive rod and the floating platform is Bi(i ═ 1, 2, 3); 1/2 of the weight of the passive rod is distributed to the floating platform, 1/2 is distributed to one end of the active rod; when the floating platform is subjected to stress analysis, the positive direction of the acting force of the passive rod on the floating platform is defined as BiCiDirection; the floating platform achieves a stress balance state to establish an equation set:
A1f1+A2f2+A3f3=0
Figure BDA0002075624850000041
order to
Figure BDA0002075624850000042
C1f1+C2f2+C3f3=0
Solving the system of equations yields:
Figure BDA0002075624850000043
wherein f isi(i is 1, 2, 3) is the force on the rod i, the direction is along the straight line of the rod, and the positive number represents BiCiDirection, negative number denotes CiBiDirection, through point Bi,CiCan find the vector
Figure BDA0002075624850000044
The force vector on each passive rod can be obtained
Figure BDA0002075624850000045
Further, the resultant force of the force on the passive lever and the force distributed on the active lever is
Figure BDA0002075624850000046
The resultant force has an included angle with the plane of the active rod, and the resultant force
Figure BDA0002075624850000047
Only in the plane OAiCiThe above components will produce moment effect on the active joint; set plane OAiCiHas a unit normal vector of
Figure BDA0002075624850000048
Then
Figure BDA0002075624850000049
Wherein
Figure BDA00020756248500000410
Is a plane OAiCiThe normal vector of (a) is,
Figure BDA00020756248500000411
resultant force
Figure BDA00020756248500000412
In-plane OAiCiThe component of normal direction being force
Figure BDA00020756248500000413
And unit normal vector
Figure BDA00020756248500000414
By dot multiplication of
Figure BDA00020756248500000415
Then the resultant force is known
Figure BDA00020756248500000416
In-plane OAiCiComponent of
Figure BDA00020756248500000417
The moment generated by the force on the passive rod on the active joint is known to be
Figure BDA00020756248500000418
Further, the active stateGravity of the rod
Figure BDA00020756248500000419
In-plane OAiCiHas a component of
Figure BDA00020756248500000420
The gravity of the driving lever
Figure BDA00020756248500000421
In-plane OAiCiComponent of
Figure BDA0002075624850000051
The gravity of the active lever can be known
Figure BDA0002075624850000052
The sum of the moments generated on the active joint is
Figure BDA0002075624850000053
Wherein point PiIs the position (i ═ 1, 2, 3) where the center of gravity of the active lever is located.
Further, the moment applied to the active joint by the motor is obtained. A moment balance equation is established at the active joint,
Figure BDA0002075624850000054
wherein the torque applied to the active joint by the motor is determined
Figure BDA0002075624850000055
Further, according to moment
Figure BDA0002075624850000056
The torque constant tau of the motor is combined to obtain the current value which should be input by the corresponding motor for balancing the self weight of the equipment
Figure BDA0002075624850000057
Compared with the prior art, the gravity feedback compensation method adopts a Newton-Euler method to analyze the stress on each rod piece and the moment on each joint in the force feedback equipment mechanism, thereby establishing the relationship between the equipment dead weight and the motor moment under any position and posture of the force feedback equipment in a motion space, outputting the appointed current through the motor to obtain the appointed moment, further balancing the moment generated on the joint by the equipment dead weight on line in real time, leading the force feedback equipment to reach a dynamic balance state, and improving the transparency of the force feedback equipment.
Drawings
FIG. 1 is a schematic diagram of a parallel mechanism according to an embodiment of the present invention
FIG. 2 is a schematic diagram of an angle between a branched chain and an X-axis of a fixed coordinate system { O }, in an embodiment of the present invention;
FIG. 3 is a simplified diagram of a parallelogram mechanism of a branched passive bar set according to an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
The implementation of the present embodiment is described in detail below with reference to specific drawings.
As shown in fig. 1 to 3, the present embodiment provides a method for active gravity compensation of a force feedback device of a parallel mechanism (Delta mechanism). The method adopts a Newton-Euler method to analyze the stress on each rod piece and the moment on each joint in the force feedback equipment mechanism, thereby establishing the relationship between the equipment dead weight and the motor moment of the force feedback equipment at any position and any posture in a motion space, outputting a specified current through a motor to obtain the specified moment, further balancing the moment generated by the equipment dead weight on the joint in real time on line, leading the force feedback equipment to reach a dynamic balance state, and improving the transparency of the force feedback equipment.
FIG. 1 is a schematic diagram of a force feedback device model of a parallel mechanism (Delta mechanism)The Delta mechanism is modeled as a horizontal configuration, i.e., the floating platform moves in space in front of the fixed platform, while other orientations, such as vertical, are used. In the Delta mechanism force feedback equipment model, a fixed platform and a floating platform of a Delta mechanism are connected through three completely consistent branched chains, each branched chain is provided with a driving rod and a driven rod, one end of the driving rod is connected with the fixed platform through a rotating hinge, the other end of the driving rod is connected with the driven rod through a rotating hinge, the driven rod is a parallelogram mechanism, four vertexes of the parallelogram are rotating hinges, and the other end of the driven rod is connected with the floating platform through a rotating link. A world coordinate system { O } is arranged at the center point of the fixed platform, the X axis of the world coordinate system is horizontally leftward, the Y axis of the world coordinate system is vertically upward, and the Z axis of the world coordinate system is perpendicular to the direction of the fixed platform and points to the direction of the floating platform. A movable coordinate system (O ') is arranged at the center point of the floating platform, the X' axis of the movable coordinate system is horizontally leftward, the Y 'axis of the movable coordinate system is vertically upward, and the Z' axis of the movable coordinate system is perpendicular to the floating platform and outward. As shown in FIG. 2, the connecting line between the center point of the fixed platform and the hinge point of the active rod has an included angle eta with the X-axisi(i ═ 1, 2, 3). The included angle between the straight line of the driving rod and the horizontal direction is thetai(i ═ 1, 2, 3). The length of the driving rod is LaWeight is G1The length of the driven rod is LbWeight is G2The weight of the floating platform is G3The hinge point of the driving rod and the fixed platform is Ai(i ═ 1, 2, 3), and the hinge point of the driving rod and the driven rod is Ci(i ═ 1, 2 and 3), and the hinged point of the passive rod and the floating platform is Bi(i ═ 1, 2, 3). By weight of driven bar
Figure BDA0002075624850000061
Is distributed to the floating platform, and the floating platform,
Figure BDA0002075624850000062
to one end of the active lever; when the floating platform is subjected to stress analysis, the positive direction of the acting force of the passive rod on the floating platform is defined as BiCiDirection; FIG. 3 is a simplified diagram of a branched passive rod parallelogram mechanism, in which two groups of edges are parallel at any time due to the parallelogram of the branched passive rodAre parallel to each other, and therefore, may be assumed to be in parallelogram B'iB″iC″iC′iThe middle point of the two short sides is connected with a rod BiCiThe length of the rod is equal to the length of the long side of the parallelogram, the weight of the length is the weight of the whole parallelogram, and the gravity center of the length is just the gravity center of the parallelogram.
First, according to the spatial model coordinate system,
Figure BDA0002075624850000071
and (5) carrying out stress analysis on the floating platform. The floating platform is under the action of gravity and the action force of the three passive rods, and when the mechanism reaches a gravity balance state, the floating platform reaches a stress balance state. The stress balance equation in three directions can be established:
force balance equation in X direction:
Figure BDA0002075624850000072
force balance equation in the Y direction:
Figure BDA0002075624850000073
force balance equation of direction:
Figure BDA0002075624850000074
in combination with the above three equations, a system of equations can be established:
A1f1+A2f2+A3f3=0
Figure BDA0002075624850000081
C1f1+C2f2+C3f3=0,order to
Figure BDA0002075624850000082
Solving the system of equations yields:
Figure BDA0002075624850000083
wherein f isi(i is 1, 2, 3) is the force on the rod i, the direction is along the straight line of the rod, and the positive number represents BiCiDirection, negative number denotes CiBiAnd (4) direction. Using point Bi,CiCan find the vector
Figure BDA0002075624850000084
Figure BDA0002075624850000085
The force vector on each passive rod can be obtained
Figure BDA0002075624850000086
And calculating the moment generated on the active joint by the resultant force of the force on the passive rod and the force distributed to the active rod. The resultant of the force on the passive rod and the force on the active rod is
Figure BDA0002075624850000087
The resultant force has an included angle with the plane of the active rod
Figure BDA0002075624850000088
Only in the plane OAiCiThe component of (a) will produce a moment effect on the active joint. Set plane OAiCiHas a unit normal vector of
Figure BDA0002075624850000089
Then
Figure BDA00020756248500000810
Wherein
Figure BDA00020756248500000811
Is a plane OAiCiThe normal vector of (a) is,
Figure BDA00020756248500000812
on the basis of the coordinates of the model,
Figure BDA00020756248500000813
resultant force
Figure BDA00020756248500000814
In-plane OAiCiThe component of normal direction being force
Figure BDA00020756248500000815
And unit normal vector
Figure BDA00020756248500000816
By dot multiplication of
Figure BDA00020756248500000817
Then the resultant force is known
Figure BDA00020756248500000818
In-plane OAiCiComponent of
Figure BDA0002075624850000091
The moment generated on the active joint by the force on the passive rod can be known as
Figure BDA0002075624850000092
And solving the moment generated on the driving joint by the gravity of the driving rod. Gravity of the driving lever
Figure BDA0002075624850000093
In-plane OAiCiHas a component of
Figure BDA0002075624850000094
The gravity of the driving lever
Figure BDA0002075624850000095
In-plane OAiCiComponent of
Figure BDA0002075624850000096
The gravity of the driving lever can be known
Figure BDA0002075624850000097
The sum of the moments generated on the active joint is
Figure BDA0002075624850000098
Wherein point PiThe position (i is 1, 2, 3) of the center of gravity of the active lever;
and solving the moment applied to the active joint by the motor. A moment balance equation is established at the active joint,
Figure BDA0002075624850000099
wherein the torque applied to the active joint by the motor is determined
Figure BDA00020756248500000910
And solving the input current of the motor. Based on the torque obtained
Figure BDA00020756248500000911
The torque constant tau of the motor is combined to obtain the current value which should be input by the corresponding motor for balancing the self weight of the equipment
Figure BDA00020756248500000912
Compared with the conventional passive gravity compensation or active compensation adopting virtual displacement, the method for performing active gravity compensation by using the Newton-Euler method can compensate the moment generated by the self weight of the force feedback device at the joint of the device when the force feedback device is at any position and posture in the motion space of the force feedback device in real time on line, and increases the transparency of the force feedback device. Compared with passive gravity compensation, the method provided by the invention only needs the motor to provide extra torque to compensate gravity, and does not need extra mechanisms and parts, so that mechanical interference generated between the newly added part and the existing part is avoided, and the inertia of equipment is not increased; compared with an active compensation method adopting virtual displacement, the method can not cause sudden change of gravity compensation moment at a part of the motion space to cause compensation failure.
The present invention is not limited to the above preferred embodiments, and any modifications, equivalent substitutions and improvements made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims (5)

1. The gravity feedback compensation method is used for a parallel mechanism and is characterized in that the parallel mechanism comprises a fixed platform, three groups of branched chains and a floating platform, wherein each branched chain comprises a driving rod and a driven rod group;
the driven rod group comprises four connecting rods in a parallelogram shape, a rotating hinge is arranged at each end point, one short edge is hinged with one end of the driving rod, and the other short edge is hinged with the floating platform
One end of the driving rod is hinged to the fixed platform;
the gravity feedback compensation method comprises the following steps:
a world coordinate system { O } is arranged at the center point of the fixed platform, and a movable coordinate system { O' } is arranged at the center point of the floating platform;
when the parallel mechanism reaches a gravity balance state, the floating platform reaches a stress balance state, and the stress of the floating platform is analyzed;
calculating the moment generated on the joint by the resultant force of the force on the passive rod and the force distributed to the active rod;
calculating the moment applied to the active joint by the motor;
calculating an input current of the motor;
wherein, the X axis of the world coordinate system { O } is horizontally leftward, the Y axis is vertically upward, and the Z axis is perpendicular to the fixed platform and points to the floating platform;
the X 'axis of the moving coordinate system (O') is horizontally leftward, the Y 'axis is vertically upward, and the Z' axis is perpendicular to the floating platform and outward;
the included angles between the connecting line of the central point of the fixed platform and the hinged point of the driving rod and the X axis are eta respectivelyi(i=1,2,3);
The length of the driving rod is LaWeight is G1The included angle between the straight line and the horizontal direction is thetai(i=1,2,3);
The length of the passive rod is LbWeight is G2The weight of the floating platform is G3
The hinge point of the driving rod and the fixed platform is Ai(i ═ 1, 2, 3), and the hinge point with the passive rod is Ci(i ═ 1, 2, 3), and the hinged point of the passive rod and the floating platform is Bi(i=1,2,3);
1/2 of the weight of the passive rod is distributed to the floating platform, 1/2 is distributed to one end of the active rod;
when the floating platform is subjected to stress analysis, the positive direction of the acting force of the passive rod on the floating platform is defined as BiCiDirection;
the floating platform achieves a stress balance state to establish an equation set:
A1f1+A2f2+A3f3=0
Figure FDA0003361735320000027
order to
Figure FDA0003361735320000021
C1f1+C2f2+C3f3=0
Solving the system of equations yields:
Figure FDA0003361735320000022
wherein f isi(i-1, 2, 3) is a rod memberi is the force in the direction along the straight line of the rod, and the positive number represents BiCiDirection, negative number denotes CiBiDirection, through point Bi,CiCan find the vector
Figure FDA0003361735320000023
The force vector on each passive rod can be obtained
Figure FDA0003361735320000024
2. The gravity feedback compensation method of claim 1, wherein a resultant force of the force on the passive rod and the force distributed on the active rod is
Figure FDA0003361735320000025
The resultant force has an included angle with the plane of the active rod, and the resultant force
Figure FDA0003361735320000026
Only in the plane OAiCiThe above components will produce moment effect on the active joint;
set plane OAiCiHas a unit normal vector of
Figure FDA0003361735320000031
Then
Figure FDA0003361735320000032
Wherein
Figure FDA0003361735320000033
Is a plane OAiCiThe normal vector of (a) is,
Figure FDA0003361735320000034
resultant force
Figure FDA0003361735320000035
In-plane OAiCiThe component of normal direction being force
Figure FDA0003361735320000036
And unit normal vector
Figure FDA0003361735320000037
By dot multiplication of
Figure FDA0003361735320000038
Then the resultant force is known
Figure FDA0003361735320000039
In-plane OAiCiComponent of
Figure FDA00033617353200000310
The moment generated by the force on the passive rod on the active joint is known to be
Figure FDA00033617353200000311
3. The gravity feedback compensation method of claim 2, wherein the gravity of the active lever
Figure FDA00033617353200000312
In-plane OAiCiHas a component of
Figure FDA00033617353200000313
The gravity of the driving lever
Figure FDA00033617353200000314
In-plane OAiCiComponent of
Figure FDA00033617353200000315
The gravity of the active lever can be known
Figure FDA00033617353200000316
The moment generated on the active joint is
Figure FDA00033617353200000317
Wherein point PiIs the position (i ═ 1, 2, 3) where the center of gravity of the active lever is located.
4. The gravity feedback compensation method according to claim 3, wherein the moment applied to the active joint by the motor is obtained, a moment balance equation is established at the active joint,
Figure FDA00033617353200000318
wherein
Figure FDA00033617353200000319
The torque applied to the active joint by the motor can be determined
Figure FDA00033617353200000320
5. Gravity feedback compensation method according to claim 4, wherein the moment is based
Figure FDA00033617353200000321
The torque constant tau of the motor is combined to obtain the current value which should be input by the corresponding motor for balancing the self weight of the equipment
Figure FDA00033617353200000322
CN201910452629.2A 2019-05-28 2019-05-28 Gravity feedback compensation method Active CN110175409B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910452629.2A CN110175409B (en) 2019-05-28 2019-05-28 Gravity feedback compensation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910452629.2A CN110175409B (en) 2019-05-28 2019-05-28 Gravity feedback compensation method

Publications (2)

Publication Number Publication Date
CN110175409A CN110175409A (en) 2019-08-27
CN110175409B true CN110175409B (en) 2022-01-25

Family

ID=67695760

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910452629.2A Active CN110175409B (en) 2019-05-28 2019-05-28 Gravity feedback compensation method

Country Status (1)

Country Link
CN (1) CN110175409B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111216129B (en) * 2020-01-07 2023-03-21 华南理工大学 Active-passive combined series-parallel force feedback equipment gravity compensation method
CN113043279B (en) * 2021-04-15 2022-08-02 诺创智能医疗科技(杭州)有限公司 Control method, controller, system, electronic device and medium for surgical robot
CN113081290B (en) * 2021-04-15 2022-06-24 诺创智能医疗科技(杭州)有限公司 Control method, controller, system, electronic device and medium for surgical robot
WO2023169306A1 (en) * 2022-03-07 2023-09-14 诺创智能医疗科技(杭州)有限公司 Driving force acquisition method and apparatus for main manipulator, and storage medium

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102320040A (en) * 2011-08-11 2012-01-18 南昌大学 Force feedback interactive device for automatically regulating balance of dead weight
CN103217924A (en) * 2013-04-15 2013-07-24 清华大学 Dynamics modeling method of over-constrained heavy parallel machine tool applied to real-time control
US8621954B1 (en) * 2010-06-04 2014-01-07 University Of Washington Through Its Center For Commercialization Systems and methods for gravity compensation
CN105835086A (en) * 2016-05-11 2016-08-10 华南理工大学 Series-parallel 6-degree-of-freedom force feedback mechanical arm
CN205704267U (en) * 2016-05-11 2016-11-23 华南理工大学 One series parallel type 6DOF force feedback manipulator
CN106980265A (en) * 2017-06-06 2017-07-25 北京航空航天大学 A kind of suspension type low-gravity environment simulation system exports feedback robust H ∞ control methods
CN107028663A (en) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 A kind of new master-slave mode operating robot control method
CN109333528A (en) * 2018-09-19 2019-02-15 欣旺达电子股份有限公司 Universal 6DOF force feedback equipment

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8621954B1 (en) * 2010-06-04 2014-01-07 University Of Washington Through Its Center For Commercialization Systems and methods for gravity compensation
CN102320040A (en) * 2011-08-11 2012-01-18 南昌大学 Force feedback interactive device for automatically regulating balance of dead weight
CN103217924A (en) * 2013-04-15 2013-07-24 清华大学 Dynamics modeling method of over-constrained heavy parallel machine tool applied to real-time control
CN105835086A (en) * 2016-05-11 2016-08-10 华南理工大学 Series-parallel 6-degree-of-freedom force feedback mechanical arm
CN205704267U (en) * 2016-05-11 2016-11-23 华南理工大学 One series parallel type 6DOF force feedback manipulator
CN107028663A (en) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 A kind of new master-slave mode operating robot control method
CN106980265A (en) * 2017-06-06 2017-07-25 北京航空航天大学 A kind of suspension type low-gravity environment simulation system exports feedback robust H ∞ control methods
CN109333528A (en) * 2018-09-19 2019-02-15 欣旺达电子股份有限公司 Universal 6DOF force feedback equipment

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Design and kinetostatic analysis of a new parallel;D. Zhang, Z. Bi, and B. Li;《Robotics and Computer-Integrated Manufacturing》;20091231;第25卷;第782-791页 *
微创外科手术机器人技术研究进展;付宜利,潘博;《哈尔滨工业大学学报》;20190131;第51卷(第1期);第1-15页 *
某末制导炮弹二体系统运动建模与仿真分析;佟德飞,宋卫东,王月怡,朱建峰;《系统仿真学报》;20140331;第26卷(第3期);第698-703页 *

Also Published As

Publication number Publication date
CN110175409A (en) 2019-08-27

Similar Documents

Publication Publication Date Title
CN110175409B (en) Gravity feedback compensation method
CN111216129B (en) Active-passive combined series-parallel force feedback equipment gravity compensation method
US9031691B2 (en) Systemic derivation of simplified dynamics for humanoid robots
Gallardo et al. Dynamics of parallel manipulators by means of screw theory
US20220019196A1 (en) Feedforward control method for floating base dynamics, computer-readable storage medium and robot
CN110104216A (en) A kind of collaboration paths planning method for kinematic redundancy dual-arm space robot
Nakanishi et al. Comparative experiments on task space control with redundancy resolution
Pedrammehr et al. Improved dynamic equations for the generally configured Stewart platform manipulator
CN104723340A (en) Impedance control method for flexibility joint mechanical arm based on connection and damping configuration
CN104723341A (en) Positioning control method for flexibility joint mechanical arm based on connection and damping configuration
Becerra-Vargas et al. Application of H∞ theory to a 6 DOF flight simulator motion base
CN109657282B (en) H-shaped motion platform modeling method based on Lagrangian dynamics
Wang et al. Simplified strategy of the dynamic model of a 6-UPS parallel kinematic machine for real-time control
Sciavicco et al. Lagrange and Newton-Euler dynamic modeling of a gear-driven robot manipulator with inclusion of motor inertia effects
Nabavi et al. Closed-form dynamic formulation of a general 6-P US robot
JP2004030502A (en) Simulation method, simulation apparatus, and simulation program
CN115686193A (en) Virtual model three-dimensional gesture control method and system in augmented reality environment
Chen et al. Design and dynamics modeling of a novel 2R1T 3-DOF parallel motion simulator
Zarafshan et al. Control of a space robot with flexible members
Ma et al. A novel aerial manipulator system compensation control based on ADRC and backstepping
CN103678897A (en) Special dynamics modeling method for flywheel vibration isolation platforms based on Kane equation
Mehra et al. Geometric-PBC based control of 4-dof underactuated overhead crane system
Subudhi et al. On the singular perturbation approach to trajectory control of a multilink manipulator with flexible links and joints
WO2013183190A1 (en) Robot system, robot control device, and robot system control method
Zhang et al. Impact analysis of space manipulator collision with soft environment

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220330

Address after: 518101 floor 1-5 of plant 4-7, Aiqun Road, Shangwu community, Shiyan street, Bao'an District, Shenzhen, Guangdong Province

Patentee after: SHENZHEN PRECISE TESTING TECHNOLOGY CO.,LTD.

Address before: 518000, 1st floor, 2nd floor, A-B area, 2nd floor, D area-9th floor, Yihe Road, Shiyan Street, Baoan District, Shenzhen City, Guangdong Province

Patentee before: SUNWODA ELECTRONICS Co.,Ltd.

CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 518106 Building 1-5, Aiqun Road, Tongfu Industrial Zone, Shangwu Community, Shiyan Street, Bao'an District, Shenzhen City, Guangdong Province

Patentee after: Shenzhen Puresis Testing Technology Co.,Ltd.

Country or region after: China

Address before: 518101 floor 1-5 of plant 4-7, Aiqun Road, Shangwu community, Shiyan street, Bao'an District, Shenzhen, Guangdong Province

Patentee before: SHENZHEN PRECISE TESTING TECHNOLOGY CO.,LTD.

Country or region before: China