Title:
STRUCTURE AND METHOD FOR CONTROLLING RESTORING FORCE OF THREE-DIMENSIONAL FORCE FEEDBACK HANDLE BASED ON FORCE/TORQUE SENSOR
Document Type and Number:
WIPO Patent Application WO/2019/024576
Kind Code:
A1
Abstract:
A structure for controlling restoring force of a three-dimensional force feedback handle based on a force/torque sensor, comprising a base plate (1), mounting brackets (2) on two sides, triangle plate ribs (3), a Y-axis motor (4), an X-axis motor (5), an inner frame (6), a three-dimensional force sensor (7), a tension spring (8), a Z-axis motor (9), a counterweight mechanism (10), a torsion spring (11), a torque sensor (12), and a handle knob (13). Also provided is a method for controlling restoring force of a three-dimensional force feedback handle based on a force/torque sensor, comprising the following steps: the three-dimensional force sensor (7) and the torque sensor (12) detect the restoring force of a force feedback handle in three directions in real time; use the difference between the expected restoring force input by a user currently and the current restoring force output of the handle at each degree of freedom as input of a PID controller; in the adjusting process, quickly adjust the current restoring force output by using all links to enable the restoring force output of the handle to track an expected input value; and if the current restoring force output value of the handle is consistent with the expected input value, the restoring force of the handle can be stably tracked and input. The control structure is simple, and the restoring force of the handle is controlled in real time and stably by means of PID adjustment.
Inventors:
SONG AIGUO (CN)
LIN ZHEN (CN)
LI HUIJUN (CN)
ZENG HONG (CN)
XU BAOGUO (CN)
ZHU LIFENG (CN)
LIN ZHEN (CN)
LI HUIJUN (CN)
ZENG HONG (CN)
XU BAOGUO (CN)
ZHU LIFENG (CN)
Application Number:
PCT/CN2018/088076
Publication Date:
February 07, 2019
Filing Date:
May 23, 2018
Export Citation:
Assignee:
UNIV SOUTHEAST (CN)
International Classes:
G01L5/22; G05B11/42
Foreign References:
| CN107560777A | 2018-01-09 | |||
| CN103406908A | 2013-11-27 | |||
| CN105116961A | 2015-12-02 | |||
| CN105710865A | 2016-06-29 | |||
| CN106507992B | 2014-07-16 | |||
| CN103140818A | 2013-06-05 | |||
| CN102221890A | 2011-10-19 | |||
| CN102122204A | 2011-07-13 | |||
| CN104908046A | 2015-09-16 | |||
| JPH0573150A | 1993-03-26 | |||
| GB2383628B | 2003-11-26 |
Attorney, Agent or Firm:
NANJING RUIHONG PATENT & TRADEMARK AGENCY (ORDINARY PARTNERSHIP) (CN)
Download PDF: