CN112847398A - Method for automatically protecting walking aid safety abnormity - Google Patents
Method for automatically protecting walking aid safety abnormity Download PDFInfo
- Publication number
- CN112847398A CN112847398A CN202110024646.3A CN202110024646A CN112847398A CN 112847398 A CN112847398 A CN 112847398A CN 202110024646 A CN202110024646 A CN 202110024646A CN 112847398 A CN112847398 A CN 112847398A
- Authority
- CN
- China
- Prior art keywords
- robot
- walking
- user
- axis
- force
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000005021 gait Effects 0.000 claims abstract description 18
- 230000002159 abnormal effect Effects 0.000 claims abstract description 12
- 210000003423 ankle Anatomy 0.000 claims abstract description 10
- 210000003127 knee Anatomy 0.000 claims abstract description 10
- 206010000117 Abnormal behaviour Diseases 0.000 claims abstract description 3
- 210000001624 hip Anatomy 0.000 claims description 9
- 238000005516 engineering process Methods 0.000 claims description 8
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000005856 abnormality Effects 0.000 claims 4
- 238000001514 detection method Methods 0.000 claims 1
- 230000006399 behavior Effects 0.000 description 2
- 210000003414 extremity Anatomy 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 238000003909 pattern recognition Methods 0.000 description 2
- 206010019468 Hemiplegia Diseases 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004064 dysfunction Effects 0.000 description 1
- 210000003141 lower extremity Anatomy 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 210000003205 muscle Anatomy 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Rehabilitation Tools (AREA)
Abstract
The invention discloses a method for automatically protecting safety abnormity of a walking aid, which is characterized in that a driving device of a walking aid robot is arranged, and the robot moves under the driving of a motor; the handle part at the rear end of the walking-aid robot is provided with a six-axis force sensor, the six-axis force sensor detects the forces Fx, Fy and Mz and the moments Mx, My and Mz in the three directions of x, y and z in a three-dimensional space coordinate system, and the movement purpose of a user is identified according to the forces Fx, Fy and Mz; gait sensors are arranged on the hip, the knee and the ankle of a user on two sides, and the gait data of the angle and the angular speed of each degree of freedom are collected in real time; the user pushes the handle part of the walking-aid robot to realize walking movement; if the user falls down or other abnormal conditions, the driving link of the walking-aid robot automatically starts an emergency protection mechanism to brake and stop the robot. According to the invention, a safety protection strategy is adopted aiming at abnormal conditions such as falling down of a user, the safety abnormal behavior of the user is sensed, and a driving device automatically adopts a brake to implement protection measures on the user aiming at the safety abnormal conditions.
Description
Technical Field
The invention relates to a technology for automatically taking protective measures aiming at walking aid safety abnormity, and belongs to the field of robot technology application.
Background
With the rapid development of automatic control technology and advanced manufacturing industry, robot technology is more and more widely applied to the aspects of social life. The intelligent walking-assisting robot is one of service robots, and aims to assist the old to accurately complete a rehabilitation training plan by means of science and technology, provide intelligent walking-assisting service for more old people and assist the old with lower limb obstacle to realize daily assisted walking.
The safety of the travel is very important for the elderly with weakened muscle strength of the limbs, hemiplegia and limb dysfunction. When the old person uses the walking-aid robot, if the old person encounters unexpected conditions such as falling, the walking-aid robot can sense the unexpected conditions in time, and automatically takes emergency measures such as braking, so that the dangerous condition of the old person is further reduced. The safety of the existing walking-aid robot needs to be improved.
Disclosure of Invention
The invention provides a method for triggering a walking-aid robot protection mechanism based on data of a six-axis force sensor and a gait sensor, so that automatic braking is realized, and the system safety is improved.
A method for automatically protecting the safety abnormity of walking aid comprises the following steps,
s1, a walking aid robot driving device is arranged, and the robot moves under the drive of a motor;
s2 a handle part at the rear end of the walking-aid robot is provided with a six-axis force sensor, the six-axis force sensor detects the forces Fx, Fy and Mz and the moments Mx, My and Mz in the three directions of x, y and z in a three-dimensional space coordinate system, and the movement purpose of a user is identified according to the forces Fx, Fy and Mz and the moments Mx, My and Mz;
s3 the user installs gait sensors on the hip, knee and ankle of two sides to collect the angle and angular speed gait data of each degree of freedom in real time;
s4, the user pushes the handle part of the walking-aid robot to realize walking movement;
s5, if the user falls down or the like, the driving link of the walking-aid robot automatically starts an emergency protection mechanism to brake and stop the robot.
Further, the driving force of the walking robot comes from the motor during the pushing of the walking robot by the user. The six-axis force sensor is arranged on the handle part of the walking-aid robot, and helps the robot to identify the movement purpose of a user when the user pushes the robot. The control scheme is based on a force admittance control method. In the control scheme, a six-axis force sensor is adopted to detect the size and the direction of the manpower of the walking aid robot. The six-axis force sensor can detect forces Fx, Fy and Mz in three directions of x, y and z in any three-dimensional coordinate system in space and detect moments Mx, My and Mz in the three directions of x, y and z. The user is behind the handle of the walking-aid robot, and the body is parallel to the y-axis. When a person pushes the walking robot, the person applies force along the x-axis direction; the direction of the applied force is along the y-axis when moving laterally.
Furthermore, since the exercise state of the user during walking is forward or turning, the six-axis force sensors are influenced by the x and y-direction forces Fx and Fy and the z-direction torque Mz, and only the analog quantities output by the three interfaces are processed in the control program. And filtering noise interference by using a filter function, and determining the x and y directions of the robot and the turning direction target speed according to the magnitudes of the three quantities of Fx, Fy and Mz through a mechanical admittance equation. Then the target speed of each driving wheel is calculated through the inverse kinematics of the walking aid robot, and the speed of each wheel is controlled, so that the movement speed and direction of the walking aid robot are controlled according to the force applied by a user, and the aim of assisting the walking aid of the user is fulfilled.
Furthermore, when a user pushes the walking-aid robot to walk, the hips, knees and ankles on two sides are all provided with gait sensors. By means of pattern recognition and signal processing technology, digital signals of angles and angular velocities of the hip, knee and ankle are acquired, and real-time gait information of the user, such as step length, step frequency, vertical/horizontal displacement, balance degree and the like, is formed through processing.
Further, on one hand, according to the force in the advancing direction (x axis) and the left-right direction (y axis) detected by the force sensor and the magnitude of the moment in the vertical direction (z axis), if the detected value is suddenly changed, and if the suddenly changed value exceeds a preset threshold value, the behavior of the user is considered to be abnormal; and on the other hand, the walking safety condition of the user is evaluated based on the data acquired and transmitted by the gait sensor in real time. By comprehensively analyzing the joint state of the multivariable, if the preset abnormal mode is met, the user is judged to slip or fall, the drive link starts an emergency protection mechanism, and the robot is braked and stopped.
Compared with the prior art, the driving device adopts a safety protection strategy aiming at the abnormal conditions of falling down and the like of the user, and the driving device automatically adopts a brake to implement protection measures on the user aiming at the abnormal conditions of safety by sensing the abnormal behaviors of the user.
Drawings
FIG. 1 is a schematic force and torque diagram of a six-axis force sensor
FIG. 2 user emergency protection mechanism
Detailed Description
The present invention can be applied to a walking assist robot driving apparatus, but is not limited thereto.
In the process of pushing the walking robot by a user, the driving force of the robot is mainly from the motor. The six-axis force sensor is arranged on the handle part of the robot, and helps the robot to identify the movement purpose of a user when the user pushes the robot. The control scheme is based on a force admittance control method. In the control scheme, the six-axis force sensor can be used for detecting the force magnitude and the direction of the pushing robot. The six-axis force sensor can detect forces Fx, Fy and Mz in three directions of x, y and z in any three-dimensional coordinate system in space and detect moments Mx, My and Mz in the three directions of x, y and z. As shown in fig. 1. The user is behind the robot handle, with the body parallel to the y-axis. When the robot is pushed by a person, the person applies force along the x-axis direction; the direction of the applied force is along the y-axis when moving laterally.
Since the main motion states of the user during walking are forward and turning, the six-axis force sensor is influenced by the forces Fx and Fy in the x and y directions and the torque Mz in the z direction, and only the analog quantities output by the three interfaces are processed in the control program. And filtering noise interference by using a filter function, and determining the x and y directions of the robot and the turning direction target speed according to the magnitudes of the three quantities of Fx, Fy and Mz through a mechanical admittance equation. Then, the target speed of each driving wheel is calculated through the inverse kinematics of the robot, and then the speed of each wheel is controlled, so that the movement speed and direction of the robot are controlled according to the force applied by a user, and the aim of assisting the user in walking is fulfilled.
When a user pushes the walking-aid robot to walk, the hips, knees and ankles on two sides are all provided with gait sensors. By means of pattern recognition and signal processing technology, digital signals of angles and angular velocities of the hip, knee and ankle are acquired, and real-time gait information of the user, such as step length, step frequency, vertical/horizontal displacement, balance degree and the like, is formed through processing.
On one hand, according to the force in the advancing direction (x axis) and the left-right direction (y axis) detected by the force sensor and the magnitude of the moment in the vertical direction (z axis), if the detected value is suddenly changed, and if the suddenly changed value exceeds a preset threshold value, the behavior of the user is considered to be abnormal; and on the other hand, the walking safety condition of the user is evaluated based on the data acquired and transmitted by the gait sensor in real time. By comprehensively analyzing the joint state of the multivariable, if the preset abnormal mode is met, the user is judged to slip or fall, the drive link starts an emergency protection mechanism, and the robot is braked and stopped.
The use steps are as follows:
s1, a walking aid robot driving device is arranged, and the robot moves under the drive of a motor;
s2 a handle part at the rear end of the walking-aid robot is provided with a six-axis force sensor, the six-axis force sensor detects the forces Fx, Fy and Mz and the moments Mx, My and Mz in the three directions of x, y and z in a three-dimensional space coordinate system, and the movement purpose of a user is identified according to the forces Fx, Fy and Mz and the moments Mx, My and Mz;
s3 the user installs gait sensors on the hip, knee and ankle of two sides to collect gait data of angle and angular speed of each degree of freedom in real time;
s4, the user pushes the handle part of the walking-aid robot to realize walking movement;
s5, if the user falls down or the like, the driving link of the walking-aid robot automatically starts an emergency protection mechanism to brake and stop the robot.
Claims (5)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110024646.3A CN112847398A (en) | 2021-01-08 | 2021-01-08 | Method for automatically protecting walking aid safety abnormity |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110024646.3A CN112847398A (en) | 2021-01-08 | 2021-01-08 | Method for automatically protecting walking aid safety abnormity |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN112847398A true CN112847398A (en) | 2021-05-28 |
Family
ID=76005592
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110024646.3A Withdrawn CN112847398A (en) | 2021-01-08 | 2021-01-08 | Method for automatically protecting walking aid safety abnormity |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112847398A (en) |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009072839A (en) * | 2007-09-19 | 2009-04-09 | Yaskawa Electric Corp | Biped robot control device and gait control method |
| CN101803988A (en) * | 2010-04-14 | 2010-08-18 | 华中科技大学 | Multifunctional intelligent rehabilitation robot for assisting stand and walk |
| CN102551994A (en) * | 2011-12-20 | 2012-07-11 | 华中科技大学 | Recovery walking aiding robot |
| CN103040586A (en) * | 2012-12-20 | 2013-04-17 | 上海大学 | External skeleton robot for exercising lower limbs and exercise control method thereof |
| CN106730638A (en) * | 2016-12-21 | 2017-05-31 | 华中科技大学 | The control method of the drive lacking healing robot based on reciprocal force identification motion intention |
| CN107693314A (en) * | 2017-08-02 | 2018-02-16 | 华中科技大学 | A kind of cane formula, which is independently fallen, protects recovery walking aiding robot |
| CN108415250A (en) * | 2018-02-09 | 2018-08-17 | 西安交通大学 | A kind of man-machine coordination control system and its control method for preventing the elderly from falling down |
| CN109079763A (en) * | 2018-10-29 | 2018-12-25 | 河北工业大学 | The wearable flexible assistant to walking robot control system of one kind and control method |
| CN109568089A (en) * | 2019-01-24 | 2019-04-05 | 中国科学技术大学 | A kind of trailing type lower limb recovery robot by training paces system |
| CN111611887A (en) * | 2020-05-08 | 2020-09-01 | 武汉工程大学 | A method and system for estimating user intent in human-machine hybrid coordinated motion |
| CN111967366A (en) * | 2020-08-12 | 2020-11-20 | 华中科技大学鄂州工业技术研究院 | Method for evaluating rehabilitation condition of leg patient and walking-aid robot |
-
2021
- 2021-01-08 CN CN202110024646.3A patent/CN112847398A/en not_active Withdrawn
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009072839A (en) * | 2007-09-19 | 2009-04-09 | Yaskawa Electric Corp | Biped robot control device and gait control method |
| CN101803988A (en) * | 2010-04-14 | 2010-08-18 | 华中科技大学 | Multifunctional intelligent rehabilitation robot for assisting stand and walk |
| CN102551994A (en) * | 2011-12-20 | 2012-07-11 | 华中科技大学 | Recovery walking aiding robot |
| CN103040586A (en) * | 2012-12-20 | 2013-04-17 | 上海大学 | External skeleton robot for exercising lower limbs and exercise control method thereof |
| CN106730638A (en) * | 2016-12-21 | 2017-05-31 | 华中科技大学 | The control method of the drive lacking healing robot based on reciprocal force identification motion intention |
| CN107693314A (en) * | 2017-08-02 | 2018-02-16 | 华中科技大学 | A kind of cane formula, which is independently fallen, protects recovery walking aiding robot |
| CN108415250A (en) * | 2018-02-09 | 2018-08-17 | 西安交通大学 | A kind of man-machine coordination control system and its control method for preventing the elderly from falling down |
| CN109079763A (en) * | 2018-10-29 | 2018-12-25 | 河北工业大学 | The wearable flexible assistant to walking robot control system of one kind and control method |
| CN109568089A (en) * | 2019-01-24 | 2019-04-05 | 中国科学技术大学 | A kind of trailing type lower limb recovery robot by training paces system |
| CN111611887A (en) * | 2020-05-08 | 2020-09-01 | 武汉工程大学 | A method and system for estimating user intent in human-machine hybrid coordinated motion |
| CN111967366A (en) * | 2020-08-12 | 2020-11-20 | 华中科技大学鄂州工业技术研究院 | Method for evaluating rehabilitation condition of leg patient and walking-aid robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Trkov et al. | Inertial sensor-based slip detection in human walking | |
| Gao et al. | IMU-based locomotion mode identification for transtibial prostheses, orthoses, and exoskeletons | |
| Kiguchi et al. | An exoskeletal robot for human elbow motion support-sensor fusion, adaptation, and control | |
| Zhou et al. | Kinematics-based control of an inflatable soft wearable robot for assisting the shoulder of industrial workers | |
| CN107943021B (en) | Self-adaptive stair ascending and descending control system and method | |
| CN113043248B (en) | Transportation and assembly whole-body exoskeleton system based on multi-source sensor and control method | |
| Kyeong et al. | Surface electromyography characteristics for motion intention recognition and implementation issues in lower-limb exoskeletons | |
| CN106726340A (en) | A kind of human body lower limbs recovery exercising robot of intelligent and safe protection | |
| Chen et al. | A robotic bipedal model for human walking with slips | |
| CN102837752A (en) | Six-foot obstacle crossing robot with limb self-cutting function and control system thereof | |
| Hayashi et al. | A lower-limb power-assist robot with perception-assist | |
| Gong et al. | BPNN-based real-time recognition of locomotion modes for an active pelvis orthosis with different assistive strategies | |
| Ji et al. | Design and control of an omni-directional robotic walker based on human–machine interaction | |
| US12127841B2 (en) | Upper limb multi-joint impedance measurement method and apparatus using the same | |
| CN109199800B (en) | Rehabilitation robot and tumble detection and protection method thereof | |
| Long et al. | Physical human-robot interaction estimation based control scheme for a hydraulically actuated exoskeleton designed for power amplification | |
| CN112847398A (en) | Method for automatically protecting walking aid safety abnormity | |
| Lee et al. | Estimation of walking behavior using accelerometers in gait rehabilitation | |
| Khan et al. | Pathological gait abnormality detection and segmentation by processing the hip joints motion data to support mobile gait rehabilitation | |
| JP4130739B2 (en) | Method for estimating floor reaction force of bipedal moving objects | |
| Bae et al. | Real-time estimation of lower extremity joint torques in normal gait | |
| Kiguchi et al. | Accident prediction based on motion data for perception-assist with a power-assist robot | |
| Xu et al. | Multi-sensor based human motion intention recognition algorithm for walking-aid robot | |
| CN116265200B (en) | A control method for automatic gait adjustment in the event of a stumbling exoskeleton | |
| Bae et al. | Design Of A Control System For A Lower-Limb Exoskeleton Rehabilitation Robot With Gait Phase Detection Algorithm Using Inertial Sensor |
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 | ||
| WW01 | Invention patent application withdrawn after publication |
Application publication date: 20210528 |
|
| WW01 | Invention patent application withdrawn after publication |