KR101476507B1 - Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same - Google Patents
Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same Download PDFInfo
- Publication number
- KR101476507B1 KR101476507B1 KR1020120132642A KR20120132642A KR101476507B1 KR 101476507 B1 KR101476507 B1 KR 101476507B1 KR 1020120132642 A KR1020120132642 A KR 1020120132642A KR 20120132642 A KR20120132642 A KR 20120132642A KR 101476507 B1 KR101476507 B1 KR 101476507B1
- Authority
- KR
- South Korea
- Prior art keywords
- wheelchair
- wheel
- torque
- motor
- speed
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G5/00—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs
- A61G5/04—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs motor-driven
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K7/00—Disposition of motor in, or adjacent to, traction wheel
- B60K7/0007—Disposition of motor in, or adjacent to, traction wheel the motor being electric
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2200/00—Type of vehicles
- B60L2200/34—Wheel chairs
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/421—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/423—Torque
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/80—Other vehicles not covered by groups B60Y2200/10 - B60Y2200/60
- B60Y2200/84—Wheelchairs
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2400/00—Special features of vehicle units
- B60Y2400/30—Sensors
- B60Y2400/303—Speed sensors
- B60Y2400/3032—Wheel speed sensors
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Animal Behavior & Ethology (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Power Engineering (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Rehabilitation Tools (AREA)
Abstract
사용자의 상지근력에 맞게 부하를 설정하여 운용할 수 있고, 이동경로가 오르막길이건 내리막길이건 상관없이, 평평한 도로에서 이동하는 것과 같이 휠체어를 운용할 수 있는 부하선택형 보조동력 휠체어가 개시된다. 상기 보조동력 휠체어는 바퀴의 회전속도를 측정하기 위한 회전속도 측정수단, 모터에 걸리는 토크를 측정하기 위한 모터토크 측정수단 및 회전속도 측정수단으로부터 인가되는 바퀴의 회전속도에 대한 정보와 모터토크 측정수단으로부터 인가되는 모터에 걸리는 모터토크에 대한 정보로부터 사용자가 핸드 림에 가한 사용자토크를 추정하고 추정된 사용자토크에 따른 목표속도를 산출하여 바퀴의 회전속도가 목표속도를 추종하도록 모터를 제어하는 모터제어수단을 포함하는 구성을 가진다.A load-selective auxiliary power wheelchair capable of operating a load according to a user's upper limb strength and capable of operating the wheelchair as if traveling on a flat road regardless of an ascending or descending path. The auxiliary power wheelchair includes rotational speed measuring means for measuring the rotational speed of the wheel, motor torque measuring means for measuring torque applied to the motor, and information on the rotational speed of the wheel applied from the rotational speed measuring means, A motor control for estimating a user torque applied to the hand rim by the user based on the information on the motor torque applied to the motor and calculating the target speed according to the estimated user torque to control the motor so that the rotational speed of the wheel follows the target speed And means.
Description
본 발명은 휠체어에 관련된 것으로, 특히 동력보조 휠체어에 관련된 것이다. 일반적으로, 휠체어는 수동형과 전동형으로 분류된다. 수동형 휠체어는 사용자가 직접 바퀴를 손으로 굴려가며 사용하기 때문에 경사지에서 운행하거나 먼 거리를 운행 시 상지근력에 무리를 줄 수 있다. 전동형 휠체어는 상지근력을 잃거나 상지근력이 저하되어 수동형 휠체어를 구동하기 힘든 장애인이 주로 사용하며 조이스틱을 이용하여 모터를 구동시켜 휠체어를 운행하므로 장기간 사용 시 휠체어 사용자의 상지근력이 약화될 수 있다. 이에 따라 경사지에서 운행하거나 먼 거리를 운행 시에도 상지근력에 무리를 주지 않고 휠체어 운행 시 사용자가 근력을 사용할 수 있도록 함으로써 재활에 도움을 줄 수 있는 동력보조 휠체어가 필요하다.The present invention relates to a wheelchair, and more particularly to a power assisted wheelchair. Generally, wheelchairs are classified as passive and motorized. Passive wheelchairs are used by the user by manually rolling the wheels, which can impair the upper limb muscles when traveling on a slope or when traveling a long distance. The motorized wheelchair is mainly used by persons with disabilities who are unable to drive a passive wheelchair due to the loss of upper limb muscular strength or lowering of upper limb muscular strength. Since the motor is driven by a joystick, the upper limb muscular strength of the wheelchair user may be weakened . Accordingly, it is necessary to provide a power assisted wheelchair which can assist the user in rehabilitation by allowing the user to use the strength in the wheelchair operation without imposing a sufficient force on the upper limb muscles even when operating on a slope or a long distance.
이용자가 수동으로 휠체어의 바퀴를 회전시키기 위해서 핸드 림(hand rim)을 잡고 힘을 가하면, 센서부에서 핸드 림에 가해진 힘을 측정하여 정보를 생성하고, 제어부가 센서부에서 생성된 정보에 따라 모터를 제어하여 바퀴의 회전속도를 제어하는 전동휠체어가 공개번호 10-2012-0096633호(발명의 명칭: 파워어시스트 장치 및 이를 이용한 파워어시스트 전동휠체어, 발명자: 공정식, 이하 "선출원 발명"이라 함)의 공개특허공보에 개시되어 있다.When a user manually grasps a hand rim to rotate a wheel of the wheelchair and applies a force, the sensor unit measures the force applied to the hand rim to generate information, and the control unit controls the motor The electric wheelchair for controlling the rotation speed of the wheel is disclosed in Patent Publication No. 10-2012-0096633 entitled Power assist device and power assist electric wheelchair using the same, inventor: process formula, hereinafter referred to as " And is disclosed in the published patent publication.
상기와 같은 선출원 발명의 파워어시스트 전동휠체어는 핸드 림에 가해진 힘을 측정하기 위한 힘측정 센서를 갖는 힘측정 모듈이 필요하고, 또한 이들을 휠체어의 바퀴에 여러 개 설치하여야 하는 문제점이 있다.The power assist electric wheelchair according to the above-described invention requires a force measuring module having a force measuring sensor for measuring the force applied to the hand rim, and a plurality of such force measuring modules must be installed on the wheel of the wheelchair.
특히, 휠체어 사용자는 휠체어를 타고 이동 시 오르막 경사지를 만나면 평지에서보다 큰 힘으로 핸드 림에 힘을 가하게 된다. 그런데, 선출원 발명의 파워어시스트 전동휠체어는 측정모듈에서 큰 힘이 감지되면 모터의 회전수를 오히려 낮추게 되어 있으므로 오르막 경사지에서 사용하기에 적합하지 않다.In particular, a wheelchair user, when riding in a wheelchair, encounters an uphill slope, which exerts a greater force on the ground than on the ground. However, the power assist electric wheelchair of the prior invention is not suitable for use in ascending slopes since the number of revolutions of the motor is lowered when a large force is sensed by the measuring module.
또한, 내리막 경사지를 만나는 경우, 휠체어 사용자는 평지에서보다 작은 힘으로 핸드 림에 힘을 가하게 되는 데, 선출원 발명의 파워어시스트 전동휠체어는 측정모듈에서 작은 힘이 감지되면 모터의 회전수를 오히려 높이게 되어 있으므로 내리막 경사지에서 사용하기에도 적합하지 않다.In addition, when the downhill slope is encountered, the user of the wheelchair applies a force to the hand rim with a smaller force in the flat area. In the power assist electric wheelchair of the prior invention, the rotation number of the motor is increased Therefore, it is not suitable for use on downhill slopes.
또한, 선출원 발명의 파워어시스트 전동휠체어는 사용자가 핸드 림을 잡는 자세나 위치에 따라 그리고 힘측정모듈에 따라 측정되는 힘에 오차가 생길 수 있는 문제점도 있다.In addition, the power assist electric wheelchair of the prior invention also has a problem in that an error may occur depending on the posture or position of the user holding the hand rim and the force measured according to the force measuring module.
또한, 선출원 발명의 파워어시스트 전동휠체어는 힘이 센 사용자가 사용하던 휠체어를 힘이 약한 사용자가 사용하고자 하는 경우 또는 그 반대의 경우에는 힘측정 센서를 새로운 사용자에 맞추어 교체 설치하여야 하는 경우도 발생될 수 있다.In addition, the power assist electric wheelchair of the prior invention may be used when a weak user wants to use a wheelchair used by a strong user, or vice versa, when the force sensor needs to be replaced with a new user .
본 발명의 목적은 선출원 발명에서와 같은 힘측정 모듈 없이 그리고 값비싼 토크 센서 없이도 사용자가 원하는 속도로 휠체어를 운행할 수 있는 휠체어 제어방법을 제공하는 데 있다.It is an object of the present invention to provide a wheelchair control method capable of operating a wheelchair at a desired speed without a force measuring module as in the prior invention and without an expensive torque sensor.
본 발명의 다른 목적은 사용자의 재활에 도움이 되도록 원하는 속도로 이동하기 위해 사용자가 바퀴에 가해야되는 토크를 원하는 수준으로 조정할 수 있는 부하선택형식의 휠체어 제어방법을 제공하는 데 있다.It is another object of the present invention to provide a wheelchair control method of a load selection type in which a user can adjust a torque to be applied to a wheel to a desired level so as to move at a desired speed to assist a user in rehabilitation.
본 발명의 다른 목적은 휠체어가 이동하는 환경, 예를 들면 오르막 또는 내리막 경사지,에 관계없이 사용자는 평지를 이동하는 것과 같은 힘으로 이동할 수 있는 휠체어 제어방법을 제공하는 데 있다.Another object of the present invention is to provide a wheelchair control method in which a user can move with a force such as moving a flat ground regardless of an environment in which the wheelchair moves, for example, an uphill or downhill slope.
사용자의 재활에 도움이 되도록 원하는 속도로 이동하기 위해 사용자가 바퀴에 가해야되는 토크를 원하는 수준으로 조정할 수 있는 부하선택형식의 휠체어 제어방법을 제공하는 데 있다.The present invention provides a wheelchair control method of a load selection type in which a user can adjust a torque to be applied to a wheel to a desired level so as to move at a desired speed so as to assist a user in rehabilitation.
본 발명의 또 다른 목적은 기존의 수동형 휠체어에서도 쉽게 구현할 수 있는 휠체어 제어방법을 제공하는 데 있다.It is another object of the present invention to provide a wheelchair control method that can be easily implemented even in a conventional passive wheelchair.
본 발명의 또 다른 목적은 본 발명의 방법이 구현된 동력보조 휠체어를 제공하는 데 있다.It is yet another object of the present invention to provide a power assisted wheel chair in which the method of the present invention is implemented.
본 발명에 따른 휠체어 제어방법은 핸드 림이 구비된 바퀴와 상기 바퀴의 회전을 도와주기 위한 모터를 구비하는 휠체어의 운행을 제어하기 위한 휠체어 제어방법에 있어서, 상기 휠체어의 운행기준을 가지는 가상의 휠체어모델을 설정하는 가상모델 설정단계; 이동 중 바퀴에 가해지는 전체 토크 중 모터 토크를 제외한 외란토크를 산출하는 외란토크 산출단계; 상기 산출된 상기 외란토크로부터 사용자가 상기 핸드 림에 가한 사용자토크를 추정하는 사용자토크 추정단계; 상기 추정된 상기 사용자토크에 따라 운행되어야 할 상기 가상의 휠체어모델의 상기 운행기준에 따른 목표속도를 산출하는 목표속도 산출단계; 상기 휠체어의 실제속도를 측정하는 실제속도 측정단계; 및 상기 산출된 상기 목표속도와 상기 측정된 상기 실제속도를 비교하면서 상기 실제속도가 상기 목표속도를 추종하도록 상기 모터의 구동속도를 제어하는 속도제어단계를 포함하는 구성을 가진다.The wheelchair control method according to the present invention is a wheelchair control method for controlling the operation of a wheelchair having a wheel equipped with a hand rim and a motor for helping rotation of the wheel, A virtual model setting step of setting a model; A disturbance torque calculating step of calculating a disturbance torque excluding a motor torque among all the torques applied to the wheels during traveling; A user torque estimation step of estimating a user torque applied to the hand rim by the user from the calculated disturbance torque; A target velocity calculating step of calculating a target velocity according to the driving reference of the virtual wheelchair model to be operated according to the estimated user torque; An actual speed measuring step of measuring an actual speed of the wheelchair; And a speed control step of controlling the driving speed of the motor so that the actual speed follows the target speed while comparing the calculated target speed and the measured actual speed.
이상의 단계는 모두 실시간으로 이루어진다.All of the above steps are performed in real time.
상기 휠체어의 서로 다른 운행기준들을 가지는 복수의 가상의 휠체어모델들을 설정하여 두는 복수가상모델 설정단계를 더 포함하고, 상기 가상모델 설정단계는 상기 복수의 가상의 휠체어모델들 중 상기 휠체어의 사용자에 맞는 하나를 선택하는 것에 의해 이루어지는 것이 바람직하다.Further comprising a plurality of virtual model setting steps for setting a plurality of virtual wheelchair models having different operating standards of the wheelchair, wherein the virtual model setting step includes setting a plurality of virtual wheelchair models corresponding to the users of the wheelchair It is preferable to select one of them.
상기 서로 다른 운행기준들은 수동휠체어의 운동을 동역학적으로 모델링한 모델에서 질량관성모멘트와 점성마찰을 증감하는 것에 의해 상기 휠체어를 이동시키고자 할 때의 상기 바퀴에 걸릴 부하를 달리 적용한 것이 좋다.It is preferable that the different driving criteria apply a load to be applied to the wheel when moving the wheelchair by increasing or decreasing mass inertial moment and viscous friction in a model in which the motion of the manual wheelchair is dynamically modeled.
본 발명에 따른 동력보조 휠체어는 핸드 림이 구비된 바퀴를 구비하는 휠체어본체와 상기 휠체어본체에 설치되어 상기 바퀴의 회전을 도와주기 위한 모터와 전원이 필요한 구성요소로 전원을 공급하기 위한 배터리를 구비하는 동력보조 휠체어에 있어서, 상기 바퀴의 회전속도를 측정하기 위한 회전속도 측정수단; 상기 모터에 걸리는 토크를 측정하기 위한 모터토크 측정수단; 및 상기 회전속도 측정수단으로부터 인가되는 상기 바퀴의 회전속도에 대한 정보와 상기 모터토크 측정수단으로부터 인가되는 상기 모터에 걸리는 모터토크에 대한 정보로부터 사용자가 상기 핸드 림에 가한 사용자토크를 추정하고 상기 추정된 사용자토크에 따른 목표속도를 산출하여 상기 바퀴의 회전속도가 상기 목표속도를 추종하도록 상기 모터를 제어하는 모터제어수단을 포함하는 구성을 가진다.The power assisted wheel chair according to the present invention includes a wheel chair body having a wheel provided with a hand rim, a motor for supporting the rotation of the wheel, and a battery for supplying power to the component, Wherein the power assisted wheel chair comprises: rotation speed measuring means for measuring a rotation speed of the wheel; Motor torque measuring means for measuring a torque applied to the motor; And estimating a user torque applied by the user to the hand rim from the information on the rotational speed of the wheel applied from the rotational speed measuring means and the information on the motor torque applied to the motor applied from the motor torque measuring means, And motor control means for calculating the target speed according to the user torque to control the motor so that the rotational speed of the wheel follows the target speed.
상기 모터제어수단은 상기 휠체어의 운행기준을 가지는 가상의 휠체어모델에 대한 정보와 상기 휠체어의 운행에 필요한 프로그램들에 대한 데이터와 상기 프로그램들의 실행에 필요한 데이터를 저장하고 있는 메모리부; 및 상기 프로그램들을 실행하고 그 결과에 따라 상기 모터의 구동속도를 제어하는 제어부를 구비하여 구성되고,Wherein the motor control means stores information on a virtual wheelchair model having a driving standard of the wheelchair, data on programs necessary for driving the wheelchair, and data necessary for executing the programs; And a control unit for executing the programs and controlling the driving speed of the motor in accordance with the results,
상기 프로그램들은, 상기 제어부로 인가되는 상기 바퀴의 회전속도에 대한 정보와 상기 모터에 걸리는 모터토크에 대한 정보로부터,Wherein the programs include information on a rotational speed of the wheel applied to the control unit and information on a motor torque applied to the motor,
상기 바퀴의 회전속도 변화를 통해 상기 바퀴에 외란토크가 가해지는지를 판단하는 외란토크발생 판단기능, 상기 바퀴에 외란토크가 가해지는 경우 전체 토크로부터 상기 외란토크를 산출하는 외란토크 산출기능, 상기 산출된 상기 외란토크로부터 상기 사용자가 상기 핸드 림에 가한 사용자토크를 추정하는 사용자토크 추정기능, 상기 추정된 상기 사용자토크에 따라 운행되어야 할 상기 가상의 휠체어모델의 상기 운행기준에 따른 목표속도를 산출하는 목표속도 산출기능, 상기 산출된 상기 목표속도를 상기 외란토크가 가해진 후의 상기 바퀴의 속도를 비교하여 상기 바퀴의 속도가 상기 목표속도를 추종하도록 모터의 구동속도를 제어하는 속도제어기능을 수행하는 프로그램들인 것을 특징으로 한다.A disturbance torque generation function for determining whether an external disturbance torque is applied to the wheel through a change in the rotation speed of the wheel, a disturbance torque calculation function for calculating the disturbance torque from the total torque when disturbance torque is applied to the wheel, A user torque estimation function for estimating a user torque applied by the user to the hand rim from the disturbance torque calculated based on the estimated disturbance torque and a target speed based on the driving standard of the virtual wheelchair model to be operated according to the estimated user torque A program for performing a speed control function of controlling the driving speed of the motor so that the speed of the wheel follows the target speed by comparing the calculated target speed with the speed of the wheel after the disturbance torque is applied, Respectively.
상기 모터는 상기 휠체어의 두 바퀴 축 내부에 장착 가능한 인-휠(in-wheel) 교류 서보모터이고, 상기 회전속도 측정수단은 상기 바퀴에 설치되어 상기 바퀴의 각속도를 측정하기 위한 인코더 또는 속도센서이고, 상기 메모리부에는 상기 휠체어의 서로 다른 운행기준을 가지는 복수의 가상의 휠체어모델에 대한 데이터가 저장되어 있고, 사용자가 상기 제어수단에 연결된 선택부를 통해 상기 서로 다른 운행기준들 중 하나를 선택할 수 있도록 된 것이 좋다.The motor is an in-wheel AC servomotor that can be mounted inside two wheel axes of the wheelchair. The rotational speed measuring means is an encoder or a speed sensor installed on the wheel for measuring an angular velocity of the wheel Wherein the memory unit stores data of a plurality of virtual wheelchair models having different driving standards of the wheelchair and allows the user to select one of the different driving criteria through a selection unit connected to the control unit It is good to be.
상기와 같은 본 발명에 따른 휠체어는 바람직하게 기존의 수동용 휠체어와, 이의 두 바퀴의 축에 장착이 가능한 인-휠(in-wheel) 교류 서보 모터, 모터 드라이버(motor driver), 모터의 토크를 측정하기 위한 모터토크 측정수단, 바퀴의 각속도를 측정하기 위한 인코더(encoder) 또는 속도 센서 및 사용자의 재활에 도움이 될 수 있는 부하를 가지는 가상휠체어모델을 1개 이상 설정해 두고 사용자가 바퀴에 가하는 사용자 토크를 추정하여 추정된 사용자 토크에 따라 가상휠체어에서의 목표속도를 산출하고 휠체어의 속도가 이 목표속도를 추종하도록 서보 모터를 구동하기 위한 모터제어신호를 모터 드라이버로 출력하는 모터제어수단으로 이루어져 있다.The wheelchair according to the present invention as described above preferably includes an existing manual wheelchair, an in-wheel AC servomotor that can be mounted on the axle of the two wheels, a motor driver, A motor torque measuring means for measuring a wheel speed, an encoder or a speed sensor for measuring an angular speed of a wheel, and a virtual wheelchair model having a load that can be helpful for a user's rehabilitation, And motor control means for calculating a target speed in a virtual wheelchair in accordance with the estimated user torque and outputting a motor control signal for driving the servo motor so that the speed of the wheelchair follows the target speed .
상기와 같은 본 발명이 구현된 동력보조 휠체어를 이용하는 사용자는 실제 이동 경로의 조건에 상관없이, 즉, 이동경로가 오르막길이건 내리막길이건 상관없이, 평평한 도로에서 이동하는 것과 같이 휠체어를 운용할 수 있다.A user using the power assisted wheel chair embodying the present invention as described above can operate the wheelchair as if moving on a flat road regardless of the condition of the actual moving route, that is, regardless of whether the moving route is an uphill or downhill length .
가상휠체어를 여러 개 설정하는 경우, 사용자에 따라 자신에 적합한 부하를 선정(예를 들면, 사용자가 가하는 동일한 토크에 대해 상대적으로 짧은 거리 이동하는 부하, 중간거리 이동하는 부하, 먼 거리 이동하는 부하를 선택)하여 휠체어를 운용하도록 할 수 있다.When multiple virtual wheelchairs are set, the user can select a load suitable for him / herself (for example, a load that travels a relatively short distance with respect to the same torque applied by the user, a load that moves at a medium distance, And the wheelchair can be operated.
본 발명에 따른 동력보조 휠체어는 사용자의 상지근력의 능력에 따라 부하를 선택할 수 있고, 이는 사용자의 이동을 편리하게 함과 더불어 재활에 도움을 준다.The power assisted wheel chair according to the present invention can select the load according to the ability of the user's upper extremity muscles, which facilitates the movement of the user and helps in rehabilitation.
본 발명에 따르면, 외란을 측정하기 위한 별도의 토크 센서 없이 인코더 또는 속도측정 센서에서 측정된 각속도와 모터토크 측정만으로 휠체어에 가해지는 사용자의 구동토크를 추정할 수 있다.According to the present invention, the driving torque of the user applied to the wheelchair can be estimated only by measuring the angular velocity and the motor torque measured by the encoder or the speed measuring sensor without a separate torque sensor for measuring disturbance.
사용자가 자신의 상지근력의 정도에 따라 가상의 휠체어모델을 통해 적절한 부하를 선택할 수 있어 다양한 사용자의 요구를 만족시킬 수 있다.The user can select the appropriate load through the virtual wheelchair model according to the degree of the upper limb muscle strength of the user, thereby satisfying the needs of various users.
평지를 이동할 때의 수동형 휠체어와 같이 힘을 가하면 속도가 증가하고 힘을 가하지 않으면 속도가 점차 감소하는 경향의 속도곡선을 나타내도록 휠체어의 속도를 제어함으로써 안전성 및 구동 시 사용자가 느끼는 이질감을 최소화 할 수 있다.By controlling the speed of the wheelchair so that the speed increases when the force is applied and the speed gradually decreases when the force is applied, like the passive wheelchair when moving on the flat ground, the safety and the feeling of the user feeling during driving can be minimized have.
본 발명에 따른 휠체어는 수동형 휠체어의 이용이 부담스러운 상지근력이 남아 있는 사용자를 위한 것으로, 전동휠체어를 사용함으로써 발생되는 상지근력 저하를 방지하고자 하는 사용자에게 적합하다. 본 발명에 따른 휠체어를 사용하는 사용자는 본인의 근력에 적합한 부하를 선택할 수 있으므로 이동의 목적뿐만 아니라 사용자의 상지근력을 강화하는 데에도 도움을 준다.The wheelchair according to the present invention is suitable for a user who has a left upper limb muscle force to which a passive wheelchair is liable to use and is intended to prevent a decrease in upper limb muscle strength caused by using an electric wheelchair. The user using the wheelchair according to the present invention can select a load suitable for his or her strength so as to enhance not only the movement but also the upper arm strength of the user.
본 발명에 따른 휠체어는 수동형과 전동형의 중간의 반자동 형태이며, 구동모터로서 인-휠(In-Wheel) 모터를 사용하여 바퀴를 탈부착 할 수 있기 때문에 유지보수가 용이하고 중량이 가벼워 운반과 보관이 용이하다.The wheelchair according to the present invention is a semiautomatic type intermediate between a passive type and a motorized type, and can be detachably attached to the wheel using an in-wheel motor as a driving motor. Therefore, the wheelchair is easy to maintain and light in weight, This is easy.
도 1은 본 발명에 따른 이동과 재활을 위한 부하 선택형 휠체어의 사시도,
도 2는 도 1에 나타낸 휠체어의 분리사시도,
도 3은 본 발명에 따른 휠체어 제어방법의 개념을 설명하기 위한 블록도,
도 4는 본 발명에 따른 모터제어시스템의 블록도,
도 5는 본 발명에 따른 휠체어 제어방법의 과정을 설명하기 위한 순서도,
도 6은 사용자에 적합한 부하선택을 설명하기 위한 그래프,
도 7은 전원을 오프(off)시킨 상태와 전원을 온(on) 시킨 상태에서 바퀴에 동일한 사용자토크를 가했을 때의 시간에 따른 속도변화를 나타낸 응답 그래프이고,
도 8은 시간에 따른 이동거리를 나타낸 응답 그래프이다.1 is a perspective view of a load selective wheelchair for movement and rehabilitation according to the present invention,
Fig. 2 is an exploded perspective view of the wheelchair shown in Fig. 1,
3 is a block diagram for explaining the concept of a wheelchair control method according to the present invention;
4 is a block diagram of a motor control system according to the present invention;
FIG. 5 is a flowchart for explaining a process of a wheelchair control method according to the present invention,
6 is a graph for explaining a load selection suitable for a user,
7 is a response graph showing a change in speed with time when the same user torque is applied to the wheel in a state in which the power is turned off and the power is turned on,
8 is a response graph showing the movement distance with time.
이하, 첨부된 도면을 참조하여 본 발명의 바람직한 실시 예를 상세하게 설명한다.Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings.
도 1은 본 발명에 따른 이동과 재활을 위한 부하 선택형 휠체어의 사시도이고, 도 2는 도 1에 나타낸 휠체어의 분리사시도, 도 3은 본 발명에 따른 휠체어 제어방법의 개념을 설명하기 위한 블록도이고, 도 4는 본 발명에 따른 모터제어시스템의 블록도이다. FIG. 1 is a perspective view of a load selectable wheelchair for movement and rehabilitation according to the present invention, FIG. 2 is an exploded perspective view of the wheelchair shown in FIG. 1, and FIG. 3 is a block diagram for explaining the concept of a wheelchair control method according to the present invention , Figure 4 is a block diagram of a motor control system according to the present invention.
도 1과 2에는 본 발명에 따른 휠체어(100)가 도시되어 있다. 이 휠체어(100)는 핸드 림(111a)이 설치된 바퀴(111)를 가지는 휠체어본체(110)를 구비하고 있다. 이 휠체어본체(110)의 형태는 기존의 수동형 휠체어에서와 같다. 휠체어본체(110)는 프레임(113)과 프레임(113)에 설치된 바퀴(111)를 구비한다. 바퀴(111)는 2개가 휠체어본체(113)의 좌우 양측에 축(115)을 통해 회전 가능케 설치되어 있다. 그리고 두 바퀴(111) 앞쪽의 프레임(113)에 보조바퀴(117)가 각각 설치되어 있다. 보조바퀴(117)는 프레임(113)에 수평방향으로 회동 가능케 설치되어 있다. 1 and 2 show a
휠체어본체(110)의 바퀴(111)에는 모터(120)가 설치되어 있다. 이 모터(120)로는 바퀴(111)의 축(115)에 설치될 수 있는 인-휠 모터로서 교류 서보 모터인 것이 바람직하다. 모터(120)는 바퀴(111)를 회전시킬 수 있으면 되므로, 반드시 인-휠 모터이어야 하는 것은 아니다. 이 모터(120)는 휠체어(100) 사용자가 바퀴(111)에 가하는 힘에 더하여 바퀴(111)를 회전시키는 것을 도와주기 위한 보조동력을 제공하기 위한 것이다.A
도 3과 4를 함께 더 참조하면, 본 발명에 따른 휠체어(100)는 모터제어시스템(130)을 구비한다. 모터제어시스템(130)은 본 발명에 따른 휠체어 제어방법에 따라 모터(120)의 구동을 제어하는 부분으로서, 모터(120)에 걸리는 모터토크(Tm)를 측정하기 위한 모터토크 측정수단(131)과 실제 휠체어(100)의 속도 즉, 바퀴(111)의 각속도(ω)를 측정하기 위한 바퀴속도 측정수단(132) 및 모터토크 측정수단(131)과 바퀴속도 측정수단(132)으로부터 인가된 정보를 토대로 모터제어신호를 생성하는 모터제어수단(140)을 구비한다.3 and 4 together, the
모터토크 측정수단(131)은 모터(120)의 축에 토크센서를 장착하여 직접 측정하는 형태이거나, 모터(120)의 코일에 흐르는 전류를 측정하여 계산에 의해 간접적으로 측정하는 방식일 수 있다.The motor torque measuring means 131 may be a type in which a torque sensor is mounted on the shaft of the
이 실시예에 따른 본 발명의 휠체어(100)는 바퀴속도 측정수단(132)으로서 바람직하게 바퀴(111)의 축(115)에 설치된 인코더를 구비한다. 이 인코더는 바퀴(111)의 각속도를 측정하여 모터제어수단(140)으로 제공하는 역할을 한다. 인코더 대신 속도센서가 이용될 수 있다.The
상기와 같은, 본 발명에 따른 동력보조 휠체어(100)에서, 바퀴(111)의 회전각도를 θ라고 하면, 바퀴(111) 하나에 대한 운동방정식은 (J + MR2) + B = Th + Tm - Tf --- (식 1)로 나타낼 수 있다.In the power assisted
여기서 J: 바퀴 하나의 회전관성, R: 바퀴의 반경, M: 사용자와 휠체어 질량의 절반, B: 바퀴의 점성마찰계수, Th: 사용자가 바퀴에 가하는 토크, Tm: 모터가 바퀴에 전달하는 토크, Tf: 마찰 토크이다.Wherein J: wheel a rotational inertia, R: radius of the wheels, M: a half of the user and the wheelchair by mass, B: viscous friction coefficient of the wheel, T h: torque user and applied to the wheel, T m: the motor is transmitted to the wheels And Tf is the friction torque.
모터제어수단(140)은 바퀴속도 측정수단(132)으로부터 인가되는 바퀴(111)의 회전속도 즉, 바퀴의 각속도(ω)에 대한 정보와 모터토크 측정수단(131)으로부터 인가되는 모터(120)에 걸리는 모터토크(Tm)에 대한 정보로부터 사용자가 핸드 림(111a)에 가한 사용자토크를 추정하고 추정된 사용자토크에 따른 목표속도를 산출하여 바퀴(111)의 회전속도가 목표속도(ωd)를 추종하도록 모터(120)를 제어하는 기능을 한다.The motor control means 140 receives information on the rotational speed of the
이러한 모터제어수단(140)의 기능은 컴퓨터에 설치된 프로그램을 통해 이루어진다. 더 자세하게 설명하면, 모터제어수단(140)은 메모리부(141)를 구비한다. 메모리부(141)에는 휠체어의 운행기준을 가지는 가상의 휠체어모델에 대한 정보(142), 상기 휠체어(100)의 운행에 필요한, 제어부(145)에서 실행되는 각종 기능을 가지는 프로그램들에 대한 데이터와 프로그램들의 실행에 필요한, 휠체어 운행에 관한 프로그램 및 관련 데이터(143), 및 기타(144)의 데이터가 저장되어 있다.The function of the motor control means 140 is achieved through a program installed in the computer. More specifically, the motor control means 140 includes a
모터제어수단(140)은 상기 프로그램들을 실행하여 모터의 구동을 제어하기 위한 제어부(145)를 구비한다. 이 제어부(145)에는 사용자가 자신에 맞는 가상의 휠체어모델(100a)을 선택할 수 있도록 하는 선택부(160)가 연결되어 있다.The
제어부(145)에서 실행되는 프로그램은 제어부(145)로 인가되는 바퀴(111)의 회전속도에 대한 정보와 모터(120)에 걸리는 모터토크에 대한 정보를 이용하여 다음과 같은 다양한 기능들을 수행하는 모듈들로서, 이들의 기능을 설명하면 다음과 같은 것이 있다.The program executed in the
외란토크발생 판단모듈(146)은 바퀴속도 측정수단(132)으로부터 인가되는 바퀴(111)의 회전속도 변화를 통해 바퀴(111)에 외란토크(Td)가 가해지는지를 판단한다. 이는 바퀴의 속도변화의 크기로부터 알 수 있다. 즉, 속도변화가 일정 이상인 경우, 외란토크가 발생한 것으로 판단할 수 있다.The disturbance torque
본 발명에서는, 외부로부터 바퀴(111)에 가해지는 외란토크를 측정할 필요가 있다. 바퀴에 토크 센서를 설치하면 외부로부터 가해지는 힘을 쉽게 얻을 수 있지만, 가격이 비싸지고 외부적인 하드웨어의 추가가 필요에 복잡해지는 단점이 있다. 본 발명에서는 바람직하게, 모터의 토크(Tm)와 휠체어속도(또는 바퀴의 각속도(ω))를 이용해 수학적 연산과정을 통해 외란토크를 산출한다. 이러한 기능을 수행하기 위한 것이 외란토크 산출모듈(147)이다.In the present invention, it is necessary to measure the disturbance torque exerted on the
외란토크 산출모듈(147)은 바퀴(111)의 각속도(ω)와 측정된 모터의 토크(Tm)를 이용한 1-차 저역필터 구조의 외란관측기를 이용하여 외란토크( )를 산출한다.The disturbance
사용자 구동토크 추정모듈(148)은 산출된 외란토크( )로부터 사용자가 핸드 림(111a)에 가한 사용자토크(Th)를 추정하는 사용자토크 추정기능을 수행한다. 수동 휠체어와 같은 구동을 위해 관측된 외란으로부터 사용자토크(Th)를 추출해야 한다.The user drive
사용자가 바퀴(111)에 가한 사용자토크(Th)의 추출을 수행하기 위해 사람이 바퀴에 가하는 토크의 특성을 파악하고 이에 부합하는 신호만을 분별한다.The user grasps the characteristics of the torque applied to the wheel by the user to perform the extraction of the user torque T h applied to the
사람이 휠체어에 가하는 토크 사용자토크(Th)는 급격하고 빠른 변화를 주는 특징을 가진다. 반면에 바퀴에 작용하는 마찰토크, 길의 상태(경사면, 울퉁불퉁한 길, 흙 길)에 따른 토크는 상대적으로 느리게 변화하는 토크이다. 이와 같은 특징을 적용하여 산출된 외란토크( )를 = m(t) + Th(t)---(식 2)를 이용해 나타낸다.The torque user torque (T h ) that a person applies to a wheelchair is characterized by rapid and rapid changes. On the other hand, the torque according to the friction torque acting on the wheel, the state of the road (slope, rugged road, dirt road) is a relatively slowly changing torque. The disturbance torque calculated by applying such a characteristic ( ) = m (t) + T h (t) - (Equation 2).
여기서 m(t)는 일정하거나 천천히 변하는 외란토크이다.Where m (t) is a constant or slowly varying disturbance torque.
따라서 Th(t) = - m(t) --- (식 3)이고,Therefore, T h (t) = - m (t) - (Equation 3)
식 3에서 m(t)은 일정하거나 천천히 변하는 외란토크이므로 다음 식 4에 의해 매 샘플링 순간마다 갱신하여 구할 수 있다.Since m (t) in Equation 3 is a constant or slowly varying disturbance torque, it can be obtained by updating each sampling instant by the following Expression (4).
m(k+1) = m(k) + μ(k)· --- (식 4)m (k + 1) = m (k) + mu (k) --- (Equation 4)
식 4는 기본적으로 적분의 특성을 갖는 적응형 필터이며, 계수 μ(k)는 적분을 수행하는 과정에서 에 대한 가중치를 나타낸다. 사용자가 가하는 토크(Th)는 크기가 크고 빠른 변화를 보이며, 상대적으로 짧은 시간 동안 가해지는 특징이 있으므로, 가 일정 기준보다 크기나 변화율이 클 경우 에는 사용자가 가하는 토크(Th)가 외란 토크 m(k)에 비해 큰 비중을 차지하며, 그 외의 경우에는 에 외란 토크 m(k)가 사용자가 가하는 토크(Th) 보다 큰 비중을 차지하게 된다. 이러한 특징을 적용하여, 의 크기나 변화율이 클 경우 식 4의 외란토크 m(k)의 갱신에서 가중치 μ(k)를 작은 값으로 하고, 반대로 의 크기나 변화율이 작을 경우 가중치 μ(k)를 큰 값으로 하여 외란토크 m(k)를 갱신하게 된다. 결정된 m(k+1)을 이용하여 식 3에서 이러한 적응형 필터를 사용함으로써 에서 사용자가 가하는 토크(Th)를 결정하게 된다.Equation (4) is basically an adaptive filter having the characteristic of integration, and the coefficient mu (k) ≪ / RTI > Since the torque applied by the user (T h ) is large in size and exhibits a rapid change and is applied for a relatively short time, Is larger than a certain standard or the rate of change is large The torque T h applied by the user takes a larger weight than the disturbance torque m (k), and in other cases The disturbance torque m (k) occupies a larger proportion than the torque T h applied by the user. By applying this feature, (K) in the update of the disturbance torque m (k) of the equation (4) is made small when the magnitude or rate of change of the disturbance torque m (K) is set to a large value when the magnitude and rate of change of the disturbance torque m (k) are small. By using this adaptive filter in Equation 3 using the determined m (k + 1) The torque T h applied by the user is determined.
추정된 사용자토크(Th)에 대한 정보는 가상의 휠체어모델(100a)에 대한 목표속도 산출모듈(149)로 인가되고, 가상의 휠체어모델(100a)에 대한 목표속도 산출모듈(149)은 추정된 사용자토크(Th)에 따라 운행되어야 할 가상의 휠체어모델(100a)의 운행기준에 따른 목표속도(ωd)를 산출하여 속도제어기(150)로 보낸다. 속도제어기(150)는 산출된 목표속도(ωd)를 실제 휠체어(100)의 바퀴(111)의 속도(ω)와 비교하여 바퀴(111)의 속도(ω)가 목표속도(ωd)를 추종하도록 모터(120)의 구동속도를 제어하는 속도제어기능을 수행한다.Information about the estimated user torque T h is applied to the target
그 외에 본 발명에 따른 휠체어(100)는 모터(120), 모터토크 측정수단(131), 바퀴속도 측정수단(132), 모터제어시스템(140) 등 전원이 필요한 구성요소로 전원을 공급하기 위한 배터리(152)를 구비한다.In addition, the
도 5는 본 발명에 따른 휠체어 제어방법의 과정을 설명하기 위한 순서도이다.5 is a flowchart illustrating a process of a wheelchair control method according to the present invention.
도 1 내지 4를 함께 참조하여 설명한다.1 to 4 together.
먼저, 수동형 휠체어를 이용하여 상지근력에 차이가 있는 복수의 사용자에게 각각 맞는 복수의 가상휠체어모델(100a)을 선정하여 관련 프로그램과 데이터를 모터제어시스템(130)의 메모리부(141)에 저장해두고, 이들 중 사용자의 선택(S1)에 의해 자신에 맞는 것을 하나 선정하여 사용자 자신에 맞는 가상휠체어모델(100a)을 모터제어수단(140)에 설정해둔다(S2). 이 가상휠체어모델(100a)들은 각각의 운행기준을 가진다. 물론, 어떤 경우에는 가장 많은 수의 사용자가 있을 것으로 예상되는 1개의 가상휠체어모델(100a)에 대한 것만을 미리 설정해둘 수 있다.First, a plurality of
휠체어(100)를 운행 중에 외란토크발생 판단모듈(146)이 바퀴(111)의 속도변화를 지속적으로 감시하면서 바퀴(111)에 외란토크가 가해지는 지를 판단한다(S3).During operation of the
바퀴(111)에 외란토크가 가해진 것으로 판단되면, 외란토크 산출모듈(147)은 모터(120)의 토크와 바퀴(111)의 각속도 정보를 이용한 1차 저역필터 구조의 외란관측기로부터 외란토크를 산출한다(S4).The disturbance
사용자 구동토크 추정모듈(148)은 산출된 외란토크로부터 (식 2) ~ (식 4)를 이용하여 사용자가 핸드 림(111a)에 가한 사용자토크를 추정한다(S5).The user drive
목표속도 산출모듈(149)은 추정된 사용자토크에 따라 가상휠체어모델(100a)의 운행기준에 따른 가상휠체어모델(100a)의 목표속도를 산출한다(S6).The target
한편, 외란토크가 가해진 후의 휠체어(100)의 실제속도는 바퀴속도 측정수단(132)에서 지속적으로 측정하여 속도제어기(150)로 계속 인가되도록 한다(S7).On the other hand, the actual speed of the
이에 따라 속도제어기(150)는 산출된 가상휠체어모델(100a)의 목표속도(ωd)와 측정된 휠체어(100)의 실제속도(ω)를 비교하면서(S9) 실제속도(ω)가 목표속도(ωd)를 추종하도록 모터(120)의 구동속도를 증가 또는 감소되도록 제어한다(S9).The
S4~S9은 모터제어시스템(140)을 종료할 때까지 실시간으로 계속 수행한다.S4 to S9 continue in real time until the
도 6은 사용자에 적합한 부하선택을 설명하기 위한 그래프이다.6 is a graph for explaining load selection suitable for a user.
앞의 도 1 내지 4를 함께 참조하면, 본 발명에서는, 수동휠체어의 운동을 동역학적으로 모델링하여 앞에서 설명한 바와 같은 1이상의 가상의 휠체어모델(100a)을 만들고 실제휠체어(100) 사용자가 선택한 가상의 휠체어모델(100a)을 추종하도록 하였다. 이에 따라 사용자가 선택한 가상의 휠체어모델(100a)에 따라 실체의 휠체어(100)에서 사용자가 느끼는 부하는 달라진다.1 to 4, kinematics of the manual wheelchair may be dynamically modeled to create at least one
상기와 같은 가상의 휠체어모델(100a)에서, 사용자는 실제휠체어(100)와는 독립적으로 자신의 근력에 적절한 부하모델 파라미터인 질량관성모멘트 JR과 점성마찰 BR의 값을 정할 수 있다. 즉, 도 5에 나타낸 바와 같이, JR과 BR을 실제 값에 비해 작은 값을 선정하면 더 작은 질량과 점성마찰을 가정하므로, 바퀴의 각속도 W(rad/sec)가 커져 동일한 토크에 의해 더 먼 거리를 이동할 수 있으며, 반대로 더 큰 값을 선정하면 바퀴의 각속도 W(rad/sec)가 작아져 더 짧은 거리를 이동하게 된다. 이 가상의 휠체어모델에 사용자가 가한 토크를 가할 때 나타나는 이동속도를 실제 휠체어가 추종하도록 속도제어기(150)가 작동된다. 이와 같은 개념을 통해서 가상의 휠체어모델(100a)의 (JR, BR)의 크기를 변화시켜 사용자의 신체적 특성(상지근 발달 정도)을 고려해 사용자의 운동량을 선택할 수 있다.In the
도 7은 전원을 오프(off)시킨 상태와 전원을 온(on) 시킨 상태에서 바퀴에 동일한 사용자토크를 가했을 때의 시간에 따른 속도변화를 나타낸 응답 그래프이고, 도 8은 시간에 따른 이동거리를 나타낸 응답 그래프이다.FIG. 7 is a response graph showing a change in speed with time when the same user torque is applied to the wheel in a state in which the power is turned off and the power is turned on. FIG. Fig.
도 7을 참조하면, 본 발명에 따른 모터제어시스템(130)이 작동되지 않는 경우에는 모터의 동력을 지원받을 수 없기 때문에 휠체어(100)의 속도 즉, 바퀴의 각속도 W(rad/sec)가 급격히 줄어들고, 토크를 가한 후 약 10초 정도로 빠른 시간 내에 휠체어가 멈추지만, 본 발명에 따른 모터제어시스템(130)이 작동되고 있는 경우에는 모터제어시스템(130)에 의해 제어되는 모터의 동력을 지원 받을 수 있어 휠체어의 속도 즉, 바퀴의 각속도 W(rad/sec)가 서서히 줄어들고, 휠체어가 25초 정도 지난 후에 천천히 멈춘다는 것을 알 수 있다.Referring to FIG. 7, when the motor control system 130 according to the present invention is not operated, since the power of the motor can not be supported, the speed of the
도 8을 참조하면, 본 발명에 따른 모터제어시스템(130)이 작동되지 않는 경우에는 2.41m 진행된 후 멈추었지만, 본 발명에 따른 모터제어시스템(130)이 작동되고 있는 경우에는 약 7.08m 진행 후에 멈추었다.Referring to FIG. 8, when the motor control system 130 according to the present invention is not operated, the motor control system 130 stops after advancing 2.41 meters. However, when the motor control system 130 according to the present invention is operated, I stopped.
이 결과는 본 제어시스템 성능을 설명하기 위한 하나의 예이다.This result is an example for explaining the performance of the present control system.
본 발명은 사용자가 가하는 힘의 크기에 따라 휠체어의 속도를 제어하여 운행되도록 하는 동력보조 휠체어를 만드는 데 적합하게 이용될 가능성이 있다. The present invention may be suitably used to create a power assisted wheel chair that controls the speed of the wheel chair according to the magnitude of the force applied by the user.
100: 휠체어 100a: 가상휠체어모델
110: 휠체어본체 111: 바퀴
111a: 바퀴 림 115: 바퀴 축
120: 모터 130: 모터제어시스템
131: 모터토크 측정수단 132: 바퀴속도 측정수단
140: 모터제어수단 146: 외란토크발생 판단모듈
147: 외란토크 산출모듈 148: 사용자 구동토크 추정모듈
149: 목표속도 산출모듈 150: 속도제어기100:
110: wheelchair body 111: wheel
111a: wheel rim 115: wheel axle
120: motor 130: motor control system
131: Motor torque measuring means 132: Wheel speed measuring means
140: motor control means 146: disturbance torque occurrence determination module
147 Disturbance torque calculation module 148: User driving torque estimation module
149: target speed calculation module 150: speed controller
Claims (6)
상기 휠체어의 운행기준을 가지는 가상의 휠체어모델을 설정하는 가상모델 설정단계;
상기 바퀴에 외란토크가 가해지면 측정된 모터토크와 측정된 상기 바퀴의 각속도 정보로부터 상기 외란토크를 산출하는 외란토크 산출단계;
상기 산출된 상기 외란토크로부터 사용자가 상기 핸드 림에 가한 사용자토크를 추정하는 사용자토크 추정단계;
상기 추정된 상기 사용자토크에 따라 운행되어야 할 상기 가상의 휠체어모델의 상기 운행기준에 따른 목표속도를 산출하는 목표속도 산출단계;
상기 외란토크가 가해진 후의 상기 휠체어의 실제속도를 측정하는 실제속도 측정단계; 및
상기 산출된 상기 목표속도와 상기 측정된 상기 실제속도를 비교하면서 상기 실제속도가 상기 목표속도를 추종하도록 상기 모터의 구동속도를 제어하는 속도제어단계를 포함하는 것을 특징으로 하는 휠체어 제어방법.A wheelchair control method for controlling the operation of a wheelchair having a wheel equipped with a hand rim and a motor for assisting rotation of the wheel,
A virtual model setting step of setting a virtual wheelchair model having a driving standard of the wheelchair;
A disturbance torque calculating step of calculating the disturbance torque from the measured motor torque and the angular velocity information of the wheel when the disturbance torque is applied to the wheel;
A user torque estimation step of estimating a user torque applied to the hand rim by the user from the calculated disturbance torque;
A target velocity calculating step of calculating a target velocity according to the driving reference of the virtual wheelchair model to be operated according to the estimated user torque;
An actual speed measuring step of measuring an actual speed of the wheel chair after the disturbance torque is applied; And
And a speed control step of controlling the driving speed of the motor so that the actual speed follows the target speed while comparing the calculated target speed and the measured actual speed.
상기 가상모델 설정단계는 상기 복수의 가상의 휠체어모델들 중 상기 휠체어의 사용자에 맞는 하나를 선택하는 것에 의해 이루어지는 것을 특징으로 하는 휠체어 제어방법.2. The method of claim 1, further comprising: setting a plurality of virtual wheelchair models having different driving standards of the wheelchair,
Wherein the virtual model setting step is performed by selecting one of the plurality of virtual wheelchair models corresponding to the user of the wheelchair.
상기 바퀴의 회전속도를 측정하기 위한 회전속도 측정수단;
상기 모터에 걸리는 토크를 측정하기 위한 모터토크 측정수단; 및
상기 회전속도 측정수단으로부터 인가되는 상기 바퀴의 회전속도에 대한 정보와 상기 모터토크 측정수단으로부터 인가되는 상기 모터에 걸리는 모터토크에 대한 정보로부터 사용자가 상기 핸드 림에 가한 사용자토크를 추정하고 추정된 상기 사용자토크에 따른 목표속도를 산출하여 상기 바퀴의 회전속도가 상기 목표속도를 추종하도록 상기 모터를 제어하는 모터제어수단을 포함하는 것을 특징으로 하는 동력보조 휠체어.1. A power assisted wheel chair comprising: a wheel chair body having a wheel provided with a hand rim; a motor for supporting rotation of the wheel; and a battery for supplying power to components necessary for power supply,
Rotation speed measuring means for measuring a rotation speed of the wheel;
Motor torque measuring means for measuring a torque applied to the motor; And
Estimating a user torque applied by the user to the hand rim from the information about the rotational speed of the wheel applied from the rotational speed measuring means and the information about the motor torque applied to the motor applied from the motor torque measuring means, And motor control means for calculating the target speed according to the user's torque and controlling the motor so that the rotational speed of the wheel follows the target speed.
상기 프로그램들을 실행하고 그 결과에 따라 상기 모터의 구동속도를 제어하는 제어부를 구비하여 구성되고,
상기 프로그램들은,
상기 제어부로 인가되는 상기 바퀴의 회전속도에 대한 정보와 상기 모터에 걸리는 모터토크에 대한 정보로부터,
상기 바퀴의 회전속도 변화를 통해 상기 바퀴에 외란토크가 가해지는지를 판단하는 외란토크발생 판단기능, 상기 바퀴에 외란토크가 가해지는 경우 전체 토크로부터 상기 외란토크를 산출하는 외란토크 산출기능, 상기 산출된 상기 외란토크로부터 상기 사용자가 상기 핸드 림에 가한 사용자토크를 추정하는 사용자토크 추정기능, 상기 추정된 상기 사용자토크에 따라 운행되어야 할 상기 가상의 휠체어모델의 상기 운행기준에 따른 목표속도를 산출하는 목표속도 산출기능, 상기 산출된 상기 목표속도를 상기 외란토크가 가해진 후의 상기 바퀴의 속도를 비교하여 상기 바퀴의 속도가 상기 목표속도를 추종하도록 모터의 구동속도를 제어하는 속도제어기능을 수행하는 프로그램들인 것을 특징으로 하는 동력보조 휠체어.5. The apparatus according to claim 4, wherein the motor control means comprises: a memory for storing information on a virtual wheelchair model having a driving standard of the wheelchair, data on programs necessary for driving the wheelchair, part; And
And a control unit for executing the programs and controlling the driving speed of the motor in accordance with the results,
The programs,
From the information about the rotational speed of the wheel applied to the control unit and the information about the motor torque applied to the motor,
A disturbance torque generation function for determining whether an external disturbance torque is applied to the wheel through a change in the rotation speed of the wheel, a disturbance torque calculation function for calculating the disturbance torque from the total torque when disturbance torque is applied to the wheel, A user torque estimation function for estimating a user torque applied by the user to the hand rim from the disturbance torque calculated based on the estimated disturbance torque and a target speed based on the driving standard of the virtual wheelchair model to be operated according to the estimated user torque A program for performing a speed control function of controlling the driving speed of the motor so that the speed of the wheel follows the target speed by comparing the calculated target speed with the speed of the wheel after the disturbance torque is applied, Of the wheelchair.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120132642A KR101476507B1 (en) | 2012-11-21 | 2012-11-21 | Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120132642A KR101476507B1 (en) | 2012-11-21 | 2012-11-21 | Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20140065291A KR20140065291A (en) | 2014-05-29 |
KR101476507B1 true KR101476507B1 (en) | 2014-12-24 |
Family
ID=50892246
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020120132642A KR101476507B1 (en) | 2012-11-21 | 2012-11-21 | Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101476507B1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20240095964A (en) | 2022-12-19 | 2024-06-26 | 인천대학교 산학협력단 | Method and apparatus for controlling state space of electric wheelchair considering variable parameters |
KR102726501B1 (en) | 2022-12-19 | 2024-11-06 | 인천대학교 산학협력단 | Method and apparatus for controlling state space of electric wheelchair considering variable parameters |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019003260A1 (en) | 2017-06-26 | 2019-01-03 | ヤマハ発動機株式会社 | Power assist wheelchair, power assist unit for wheelchair, control device for power assist wheelchair, control method for power assist wheelchair, and program |
KR102307658B1 (en) * | 2019-11-19 | 2021-09-30 | 경일대학교산학협력단 | Auxiliary power unit for manual wheelchair |
JP2022138312A (en) * | 2021-03-10 | 2022-09-26 | ヤマハ発動機株式会社 | Power-assisted wheelchair, drive unit, control method, and computer program |
CN113499224B (en) * | 2021-08-05 | 2022-07-08 | 吉林大学 | Rehabilitation training device for patients with cardiovascular and cerebrovascular diseases |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100338531B1 (en) * | 2000-03-24 | 2002-05-27 | 오희범 | System for controlling power of a wheelchair |
JP2002263143A (en) * | 2001-03-08 | 2002-09-17 | Yamaguchi Technology Licensing Organization Ltd | Motor-driver wheelchair |
JP2004194794A (en) * | 2002-12-17 | 2004-07-15 | Fukushin Denki Kk | Electric wheelchair |
JP2006230421A (en) * | 2005-02-21 | 2006-09-07 | Hisashi Takahashi | Power assist type wheelchair |
-
2012
- 2012-11-21 KR KR1020120132642A patent/KR101476507B1/en active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100338531B1 (en) * | 2000-03-24 | 2002-05-27 | 오희범 | System for controlling power of a wheelchair |
JP2002263143A (en) * | 2001-03-08 | 2002-09-17 | Yamaguchi Technology Licensing Organization Ltd | Motor-driver wheelchair |
JP2004194794A (en) * | 2002-12-17 | 2004-07-15 | Fukushin Denki Kk | Electric wheelchair |
JP2006230421A (en) * | 2005-02-21 | 2006-09-07 | Hisashi Takahashi | Power assist type wheelchair |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20240095964A (en) | 2022-12-19 | 2024-06-26 | 인천대학교 산학협력단 | Method and apparatus for controlling state space of electric wheelchair considering variable parameters |
KR102726501B1 (en) | 2022-12-19 | 2024-11-06 | 인천대학교 산학협력단 | Method and apparatus for controlling state space of electric wheelchair considering variable parameters |
Also Published As
Publication number | Publication date |
---|---|
KR20140065291A (en) | 2014-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108602547B (en) | Pedal-driven system and its operating method, electric vehicle and training device | |
CN103370039B (en) | Walking assisting wheel | |
US20120130603A1 (en) | System and method for controlling a transmission of a human-powered vehicle | |
JP5471456B2 (en) | Training system, training method and training program | |
EP2672944B2 (en) | Device for autonomous retraining in walking | |
CA2714914C (en) | Rehabilitation system and method using muscle feedback | |
KR101476507B1 (en) | Method for controlling a wheelchair and load selectable power assisted wheelchair for traveling and rehabilitation utilizing the same | |
US10772774B2 (en) | Self-balancing wheelchair | |
JP5338726B2 (en) | Training system, training method and training program | |
US20110118941A1 (en) | System and method for stabilizing a single-track vehicle | |
CN101104385A (en) | Safety contron system for electric vehicles | |
CN110868925A (en) | Method and device for controlling mobile device | |
AU2017431553B2 (en) | Power assist wheelchair, power assist unit for wheelchair, control device for power assist wheelchair, control method for power assist wheelchair, program, and terminal | |
JP6436138B2 (en) | Inverted pendulum type moving body and ankle joint torque estimation method | |
US20210269111A1 (en) | Systems and methods to assist balancing of human-supported vehicles | |
TWI615137B (en) | Electric walking assisting device for multi-mode walking training and control method of the same | |
WO2018133050A1 (en) | Electric walking aid for multimode walking training, and control method therefor | |
JP7083593B2 (en) | Braking method for electric vehicles and electric vehicles | |
JP5560234B2 (en) | Center of gravity angle estimation method and inverted wheel type traveling body controlled by the method | |
WO2016035734A1 (en) | Electric wheelchair, method for controlling same, program for controlling same, and controller for operating electronic device | |
JP6324335B2 (en) | Motor control device and motor control method | |
KR102420888B1 (en) | Analysis sysem for driving wheelchair | |
JP2017012589A (en) | Training system | |
CN113577658A (en) | Variable impedance moment training device that rides | |
CN115457830A (en) | Driving simulation system based on 5G |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant | ||
FPAY | Annual fee payment |
Payment date: 20171123 Year of fee payment: 4 |
|
FPAY | Annual fee payment |
Payment date: 20181204 Year of fee payment: 5 |