CN110123539A - A kind of novel stair climbing wheelchair robot - Google Patents
A kind of novel stair climbing wheelchair robot Download PDFInfo
- Publication number
- CN110123539A CN110123539A CN201910372410.1A CN201910372410A CN110123539A CN 110123539 A CN110123539 A CN 110123539A CN 201910372410 A CN201910372410 A CN 201910372410A CN 110123539 A CN110123539 A CN 110123539A
- Authority
- CN
- China
- Prior art keywords
- climbing
- wheel assembly
- parallelogram
- front wheels
- bracket
- 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.)
- Pending
Links
Classifications
-
- 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
-
- 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/06—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs with obstacle mounting facilities, e.g. for climbing stairs, kerbs or steps
- A61G5/061—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs with obstacle mounting facilities, e.g. for climbing stairs, kerbs or steps for climbing stairs
-
- 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/06—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs with obstacle mounting facilities, e.g. for climbing stairs, kerbs or steps
- A61G5/068—Chairs or personal conveyances specially adapted for patients or disabled persons, e.g. wheelchairs with obstacle mounting facilities, e.g. for climbing stairs, kerbs or steps with extensible supports pushing upwards, e.g. telescopic legs
-
- 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/10—Parts, details or accessories
-
- 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/10—Parts, details or accessories
- A61G5/1051—Arrangements for steering
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Handcart (AREA)
Abstract
本发明公开了一种新型爬楼梯轮椅机器人,包括:定位机构、攀爬机构,所述定位机构由两组相互铰接的平行四边形机构以及第一电动推杆组成,所述平行四边形机构有四组相互铰接并呈平行四边形状的杆组成;所述攀爬机构包括:支架、前轮总成和后轮总成,所述支架设置两组,所述后轮总成包括:安装架、第二电动推杆、爬升杆,所述爬升杆与安装架相对可滑动连接。本发明的爬楼梯轮椅机器人,以双平行四边形机构作为定位机构,以电动爬升杆组成攀爬机构。通过两个机构的相互配合,完成楼梯的爬越,可实现“上楼梯时面向楼上,下楼梯面向楼下”的目标,从而使轮椅上下楼梯的方式更加符合日常运动逻辑思维,提高使用者的舒适性。
The invention discloses a novel stair-climbing wheelchair robot, which comprises: a positioning mechanism and a climbing mechanism. The positioning mechanism is composed of two sets of mutually hinged parallelogram mechanisms and a first electric push rod. The parallelogram mechanisms have four sets It is composed of rods hinged to each other and in the shape of a parallelogram; the climbing mechanism includes: a bracket, a front wheel assembly and a rear wheel assembly, the bracket is provided with two groups, and the rear wheel assembly includes: a mounting frame, a second An electric push rod and a climbing rod are relatively slidably connected to the installation frame. The stair-climbing wheelchair robot of the present invention uses a double parallelogram mechanism as a positioning mechanism, and forms a climbing mechanism with an electric climbing rod. Through the mutual cooperation of the two mechanisms, the climbing of the stairs can be completed, and the goal of "facing the upstairs when going up the stairs, and facing the downstairs when going down the stairs" can be achieved, so that the way the wheelchair goes up and down the stairs is more in line with the logical thinking of daily sports and improves the user's mobility. comfort.
Description
技术领域technical field
本发明涉及一种攀爬机器人,具体是一种新型爬楼梯轮椅机器人。The invention relates to a climbing robot, in particular to a novel stair climbing wheelchair robot.
背景技术Background technique
当今中国人口老龄化程度不断加深。数据显示,2014年中国65岁以上人口数量达到13755万人,占全国比重10.1%。另一方面,残疾人的数量也在大幅增加。如果辅以爬楼梯轮椅等辅助爬楼设备,老年人和残疾人面对楼梯将更加从容。The aging of China's population continues to deepen. Statistics show that in 2014, the number of people over the age of 65 in China reached 137.55 million, accounting for 10.1% of the country's total. On the other hand, the number of persons with disabilities has also increased significantly. If supplemented with auxiliary stair-climbing equipment such as stair-climbing wheelchairs, the elderly and disabled people will be more comfortable facing the stairs.
国外对爬楼梯装置的研究开始得相对较早,总体来看可按照爬楼梯功能实现的原理可分为轮组式、履带式、步进支撑式以及其他附加辅助式爬楼梯装置。The research on stair-climbing devices in foreign countries started relatively early. Generally speaking, according to the principle of stair-climbing function realization, it can be divided into wheel-type, crawler-type, step-supporting and other additional auxiliary stair-climbing devices.
轮组式爬楼装置,在平地行走和爬楼梯时其各小轮的运动方式是不同的:平地行走时各小轮绕各自的轴线自转,爬楼梯时各小轮一起绕中心轴公转。但轮组式轮椅有一些缺点。首先,一个轮组中的每一个轮子都必须有自己的传动系统,因此轮椅车可能非常笨重。其次,更为致命的是轮组的几何结构不能被调整为台阶几何结构。此外,行星轮机构在上下楼梯时重心起伏较大,对使用者的舒适性有较大影响。For the wheel set type stair climbing device, the movement modes of the small wheels are different when walking on flat ground and climbing stairs: when walking on flat ground, each small wheel rotates on its own axis, and when climbing stairs, each small wheel revolves around the central axis together. However, wheeled wheelchairs have some disadvantages. First, each wheel in a wheel set must have its own drive train, so wheelchairs can be very bulky. Second, and more fatally, the geometry of the wheel set cannot be adjusted to a stepped geometry. In addition, the center of gravity of the planetary gear mechanism fluctuates greatly when going up and down stairs, which has a great impact on the comfort of users.
履带型机构的爬楼梯轮椅应用较多,与轮组机构相比,其运动方式更为连续,传动效率比较高。在上下楼梯过程中,轮椅的重心总是沿着与楼梯台阶沿的连线相平行的直线运动,其重心的波动很小,运动平稳。此外,履带结构还有控制简单,能够适应各种尺寸的楼梯、障碍等优点。但一般而言,履带轮椅不适合在楼梯阶沿太光滑及斜度大于30°~35°的环境使用。另外,履带轮椅爬楼梯时容易损坏楼梯边沿,后期的维护成本较高。这一系列问题都制约着履带轮椅的发展。The stair-climbing wheelchair with the track-type mechanism is widely used. Compared with the wheel-set mechanism, its motion mode is more continuous and the transmission efficiency is relatively high. In the process of going up and down the stairs, the center of gravity of the wheelchair always moves along a straight line parallel to the line along the steps of the stairs, the fluctuation of the center of gravity is small, and the movement is stable. In addition, the crawler structure has the advantages of simple control and the ability to adapt to stairs and obstacles of various sizes. But generally speaking, crawler wheelchairs are not suitable for use in environments where the edge of the stairs is too smooth and the slope is greater than 30° to 35°. In addition, crawler wheelchairs are easy to damage the edge of the stairs when climbing stairs, and the later maintenance costs are relatively high. These series of problems all restrict the development of crawler wheelchair.
步进支撑式爬楼梯轮椅是所有形式爬楼梯轮椅中安全性较高,传动机构最复杂,控制最复杂的一种。步进支撑式爬楼梯轮椅的攀爬机构由连杆机构组成。这类型爬楼梯轮椅主要包括腿式系统和轮腿混合系统两种。The step-support stair-climbing wheelchair is the one with higher safety, the most complicated transmission mechanism and the most complicated control among all forms of stair-climbing wheelchairs. The climbing mechanism of the step-support type stair-climbing wheelchair is composed of a link mechanism. This type of stair-climbing wheelchair mainly includes two types of leg system and wheel-leg hybrid system.
此外,目前市面上的大部分轮腿式轮椅机器人爬楼梯时背朝楼梯,这与人们日常运动逻辑相反,降低了使用者的舒适度,一定程度上影响了乘客的体验。In addition, most wheel-legged wheelchair robots currently on the market face the stairs with their backs when climbing stairs, which is contrary to the logic of people’s daily movement, which reduces the comfort of users and affects the experience of passengers to a certain extent.
发明内容Contents of the invention
本发明的目的在于提供一种新型爬楼梯轮椅机器人,以解决上述背景技术中提出的问题。The object of the present invention is to provide a novel stair-climbing wheelchair robot to solve the problems raised in the above-mentioned background technology.
为实现上述目的,本发明提供如下技术方案:To achieve the above object, the present invention provides the following technical solutions:
一种新型爬楼梯轮椅机器人,包括:定位机构、攀爬机构,所述定位机构由两组相互铰接的平行四边形机构以及第一电动推杆组成,所述平行四边形机构有四组相互铰接并呈平行四边形状的杆组成,平行四边形机构连接座椅,所述第一电动推杆尾端分别与两组平行四边形机构铰接,顶端连接到座椅上;A new type of stair-climbing wheelchair robot, comprising: a positioning mechanism and a climbing mechanism, the positioning mechanism is composed of two groups of mutually hinged parallelogram mechanisms and a first electric push rod, and the described parallelogram mechanisms have four groups of mutually hinged and formed Composed of rods in the shape of a parallelogram, the parallelogram mechanism is connected to the seat, the tail ends of the first electric push rod are respectively hinged with two sets of parallelogram mechanisms, and the top end is connected to the seat;
所述攀爬机构包括:支架、前轮总成和后轮总成,所述支架设置两组,分别与平行四边形机构连接,所述前轮总成和后轮总成分别固定于两组支架底部,前轮总成和后轮总成均包括:安装架、第二电动推杆、爬升杆,所述安装架与支架固定连接,所述第二电动推杆两端分别与爬升杆和支架转动连接,所述爬升杆与安装架相对可滑动连接;两组支架底部分别安装有可转动的前轮组和后轮组,所述前轮组上设置转向机构和驱动机构,分别用于控制前轮组转向和驱动前轮组运动。The climbing mechanism includes: a bracket, a front wheel assembly and a rear wheel assembly, the brackets are provided with two groups, respectively connected to the parallelogram mechanism, and the front wheel assembly and the rear wheel assembly are respectively fixed on the two groups of brackets At the bottom, the front wheel assembly and the rear wheel assembly all include: a mounting frame, a second electric push rod, and a climbing rod. Rotation connection, the climbing rod and the installation frame are relatively slidable connection; the bottom of the two sets of brackets are respectively equipped with a rotatable front wheel set and a rear wheel set, and the front wheel set is provided with a steering mechanism and a driving mechanism, which are respectively used to control The front wheelset steers and drives the movement of the front wheelset.
作为本发明进一步的方案:所述转向机构包括第一舵机和转向连杆,所述转向连杆分别与第一舵机和前轮组连接。As a further solution of the present invention: the steering mechanism includes a first steering gear and a steering linkage, and the steering linkage is respectively connected to the first steering gear and the front wheel set.
作为本发明进一步的方案:所述驱动机构包括电机和锥齿轮组,电机通过锥齿轮组与前轮组的转轴连接。As a further solution of the present invention: the drive mechanism includes a motor and a bevel gear set, and the motor is connected to the rotating shaft of the front wheel set through the bevel gear set.
作为本发明进一步的方案:所述前轮组和后轮组上均设置丝杠机构,所示丝杠机构包括第二舵机、丝杠、滑块和滑轨,所述滑轨固定设置于安装架下方,所述滑块滑动设置在滑轨上,所述丝杠安装在安装架底部并与第二舵机连接,丝杠贯穿于滑块中的螺纹孔,滑块底部安装前轮组或后轮组。As a further solution of the present invention: the front wheel set and the rear wheel set are provided with a screw mechanism, the screw mechanism shown includes a second steering gear, a lead screw, a slider and a slide rail, and the slide rail is fixedly arranged on Below the installation frame, the slider is slidably arranged on the slide rail, the screw is installed at the bottom of the installation frame and connected with the second steering gear, the screw runs through the threaded hole in the slider, and the front wheel set is installed at the bottom of the slider or the rear wheel set.
作为本发明进一步的方案:所述爬升杆相对支架倾斜35°角。As a further solution of the present invention: the climbing pole is inclined at an angle of 35° relative to the support.
作为本发明进一步的方案:所述后轮总成中爬升杆的底端两侧各设置一橡胶套,前轮总成中爬升杆上固定设置有撑杆,撑杆底部两侧各设置一橡胶套。As a further solution of the present invention: a rubber sleeve is respectively arranged on both sides of the bottom end of the climbing rod in the rear wheel assembly, a strut is fixedly arranged on the climbing rod in the front wheel assembly, and a rubber sleeve is respectively arranged on both sides of the bottom of the strut. set.
与现有技术相比,本发明的有益效果是:本发明的爬楼梯轮椅机器人,设计爬楼梯轮椅的机构运动原理,以双平行四边形机构作为定位机构,以电动爬升杆组成攀爬机构。通过两个机构的相互配合,完成楼梯的爬越,可实现“上楼梯时面向楼上,下楼梯面向楼下”的目标,从而使轮椅上下楼梯的方式更加符合日常运动逻辑思维,提高使用者的舒适性。Compared with the prior art, the beneficial effects of the present invention are: the stair-climbing wheelchair robot of the present invention is designed with the mechanism motion principle of the stair-climbing wheelchair, uses a double parallelogram mechanism as a positioning mechanism, and forms a climbing mechanism with an electric climbing rod. Through the mutual cooperation of the two mechanisms, the climbing of the stairs can be completed, and the goal of "facing the upstairs when going up the stairs, and facing the downstairs when going down the stairs" can be achieved, so that the way the wheelchair goes up and down the stairs is more in line with the logical thinking of daily sports and improves the user's mobility. comfort.
附图说明Description of drawings
图1为本发明的结构图。Fig. 1 is a structural diagram of the present invention.
图2为本发明中丝杠机构的示意图。Fig. 2 is a schematic diagram of the screw mechanism in the present invention.
图3为图1中A处的放大结构图。FIG. 3 is an enlarged structure diagram at point A in FIG. 1 .
图4为本发明中前轮总成的结构图。Fig. 4 is a structural diagram of the front wheel assembly in the present invention.
图5为本发明中前后定位推杆的PID控制系统原理图。Fig. 5 is a schematic diagram of the PID control system of the front and rear positioning push rods in the present invention.
图6为本发明中前后爬升推杆的PID控制系统原理图。Fig. 6 is a schematic diagram of the PID control system of the front and rear climbing push rods in the present invention.
图7为本发明中驱动机构的驱动PID控制系统原理图。Fig. 7 is a schematic diagram of the driving PID control system of the driving mechanism in the present invention.
图8为本发明上台阶过程的示意图。Fig. 8 is a schematic diagram of the step-up process of the present invention.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will clearly and completely describe the technical solutions in the embodiments of the present invention with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some, not all, embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.
请参阅图1~4,本发明实施例中,一种新型爬楼梯轮椅机器人,包括:定位机构、攀爬机构,所述定位机构由两组相互铰接的平行四边形机构21以及第一电动推杆22组成,所述平行四边形机构21有四组相互铰接并呈平行四边形状的杆组成,平行四边形机构21连接座椅1,所述第一电动推杆21尾端分别与两组平行四边形机构21铰接,顶端连接到座椅1上,通过第一电动推杆21分别驱动两组平行四边形机构21运动,在驱动过程中,利用平行四杆机构的特性,可保持座椅1始终保持水平,另一方面可改变轮椅姿态,实现轮子在一定范围内的相对运动。Please refer to Fig. 1~4, in the embodiment of the present invention, a kind of novel stair-climbing wheelchair robot comprises: positioning mechanism, climbing mechanism, and described positioning mechanism is composed of two groups of mutually hinged parallelogram mechanism 21 and first electric push rod 22, the parallelogram mechanism 21 is composed of four sets of rods that are hinged to each other and in the shape of a parallelogram. Hinged, the top end is connected to the seat 1, and the two sets of parallelogram mechanisms 21 are respectively driven to move through the first electric push rod 21. During the driving process, the characteristics of the parallelogram mechanism can be used to keep the seat 1 always level. On the one hand, the posture of the wheelchair can be changed to realize the relative movement of the wheels within a certain range.
所述攀爬机构包括:支架4、前轮总成和后轮总成,所述支架4设置两组,分别与平行四边形机构21连接,所述前轮总成和后轮总成分别固定于两组支架4底部,前轮总成和后轮总成均包括:安装架31、第二电动推杆32、爬升杆33,所述安装架31与支架4固定连接,所述第二电动推杆32两端分别与爬升杆33和支架4转动连接,所述爬升杆33与安装架31相对可滑动连接,且爬升杆33相对支架4倾斜35°角,此外,位于后侧的爬升杆33的底端两侧各设置一橡胶套331,位于前侧的爬升杆33上固定设置有撑杆332,撑杆332底部两侧各设置一橡胶套331;两组支架4底部分别安装有可转动的前轮组54和后轮组35,所述前轮组54上设置转向机构和驱动机构,所述转向机构包括第一舵机52和转向连杆55,所述转向连杆55分别与第一舵机52和前轮组54连接,通过第一舵机52驱动前轮组52实现转向,所述驱动机构包括电机53和锥齿轮组51,电机53通过锥齿轮组51与前轮组54的转轴连接,用以驱动前轮组54转动。Described climbing mechanism comprises: support 4, front wheel assembly and rear wheel assembly, described support 4 is provided with two groups, is connected with parallelogram mechanism 21 respectively, and described front wheel assembly and rear wheel assembly are respectively fixed on The bottom of the two groups of supports 4, the front wheel assembly and the rear wheel assembly all include: a mounting frame 31, a second electric push rod 32, a climbing rod 33, the mounting frame 31 is fixedly connected with the support 4, and the second electric push rod The two ends of the rod 32 are rotatably connected with the climbing rod 33 and the bracket 4 respectively, and the climbing rod 33 is relatively slidably connected with the mounting frame 31, and the climbing rod 33 is inclined at an angle of 35° relative to the bracket 4. In addition, the climbing rod 33 on the rear side A rubber sleeve 331 is respectively arranged on both sides of the bottom end of the bottom end, and a strut 332 is fixedly arranged on the climbing rod 33 on the front side, and a rubber sleeve 331 is respectively arranged on both sides of the bottom of the strut 332; The front wheel set 54 and the rear wheel set 35 are provided with a steering mechanism and a driving mechanism on the front wheel set 54, and the steering mechanism includes a first steering gear 52 and a steering link 55, and the steering link 55 is connected to the first steering link 55 respectively. A steering gear 52 is connected with the front wheel set 54, and the front wheel set 52 is driven by the first steering gear 52 to realize turning. The drive mechanism includes a motor 53 and a bevel gear set 51. The rotating shaft is connected in order to drive the front wheel set 54 to rotate.
为了使车轮在爬升过程中不与台阶发生接干涉,所述前轮组54和后轮组35上均设置丝杠机构34,所示丝杠机构34包括第二舵机341、丝杠342、滑块343和滑轨344,所述滑轨344固定设置于安装架31下方,所述滑块343滑动设置在滑轨344上,所述丝杠342安装在安装架31底部并与第二舵机341连接,丝杠342贯穿于滑块343中的螺纹孔,滑块343底部安装前轮组54或后轮组35。In order to prevent the wheels from interfering with the steps during the climbing process, a lead screw mechanism 34 is provided on the front wheel set 54 and the rear wheel set 35, and the shown lead screw mechanism 34 includes a second steering gear 341, a lead screw 342, Slider 343 and slide rail 344, described slide rail 344 is fixedly arranged below mounting frame 31, and described slide block 343 is slidably arranged on slide rail 344, and described lead screw 342 is installed in mounting frame 31 bottom and is connected with the second rudder Machine 341 is connected, and leading screw 342 runs through the threaded hole in the slide block 343, and front wheel set 54 or rear wheel set 35 are installed at the bottom of slide block 343.
如图5所示为第一电动推杆21的PID控制系统原理图,对于前后定位机构的电动推杆,模型简化为给推杆头和推杆底座施加一对相互作用力,PID输入为推杆的伸长量误差,输出为推力的大小。由于系统的稳态必须要有一定大小的作用力去维持,为防止轮椅在开机启动阶段抖动剧烈和超调,在PID输出信号处叠加一个力的初值F0,使得PID更快达到稳态。Figure 5 shows the schematic diagram of the PID control system of the first electric push rod 21. For the electric push rod of the front and rear positioning mechanism, the model is simplified as applying a pair of interaction forces to the push rod head and the push rod base, and the PID input is the push rod The elongation error of the rod, the output is the magnitude of the thrust. Since the steady state of the system must be maintained with a certain amount of force, in order to prevent the wheelchair from vibrating violently and overshooting during the start-up phase, an initial value of force F0 is superimposed on the PID output signal to make the PID reach a steady state faster.
如图6为第二电动推杆33的PID控制系统原理图,爬升杆33的电动推杆控制,被控量和执行机构与第一电动推杆21一样,由于攀爬阶段和非攀爬阶段推杆的受力截然不同,属于两套不一样的系统,因此对攀爬阶段和非攀爬阶段分别进行参数整定,两个阶段转换时重新初始化积分项。Figure 6 is a schematic diagram of the PID control system of the second electric push rod 33, the electric push rod control of the climbing rod 33, the controlled quantity and the actuator are the same as the first electric push rod 21, due to the climbing stage and the non-climbing stage The force of the putter is completely different, and it belongs to two different systems. Therefore, the parameters of the climbing stage and the non-climbing stage are set separately, and the integral item is re-initialized when the two stages are converted.
如图7为前轮组54驱动机构的PID控制系统原理图,PID控制系统的输入为速度偏差,输出为前轮组54转矩。为减少轮子速度超调,采用积分分离PID控制算法。为避免轮子堵转等意外情况的发生,对积分项进行限幅。此外,受轮子电机最大转矩的限制,转矩的输出也要作限幅处理。在进行转矩输出前,还应判断前轮组54当前状态是否与地面接触,若轮子悬空,转矩输出为零。7 is a schematic diagram of the PID control system of the driving mechanism of the front wheel set 54, the input of the PID control system is the speed deviation, and the output is the torque of the front wheel set 54. In order to reduce the wheel speed overshoot, the integral separation PID control algorithm is adopted. In order to avoid accidents such as wheel stalling, the integral term is limited. In addition, limited by the maximum torque of the wheel motor, the torque output should also be limited. Before carrying out the torque output, it should also be judged whether the current state of the front wheel set 54 is in contact with the ground, if the wheels are suspended in the air, the torque output is zero.
本发明的上台阶的过程如图8所示,开始时,轮椅前进,当轮子靠近障碍物时,轮椅停止运动;The step-up process of the present invention is shown in Figure 8. At the beginning, the wheelchair moved forward, and when the wheels approached the obstacle, the wheelchair stopped moving;
前轮组54侧的爬升杆33向下运动,与地面接触,轮椅的重量转移到爬升杆33上;The climbing rod 33 on the front wheel group 54 side moves downwards and contacts with the ground, and the weight of the wheelchair is transferred to the climbing rod 33;
车轮在爬升杆33的驱动下往右上方移动,同时丝杆342驱动滑块343带动前轮组54往后移动以避免与台阶发生干涉,最后前轮组54以方向向上的合成运动爬上台阶;The wheel moves upwards to the right under the drive of the climbing rod 33, and at the same time, the screw rod 342 drives the slider 343 to drive the front wheel group 54 to move backwards to avoid interference with the steps, and finally the front wheel group 54 climbs up the steps with an upward synthetic movement ;
当前轮组54的高度足够时,丝杆342驱动车轮向前移动到初始位置,爬升杆33收缩,前轮组54与第一级台阶接触,轮椅的重量再一次转移到轮子上,至此完成第一级台阶的爬升,可见,在整个攀爬过程中,轮椅与地面的接触点始终保持4个,这样有利于系统始终处于稳定状态。When the height of the front wheel set 54 is sufficient, the screw mandrel 342 drives the wheels to move forward to the initial position, the climbing rod 33 shrinks, the front wheel set 54 contacts the first step, and the weight of the wheelchair is transferred to the wheels again. Climbing a step, it can be seen that during the whole climbing process, there are always four contact points between the wheelchair and the ground, which is conducive to the system being in a stable state all the time.
下楼梯过程与上述过程类似,下楼梯过程为后轮组35朝前进方向,当后轮组35靠近台阶的边缘时,爬升杆33展开,爬升,33与地面接触,丝杆342驱动后轮组35向前运动以避免与台阶干涉,然后爬升杆33收缩,当车轮与地面接触时,车轮恢复到原来的状态。The process of descending the stairs is similar to the above process. The process of descending the stairs is that the rear wheel group 35 is facing the forward direction. When the rear wheel group 35 is close to the edge of the step, the climbing rod 33 is launched, climbs, and the 33 contacts the ground, and the screw mandrel 342 drives the rear wheel group 35 moves forward to avoid interfering with the steps, then the climbing rod 33 shrinks, and when the wheels are in contact with the ground, the wheels return to their original state.
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的具体形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同要件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。It will be apparent to those skilled in the art that the invention is not limited to the details of the above-described exemplary embodiments, but that the invention can be embodied in other specific forms without departing from the spirit or essential characteristics of the invention. Accordingly, the embodiments should be regarded in all points of view as exemplary and not restrictive, the scope of the invention being defined by the appended claims rather than the foregoing description, and it is therefore intended that the scope of the invention be defined by the appended claims rather than by the foregoing description. All changes within the meaning and range of equivalents of the elements are embraced in the present invention. Any reference sign in a claim should not be construed as limiting the claim concerned.
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。In addition, it should be understood that although this specification is described according to implementation modes, not each implementation mode only includes an independent technical solution, and this description in the specification is only for clarity, and those skilled in the art should take the specification as a whole , the technical solutions in the various embodiments can also be properly combined to form other implementations that can be understood by those skilled in the art.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910372410.1A CN110123539A (en) | 2019-05-06 | 2019-05-06 | A kind of novel stair climbing wheelchair robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910372410.1A CN110123539A (en) | 2019-05-06 | 2019-05-06 | A kind of novel stair climbing wheelchair robot |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110123539A true CN110123539A (en) | 2019-08-16 |
Family
ID=67576232
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910372410.1A Pending CN110123539A (en) | 2019-05-06 | 2019-05-06 | A kind of novel stair climbing wheelchair robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110123539A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111494109A (en) * | 2020-04-20 | 2020-08-07 | 深圳大学 | Wheelchair capable of climbing stairs |
WO2022046010A1 (en) * | 2020-08-27 | 2022-03-03 | Munzur Universitesi Rektorlugu | Battery powered chair with height up and down function |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2421976Y (en) * | 2000-04-19 | 2001-03-07 | 时啟瑞 | Wheel chair capable of climbing stairs |
WO2001053145A1 (en) * | 2000-01-21 | 2001-07-26 | Ecole Polytechnique Federale De Lausanne | Vehicle for rugged terrain |
JP2005041461A (en) * | 2003-05-12 | 2005-02-17 | Koichi Okamoto | Escalator cart |
JP2005103725A (en) * | 2003-10-01 | 2005-04-21 | Niigata Tlo:Kk | Stable walking method, stride control method, steering method, and apparatus of legged robot |
CN201280164Y (en) * | 2008-03-17 | 2009-07-29 | 崔秉印 | Electric three-wheel wheelchair without obstruction |
JP2012005762A (en) * | 2010-06-28 | 2012-01-12 | Kuma Lift Gijutsu Kenkyusho:Kk | Stair rise/fall type moving vehicle |
CN102429787A (en) * | 2011-09-15 | 2012-05-02 | 上海电机学院 | Horizontal manned wheelchair |
CN204233308U (en) * | 2014-09-29 | 2015-04-01 | 贠亚杰 | A kind of step-by-step movement climbing machine |
CN104828122A (en) * | 2015-05-21 | 2015-08-12 | 重庆大学 | Traveling wheel walking mechanism |
CN106137580A (en) * | 2015-04-01 | 2016-11-23 | 吴大平 | A kind of electric wheelchair of energy stair activity |
CN210698041U (en) * | 2019-05-06 | 2020-06-09 | 重庆大学 | Novel stair climbing wheelchair robot |
-
2019
- 2019-05-06 CN CN201910372410.1A patent/CN110123539A/en active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2001053145A1 (en) * | 2000-01-21 | 2001-07-26 | Ecole Polytechnique Federale De Lausanne | Vehicle for rugged terrain |
CN2421976Y (en) * | 2000-04-19 | 2001-03-07 | 时啟瑞 | Wheel chair capable of climbing stairs |
JP2005041461A (en) * | 2003-05-12 | 2005-02-17 | Koichi Okamoto | Escalator cart |
JP2005103725A (en) * | 2003-10-01 | 2005-04-21 | Niigata Tlo:Kk | Stable walking method, stride control method, steering method, and apparatus of legged robot |
CN201280164Y (en) * | 2008-03-17 | 2009-07-29 | 崔秉印 | Electric three-wheel wheelchair without obstruction |
JP2012005762A (en) * | 2010-06-28 | 2012-01-12 | Kuma Lift Gijutsu Kenkyusho:Kk | Stair rise/fall type moving vehicle |
CN102429787A (en) * | 2011-09-15 | 2012-05-02 | 上海电机学院 | Horizontal manned wheelchair |
CN204233308U (en) * | 2014-09-29 | 2015-04-01 | 贠亚杰 | A kind of step-by-step movement climbing machine |
CN106137580A (en) * | 2015-04-01 | 2016-11-23 | 吴大平 | A kind of electric wheelchair of energy stair activity |
CN104828122A (en) * | 2015-05-21 | 2015-08-12 | 重庆大学 | Traveling wheel walking mechanism |
CN210698041U (en) * | 2019-05-06 | 2020-06-09 | 重庆大学 | Novel stair climbing wheelchair robot |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111494109A (en) * | 2020-04-20 | 2020-08-07 | 深圳大学 | Wheelchair capable of climbing stairs |
WO2022046010A1 (en) * | 2020-08-27 | 2022-03-03 | Munzur Universitesi Rektorlugu | Battery powered chair with height up and down function |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN203042684U (en) | Multifunctional stair climbing wheel chair | |
CN103230320B (en) | A kind of reconfigurable wheel leg combination type wheelchair | |
CN210698041U (en) | Novel stair climbing wheelchair robot | |
CA2863971A1 (en) | Step-climbing attachment for a wheeled chair | |
CN105748217A (en) | Two-section four-track stair climbing wheelchair based on walking wheel swinging and upstairs and downstairs going method | |
CN205339345U (en) | Building wheelchair was climbed to two tracks two festivals based on swing of walking wheel | |
CN212281925U (en) | Battery-assisted walking and stair climbing multifunctional wheelchair | |
CN110123539A (en) | A kind of novel stair climbing wheelchair robot | |
CN204798167U (en) | Electronic wheelchair of going downstairs in ability | |
WO2020088356A1 (en) | Barrier-free automatic wheelchair capable of climbing stairs and running on flat ground | |
CN102429787A (en) | Horizontal manned wheelchair | |
CN108514478B (en) | Novel climb electronic wheelchair of stair | |
CN103300981B (en) | A kind of wheelchair of climbing step | |
CN111714302A (en) | A multi-plane stair-climbing wheelchair | |
CN103230322B (en) | Front leg mechanism of composite wheel leg type wheelchair | |
CN111096861A (en) | Self-adaptive electric wheelchair capable of climbing steep slope | |
CN205515253U (en) | Building wheelchair is climbed to two tracks of single section based on swing of walking wheel | |
CN101803980B (en) | Barrier free wheelchair | |
CN106109124A (en) | A kind of convenience climbs the wheelchair in building up and down | |
CN205698286U (en) | A kind of nursing assisting system | |
CN211674963U (en) | Stair climbing wheelchair | |
CN214858397U (en) | Supporting structure, chassis structure, double-track walking stair climbing vehicle and intelligent stair climbing wheelchair | |
CN115919566B (en) | Self-balancing stair climbing wheelchair | |
CN209757397U (en) | Stair climbing device | |
CN217793621U (en) | Wheelchair with posture transformation function |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20190816 |
|
WD01 | Invention patent application deemed withdrawn after publication |