CN103481965A - Low-power dissipation running gear and control method based on intelligent terminal - Google Patents
Low-power dissipation running gear and control method based on intelligent terminal Download PDFInfo
- Publication number
- CN103481965A CN103481965A CN201310446974.8A CN201310446974A CN103481965A CN 103481965 A CN103481965 A CN 103481965A CN 201310446974 A CN201310446974 A CN 201310446974A CN 103481965 A CN103481965 A CN 103481965A
- Authority
- CN
- China
- Prior art keywords
- leg
- upper body
- terminal
- angle
- shank
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 210000002414 leg Anatomy 0.000 claims abstract description 138
- 210000004394 hip joint Anatomy 0.000 claims abstract description 22
- 210000000689 upper leg Anatomy 0.000 claims description 56
- 230000008569 process Effects 0.000 claims description 18
- 210000002683 foot Anatomy 0.000 claims description 15
- 230000007704 transition Effects 0.000 claims description 11
- 210000000629 knee joint Anatomy 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims 5
- 230000000694 effects Effects 0.000 claims 4
- 230000005021 gait Effects 0.000 abstract description 13
- 238000005265 energy consumption Methods 0.000 abstract description 4
- 244000309466 calf Species 0.000 description 23
- 230000009471 action Effects 0.000 description 8
- 230000033001 locomotion Effects 0.000 description 7
- 238000013480 data collection Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 210000001624 hip Anatomy 0.000 description 2
- 210000003127 knee Anatomy 0.000 description 2
- 230000000739 chaotic effect Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
Images
Landscapes
- Rehabilitation Tools (AREA)
Abstract
本发明公开了一种基于智能终端的低功耗行走装置及控制方法,包括一对腿部;驱动装置,制动装置;在髋关节的上端设有倾角传感器,在两只大腿及两只小腿的内侧分别设有编码器;在髋关节的左右两侧分别设有陀螺仪,且陀螺仪固定在连接腿部与髋关节的第一转轴上;在两只足部的底部分别设有压力传感器;还包括上身,上身包括支撑架以及安装在支撑架上的智能终端、驱动电路和数据采集设备;支撑架的下端通过第二转轴与髋关节连接;数据采集设备分别与智能终端、驱动电路、倾角传感器、四个编码器、两只陀螺仪和两只压力传感器相连接;驱动电路分别与驱动装置和制动装置相连接。本发明具有更合理的仿人形态,同时还具有被动行走器的低能耗和步态自然。
The invention discloses a walking device with low power consumption and a control method based on an intelligent terminal, which includes a pair of legs; a driving device and a braking device; Encoders are set on the inner side of the hip joint respectively; gyroscopes are respectively set on the left and right sides of the hip joint, and the gyroscope is fixed on the first rotating shaft connecting the leg and the hip joint; pressure sensors are respectively set on the bottom of the two feet ; also includes the upper body, the upper body includes a support frame and an intelligent terminal installed on the support frame, a drive circuit and a data acquisition device; the lower end of the support frame is connected to the hip joint through a second rotating shaft; the data acquisition device is respectively connected to the intelligent terminal, the drive circuit, An inclination sensor, four encoders, two gyroscopes and two pressure sensors are connected; a driving circuit is connected with a driving device and a braking device respectively. The invention has a more reasonable humanoid form, and also has the low energy consumption and natural gait of a passive walker.
Description
技术领域 technical field
本发明涉及一种基于智能终端的低功耗行走装置及控制方法。 The invention relates to a low-power consumption walking device and a control method based on an intelligent terminal.
背景技术 Background technique
当前主流的机械行走装置主要有两种行走方式,一种为轮式,即通过电机控制轮轴转动来实现行走装置的运动,一种为足式,目前主流的足式行走装置主要分为两类,一类是以日本HONDA公司生产制作的Asimo为代表,被称为主动行走机器人,它能模拟人类行走的各种动作,包括不同速度的稳定步行,慢步行走,上下楼梯,且有避障行走能力,但是它们都涉及到使用大力矩的驱动系统和高增益的反馈控制;另一类是近年来研究的很多的被动行走机器,它的最大特点是低能耗和自然步态,主要以McGeer研究设计的直腿带膝关节行走装置为代表,近年来出现了大量新的类似研究模型,包括从纯被动行走器到半被动行走器,但他们均没有上身,都不具备真正的仿人形态。 The current mainstream mechanical walking devices mainly have two walking modes, one is the wheel type, that is, the movement of the walking device is realized by controlling the rotation of the wheel shaft by the motor, and the other is the foot type, and the current mainstream foot type walking devices are mainly divided into two types , one is represented by Asimo produced by Japan's HONDA company, which is called an active walking robot, which can simulate various human walking actions, including stable walking at different speeds, walking slowly, going up and down stairs, and has obstacle avoidance Walking ability, but they all involve the use of high-torque drive system and high-gain feedback control; the other is a lot of passive walking machines studied in recent years, its biggest feature is low energy consumption and natural gait, mainly based on McGeer The research-designed walking device with straight legs and knee joints is the representative. In recent years, a large number of new similar research models have appeared, including pure passive walking devices to semi-passive walking devices, but none of them have an upper body and do not have a real humanoid form. .
发明内容 Contents of the invention
本发明的目的是提供一种基于智能终端的低功耗行走装置及控制方法,使其具有更合理的仿人形态,同时还具有被动行走器的低能耗和步态自然。 The purpose of the present invention is to provide a low-power walking device and control method based on an intelligent terminal, so that it has a more reasonable humanoid form, and at the same time has the low energy consumption and natural gait of a passive walking device.
本发明所述的基于智能终端的低功耗行走装置,包括: The intelligent terminal-based low-power walking device of the present invention includes:
一对腿部,每只所述腿部分别通过第一转轴与髋关节连接,每只所述腿部包括大腿和小腿,所述大腿和小腿通过膝关节连接,每只小腿下端连接有足部; A pair of legs, each of which is connected to the hip joint through a first rotating shaft, each of which includes a thigh and a calf, the thigh and the calf are connected through a knee joint, and a foot is connected to the lower end of each calf ;
驱动装置,其设在所述髋关节处; a driving device disposed at the hip joint;
制动装置,其设在所述两只腿部的膝关节处,能将所述大腿和小腿锁在一起; a braking device, located at the knee joints of said two legs, capable of locking said upper and lower legs together;
在髋关节的上端设有倾角传感器,用于检测腿部姿态角初值及地面倾斜角; There is an inclination sensor on the upper end of the hip joint, which is used to detect the initial value of the leg attitude angle and the ground inclination angle;
在两只大腿及两只小腿的内侧分别设有编码器,位于两只大腿的编码器用于检测两只大腿之间的角度,位于同一只腿部的两个编码器用于检测该腿部的大腿与小腿之间的角度; There are encoders on the inner sides of the two thighs and the two calves respectively. The encoders located on the two thighs are used to detect the angle between the two thighs, and the two encoders located on the same leg are used to detect the angle between the thighs of the leg. the angle between the calf;
在髋关节的左右两侧分别设有陀螺仪,且陀螺仪固定在连接腿部与髋关节的第一转轴上,用于检测腿部运动的角速度; Gyroscopes are respectively arranged on the left and right sides of the hip joint, and the gyroscope is fixed on the first rotating shaft connecting the leg and the hip joint to detect the angular velocity of the leg movement;
在两只足部的底部分别设有压力传感器,用于检测足部与地面的接触力; There are pressure sensors on the bottom of the two feet respectively, which are used to detect the contact force between the feet and the ground;
还包括上身,所述上身包括支撑架以及安装在支撑架上的智能终端、驱动电路和数据采集设备; Also includes the upper body, the upper body includes a support frame and an intelligent terminal installed on the support frame, a drive circuit and a data acquisition device;
所述支撑架的下端通过第二转轴与髋关节连接; The lower end of the support frame is connected with the hip joint through the second rotating shaft;
所述数据采集设备分别与智能终端、驱动电路、倾角传感器、四个编码器、两只陀螺仪和两只压力传感器电连接,所述数据采集设备用于采集各传感器检测的数据信号并传送给智能终端,所述智能终端基于数据采集设备采集的数据信号发出控制指令经数据采集设备后输入驱动电路; The data acquisition equipment is respectively electrically connected with the intelligent terminal, the drive circuit, the inclination sensor, four encoders, two gyroscopes and two pressure sensors, and the data acquisition equipment is used to collect the data signals detected by each sensor and transmit them to An intelligent terminal, wherein the intelligent terminal sends a control instruction based on the data signal collected by the data acquisition device, and then enters the drive circuit through the data acquisition device;
所述驱动电路分别与驱动装置和制动装置相连接,驱动电路控制所述驱动装置产生驱动大腿和上身摆动的力矩以及控制制动装置将大腿和小腿松开/锁闭。 The driving circuit is respectively connected with the driving device and the braking device, and the driving circuit controls the driving device to generate a torque for driving the thigh and the upper body to swing and controls the braking device to release/lock the thigh and the lower leg.
所述支撑架的左右两侧分别通过一弹簧与同侧的大腿连接。 The left and right sides of the support frame are respectively connected to the thighs on the same side through a spring.
所述制动装置为键控式制动器。 The brake device is a keyed brake.
所述第二转轴与两只所述第一转轴同轴设置。 The second rotating shaft is arranged coaxially with the two first rotating shafts.
本发明所述的基于智能终端的低功耗行走装置的控制方法,包括以下步骤: The control method of the low-power consumption walking device based on the intelligent terminal of the present invention comprises the following steps:
A、智能终端根据倾角传感器、陀螺仪及压力传感器检测的数据信号,得出装置的绝对姿态角,从而判断该行走装置是处于斜面/平面上; A. According to the data signals detected by the inclination sensor, gyroscope and pressure sensor, the intelligent terminal can obtain the absolute attitude angle of the device, so as to judge whether the walking device is on an inclined plane/plane;
B、行走装置在斜面上行走: B. The walking device walks on the slope:
b1、智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D1,驱动电路控制制动装置分别将摆动腿的大腿与小腿以及支撑腿的大腿与小腿锁闭; b1. The intelligent terminal sends a control command D1 according to the data signals detected by the inclination sensor, gyroscope and pressure sensor, and the drive circuit controls the braking device to lock the thigh and calf of the swinging leg and the thigh and calf of the supporting leg respectively;
b2、智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D2,驱动电路控制驱动装置给摆动腿施加向前摆动的驱动力矩J1,使摆动腿向前摆动,直至摆动腿与支撑脚的夹角α为预设的αMax,同时给上身施加向后摆动的驱动力矩J2,上身向后摆动直至上身与竖直线L的夹角β为预设的βMax; b2. The intelligent terminal sends the control command D2 according to the data signals detected by the inclination sensor, the gyroscope and the pressure sensor, and the driving circuit controls the driving device to apply a driving torque J 1 for swinging forward to the swinging leg, so that the swinging leg swings forward until the swinging leg The angle α between the upper body and the supporting foot is the preset α Max , and at the same time, a driving moment J 2 for swinging backward is applied to the upper body, and the upper body swings backward until the angle β between the upper body and the vertical line L is the preset β Max ;
b3、摆动腿在弹簧的牵引下缓慢着地,上身在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿; b3. The swinging leg lands slowly under the traction of the spring, and the upper body returns slowly under the action of the spring. At this time, the original swinging leg is converted into a supporting leg, and the original supporting leg is converted into a swinging leg;
b4、智能终端根据编码器检测的数据信号发出控制指令D3,驱动电路控制驱动装置给上身施加向前摆动的驱动力矩J3,上身向前摆动直至上身与竖直线L的夹角β为预设的βMax,摆动腿向前摆动直至摆动腿与支撑腿的夹角α为0; b4. The intelligent terminal sends a control command D3 according to the data signal detected by the encoder, and the driving circuit controls the driving device to apply a driving torque J 3 for swinging forward to the upper body, and the upper body swings forward until the angle β between the upper body and the vertical line L is predetermined Assuming β Max , the swing leg swings forward until the angle α between the swing leg and the support leg is 0;
b5、摆动腿在弹簧的牵引下缓慢着地,上身在弹簧的作用下缓慢回位,重新开始新的周期; b5. The swinging leg lands slowly under the traction of the spring, and the upper body returns slowly under the action of the spring to start a new cycle;
C、行走装置在平面上行走: C. The walking device walks on the plane:
c1、智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D4,驱动电路控制制动装置控制松开摆动腿的大腿与小腿,同时锁闭支撑腿的大腿与小腿; c1. The intelligent terminal sends a control command D4 according to the data signals detected by the inclination sensor, gyroscope and pressure sensor, and the driving circuit controls the braking device to control the loosening of the thigh and calf of the swinging leg, and simultaneously locks the thigh and calf of the supporting leg;
c2、智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D5,驱动电路控制驱动装置给摆动腿施加向前摆动的驱动力矩J4,使摆动腿向前摆动,直至摆动腿与支撑脚的夹角α为预设的αMax,同时给上身施加向后摆动的驱动力矩J5,上身向后摆动直至上身与竖直线L的夹角β为预设的βMax; c2. The intelligent terminal sends a control command D5 according to the data signals detected by the inclination sensor, the gyroscope and the pressure sensor, and the driving circuit controls the driving device to apply the driving torque J 4 for swinging forward to the swinging leg, so that the swinging leg swings forward until the swinging leg The angle α between the upper body and the supporting foot is the preset α Max , and at the same time, a driving moment J 5 for swinging backward is applied to the upper body, and the upper body swings backward until the angle β between the upper body and the vertical line L is the preset β Max ;
c3、智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D6,驱动电路控制制动装置控制锁闭摆动腿的大腿与小腿,摆动腿在弹簧的牵引下缓慢着地,上身在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿; c3. The intelligent terminal sends a control command D6 according to the data signals detected by the inclination sensor, gyroscope and pressure sensor. The driving circuit controls the brake device to control and lock the thigh and calf of the swing leg. The swing leg is pulled by the spring to land slowly. Slowly return to the position under the action of the spring, at this time, the original swing leg is converted into a support leg, and the original support leg is converted into a swing leg;
c4、智能终端根据编码器检测的数据信号发出控制指令D7,驱动电路控制驱动装置给上身施加向前摆动的驱动力矩J5,上身向前摆动直至上身与竖直线L的夹角β为预设的βMax,同时,智能终端根据倾角传感器、压力传感器和编码器检测的数据信号发出控制指令D8,驱动电路控制制动装置控制松开摆动腿的大腿与小腿,控制驱动装置给摆动腿施加向前摆动的驱动力矩J6,摆动腿向前摆动直至摆动腿与支撑腿的夹角α为0; c4. The intelligent terminal sends out the control command D7 according to the data signal detected by the encoder. The driving circuit controls the driving device to apply the driving torque J 5 for swinging forward to the upper body, and the upper body swings forward until the angle β between the upper body and the vertical line L is predetermined. At the same time , the intelligent terminal sends out the control command D8 according to the data signals detected by the inclination sensor, the pressure sensor and the encoder, the driving circuit controls the braking device to control the loosening of the thigh and calf of the swinging leg, and controls the driving device to apply force to the swinging leg. Forward swinging driving moment J 6 , the swinging leg swings forward until the angle α between the swinging leg and the supporting leg is 0;
c5、摆动腿在弹簧的牵引下缓慢着地,上身在弹簧的作用下缓慢回位,重新开始新的周期; c5. The swinging leg lands slowly under the traction of the spring, and the upper body slowly returns to its position under the action of the spring, and a new cycle starts again;
D、行走装置在复杂地面上行走: D. The walking device walks on complex ground:
若存在斜面与平面间切换或者倾角比较大的斜面与倾角比较小的斜面之间进行切换时,所述智能终端根据陀螺仪测得的角速度数据信号以及倾角传感器测得的地面信号,经数据采集设备传导至智能终端,智能终端可以根据这些数据信号得出装置的绝对姿态角度是否发生了变化,从而控制行走装置在斜面与平面间切换; If there is a switch between an inclined plane and a plane or between an inclined plane with a relatively large inclination angle and an inclined plane with a relatively small inclination angle, the intelligent terminal is based on the angular velocity data signal measured by the gyroscope and the ground signal measured by the inclination sensor. The equipment is transmitted to the smart terminal, and the smart terminal can determine whether the absolute attitude angle of the device has changed according to these data signals, so as to control the walking device to switch between the inclined plane and the plane;
d1、当行走装置是从大倾角斜面过渡到小倾角斜面时,智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D9,驱动电路对摆动腿施加与其摆动方向相同的力矩J7,若行走装置继续在斜面上行走,则接下来的行走过程按照所述步骤b3至步骤b5; d1. When the walking device transitions from a slope with a large inclination angle to a slope with a small inclination angle, the intelligent terminal sends a control command D9 according to the data signals detected by the inclination sensor, gyroscope and pressure sensor, and the drive circuit applies the same torque J to the swinging leg as it swings 7. If the walking device continues to walk on the slope, the next walking process follows the steps b3 to b5;
d2、当行走装置是从小倾角斜面过渡到大倾角斜面时,智能终端根据倾角传感器、陀螺仪和压力传感器检测的数据信号发出控制指令D10,驱动电路对摆动腿施加与其摆动方向相反的力矩J8,若行走装置继续在斜面上行走,则接下来的行走过程按照所述步骤b3至步骤b5; d2. When the walking device transitions from a small inclination to a large inclination, the smart terminal sends a control command D10 according to the data signals detected by the inclination sensor, gyroscope and pressure sensor, and the drive circuit applies a torque J 8 opposite to the swing direction of the swing leg , if the walking device continues to walk on the slope, the next walking process follows the steps b3 to b5;
d3、当行走装置是从斜面过渡到平面时,智能终端发送控制指令D11,驱动电路产生控制信号,使得摆动腿的大腿与小腿松开,接下来的行走过程按照所述步骤C; d3. When the walking device transitions from an inclined plane to a flat plane, the intelligent terminal sends a control command D11, and the drive circuit generates a control signal, so that the thigh and calf of the swinging leg are released, and the next walking process follows the above step C;
d4、当装置是从平面过渡到斜面时,智能终端发送控制指令D12,驱动电路产生控制信号,使得摆动腿的大腿与小腿锁闭,接下来的行走过程按照所述步骤B。 d4. When the device transitions from a plane to an inclined plane, the smart terminal sends a control command D12, and the drive circuit generates a control signal to lock the thigh and calf of the swinging leg, and the next walking process follows step B.
在行走过程中,所述摆动腿与支撑脚的夹角α和上身与竖直线L的夹角β满足以下关系式:2α=β。 During walking, the angle α between the swing leg and the supporting foot and the angle β between the upper body and the vertical line L satisfy the following relationship: 2α=β.
本发明具有以下优点: The present invention has the following advantages:
(1)不仅具有膝关节,还有由支撑架、智能终端、多功能数据采集设备构成的可以绕髋部旋转的上身,因此具有更合理的仿人形态; (1) It not only has knee joints, but also has an upper body that can rotate around the hips, which is composed of support frames, smart terminals, and multi-functional data acquisition equipment, so it has a more reasonable humanoid form;
(2)基于感测装置传导的地面环境数据,利用手持智能终端越来越高效的数据处理能力,控制驱动装置对大腿部分施加摆动力矩;控制制动装置锁定和松开大腿和小腿;动态控制髋部内控制和调整小腿下降速度的轴承的旋转速度;控制上身按照设定的规则前后摆动;通过避免脚擦地,避免小腿与膝盖的碰撞,优化各耗能部件工作机制的方式,在斜面上进行被动行走等方式实现节能,具有被动行走器的低能耗和步态自然的特点,甚至可以实现零能耗行走步态; (2) Based on the ground environment data transmitted by the sensing device, using the increasingly efficient data processing capabilities of handheld smart terminals, control the driving device to apply swing torque to the thigh; control the braking device to lock and release the thigh and calf; dynamic control The rotation speed of the bearings in the hip controls and adjusts the descending speed of the calf; the upper body is controlled to swing back and forth according to the set rules; by avoiding the feet from rubbing the ground, avoiding the collision of the calf and the knee, and optimizing the working mechanism of each energy-consuming component, on the slope Passive walking and other methods to achieve energy saving, has the characteristics of low energy consumption and natural gait of passive walking, and can even achieve zero-energy walking gait;
(3)在行走过程中上身的摆动角度α与两腿部之间的夹角β始终保持一定的角度关系(即:2α=β),保持该角度关系有利于最大程度保证行走装置在行走过程中能量损失最小,同时还能够保持平衡,该角度关系可以减少摆动腿落地时的足底碰撞能量损耗,同时该角度关系配合腿部的膝关节可以避免摆动腿在摆动过程中足部与底面之间的摩擦; (3) In the process of walking, the swing angle α of the upper body and the angle β between the two legs always maintain a certain angle relationship (ie: 2α=β), and maintaining this angle relationship is conducive to ensuring the maximum degree of walking of the walking device. The energy loss in the center is the smallest, and at the same time it can maintain balance. This angle relationship can reduce the energy loss of the plantar collision when the swing leg lands. friction between
(4)借助目前发展迅速并且数据处理能力日益强大的智能终端设备来分析和处理运动数据并实施控制,从而可以实现广泛的市场应用,还可在行走装置基础上进行相关拓展应用,如利用智能终端自带摄像头或外接摄像头拓展数据采集范围,或搭载用于其它非运动相关数据采集的传感器进行拓展应用等; (4) With the help of intelligent terminal equipment that is developing rapidly and has increasingly powerful data processing capabilities to analyze and process motion data and implement control, a wide range of market applications can be achieved, and related expansion applications can also be carried out on the basis of walking devices, such as using intelligent The terminal has its own camera or an external camera to expand the range of data collection, or it is equipped with sensors for other non-sports-related data collection for extended applications, etc.;
(5)利用智能终端设备自带的USB数据接口,可以为装置提供数据传输接口,还可为行走装置的耗能部分供电; (5) Using the USB data interface that comes with the smart terminal equipment, it can provide a data transmission interface for the device, and can also supply power for the energy-consuming part of the walking device;
综上所述,该行走装置不仅有拟人形态的带膝盖的双腿,还有由智能终端支撑架、智能终端、数据采集设备等组成的可摆动的上身,该装置通过上身摆动和膝盖的配合,充分利用智能终端不断增强的数据处理能力,不仅可以搭载任意智能终端进行避免足地摩擦和减少足地碰撞的节能行走,还可以对装置的行走过程进行实时输出力矩控制,并结合双足行走的被动行走特性和自稳定特性,从而使装置无论在平地还是在斜面上都能始终处于倍周期行走步态中。 To sum up, the walking device not only has anthropomorphic legs with knees, but also a swingable upper body composed of smart terminal support frame, smart terminal, data acquisition equipment, etc. , making full use of the ever-increasing data processing capabilities of intelligent terminals, not only can carry any intelligent terminal to avoid foot-ground friction and reduce foot-ground collision energy-saving walking, but also can control the real-time output torque of the walking process of the device, combined with bipedal walking The passive walking characteristics and self-stabilizing characteristics enable the device to always be in a cycle-doubling walking gait no matter whether it is on a flat ground or on a slope.
附图说明 Description of drawings
图1是本发明的结构示意图; Fig. 1 is a structural representation of the present invention;
图2是本发明的结构框图; Fig. 2 is a structural block diagram of the present invention;
图3是本发明中支撑架的结构示意图; Fig. 3 is the structural representation of support frame among the present invention;
图4是本发明的数据处理流程图; Fig. 4 is the data processing flowchart of the present invention;
图5是本发明在斜面上行走的控制流程图; Fig. 5 is the control flowchart of the present invention walking on the slope;
图6是本发明所述基于智能终端的低功耗行走装置的在斜面时整个周期步态的示意图; Fig. 6 is a schematic diagram of the entire cycle gait of the intelligent terminal-based low-power walking device of the present invention on an inclined plane;
图7是本发明在水平面上行走的控制流程图; Fig. 7 is the control flowchart of the present invention walking on horizontal plane;
图8是本发明所述基于智能终端的低功耗行走装置的在平面时整个周期步态的示意图。 Fig. 8 is a schematic diagram of the whole cycle gait of the intelligent terminal-based low-power walking device of the present invention on a plane.
具体实施方式 Detailed ways
下面结合附图对本发明作进一步说明: The present invention will be further described below in conjunction with accompanying drawing:
如图1至图3所示的基于智能终端的低功耗行走装置,一对腿部,每只所述腿部分别通过第一转轴与髋关节11连接,每只所述腿部包括大腿4和小腿8,所述大腿4和小腿8通过膝关节6连接,每只小腿8下端连接有足部9。
As shown in Figures 1 to 3, a low-power walking device based on an intelligent terminal, a pair of legs, each of which is connected to the hip joint 11 through a first rotating shaft, and each of which includes a
驱动装置2,其设在所述髋关节11处。
The driving
制动装置7,其设在所述两只腿部的膝关节6处,能将所述大腿4和小腿8锁在一起。
The
在髋关节11的上端设有倾角传感器13,用于检测腿部姿态角初值及地面倾斜角。
An
在两只大腿4及两只小腿8的内侧分别设有编码器5,位于两只大腿4的编码器5用于检测两只大腿4之间的角度,位于同一只腿部的两个编码器5用于检测该腿部的大腿4与小腿8之间的角度。
在髋关节11的左右两侧分别设有陀螺仪3,且陀螺仪3固定在连接腿部与髋关节11的第一转轴上,用于检测腿部运动的角速度。
Gyroscopes 3 are respectively provided on the left and right sides of the
在两只足部9的底部分别设有压力传感器10,用于检测足部9与地面的接触力。
The bottoms of the two
还包括上身1,所述上身1包括支撑架14以及安装在支撑架14上的智能终端15、驱动电路16和数据采集设备17。
The
所述支撑架14的下端通过第二转轴与髋关节11连接。
The lower end of the
所述数据采集设备17分别与智能终端15、驱动电路16、倾角传感器13、四个编码器5、两只陀螺仪3和两只压力传感器10电连接,所述数据采集设备17用于采集各传感器检测的数据信号并传送给智能终端15,所述智能终端15基于数据采集设备17采集的数据信号发出控制指令经数据采集设备17后输入驱动电路16。
The
所述驱动电路16分别与驱动装置2和制动装置7相连接,驱动电路16控制所述驱动装置2产生驱动大腿4和上身1摆动的力矩以及控制制动装置7将大腿4和小腿8松开/锁闭。
The driving
所述支撑架14的左右两侧分别通过一弹簧11与同侧的大腿4连接,当检测到撞地压力过大时,调整弹簧11弹性系数,使弹簧11收集能量的能力更强,从而可以避免过多的足底碰撞能量损失。
The left and right sides of the
所述制动装置7为键控式制动器。
The
所述第二转轴与两只所述第一转轴同轴设置。以使每一腿腿都可以作为摆动腿摆动,同时使上身可以根据两腿部间的相对角度变化调整前后摆动角度。 The second rotating shaft is arranged coaxially with the two first rotating shafts. Each leg can be used as a swing leg to swing, and at the same time, the upper body can adjust the front and rear swing angles according to the relative angle change between the two legs.
工作时,首先行走装置的双腿呈一定角度跨立在水平面上,将智能终端(比如:安卓智能手机)开机,放置于支撑架内,然后旋转旋钮d,使智能终端在左右方向上固定,随后旋转旋钮a、b,使智能终端设备在前后方向上固定。然后连接好数据传输线,然后开机,并通过数据线利用智能终端对装置各组件上电,检查各装置是否正常开启,若有部件未正常开启,则在智能终端显示器上显示通知信息,人工检查后再次检测。各装置均正常工作后,接受传感器传回的初始数据(如腿部姿态角初值和地面倾斜角),对数据处理程序进行初始化,判断装置是处于斜面上行走还是水平面上行走。随后装置整体开始正常工作,行走过程开始,各传感器传回地面压力上数据,两腿部相对角度变化,腿运动角速度等,这些数据经数据采集设备(DAQ)传至智能终端,数据处理程序处理后,判断行走装置是处于某一确定周期步态行走中还是处于混沌步态中,若是处于某一种周期步态行走中,则不发送控制指令,只是继续监视行走装置的运动数据;否则利用控制程序(如:OGY控制等)进行行走控制,使行走步态回归到周期步态中。在行走过程中不仅要对腿的运动进行控制,还要对上身进行控制,若装置是行走于水平面上,还要对大腿摆动力矩、对制动装置中的制动器的制动与断开进行控制,实施这些控制目的都是为了该行走装置能够实现节能行走,甚至行走动力学研究中所说的无能量行走。 When working, firstly, the legs of the walking device straddle the horizontal plane at a certain angle, turn on the smart terminal (such as an Android smart phone), place it in the support frame, and then turn the knob d to fix the smart terminal in the left and right directions. Then rotate the knobs a and b to fix the smart terminal device in the front and back direction. Then connect the data transmission line, then turn it on, and use the smart terminal to power on each component of the device through the data line to check whether each device is turned on normally. If any part is not turned on normally, a notification message will be displayed on the smart terminal display. After manual inspection Check again. After each device is working normally, it receives the initial data sent back by the sensor (such as the initial value of the leg attitude angle and the ground inclination angle), initializes the data processing program, and judges whether the device is walking on an inclined plane or on a horizontal plane. Then the device as a whole starts to work normally, and the walking process starts. Each sensor sends back the data on the ground pressure, the relative angle change of the two legs, the angular velocity of the leg movement, etc. These data are transmitted to the smart terminal through the data acquisition device (DAQ) and processed by the data processing program. Finally, it is judged whether the walking device is in a certain cycle gait or in a chaotic gait, if it is in a certain cycle gait, it will not send control instructions, but continue to monitor the motion data of the walking device; otherwise use The control program (such as: OGY control, etc.) performs walking control, so that the walking gait returns to the periodic gait. In the process of walking, not only the movement of the legs should be controlled, but also the upper body should be controlled. If the device is walking on a horizontal surface, the swinging moment of the thigh and the braking and disconnection of the brake in the braking device should also be controlled. , the purpose of implementing these controls is to enable the walking device to realize energy-saving walking, or even energy-free walking in the study of walking dynamics.
如图4至图8所示,本发明所述的基于智能终端的低功耗行走装置的控制方法,包括以下步骤: As shown in Fig. 4 to Fig. 8, the control method of the low power consumption walking device based on the intelligent terminal according to the present invention comprises the following steps:
A、智能终端15根据倾角传感器13、陀螺仪3及压力传感器10检测的数据信号,得出装置的绝对姿态角,从而判断该行走装置是处于斜面/平面上;
A, the
B、行走装置在斜面上行走: B. The walking device walks on the slope:
b1、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D1,驱动电路16控制制动装置7分别将摆动腿的大腿4与小腿8以及支撑腿的大腿4与小腿8锁闭;
b1. The
b2、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D2,驱动电路16控制驱动装置2给摆动腿施加向前摆动的驱动力矩J1,使摆动腿向前摆动,直至摆动腿与支撑脚的夹角α为预设的αMax,同时给上身1施加向后摆动的驱动力矩J2,上身1向后摆动直至上身1与竖直线L的夹角β为预设的βMax;
b2. The intelligent terminal 15 issues a control instruction D2 according to the data signals detected by the
b3、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿;
b3. The swing leg lands slowly under the traction of the spring, and the
b4、智能终端15根据编码器5检测的数据信号发出控制指令D3,驱动电路16控制驱动装置2给上身1施加向前摆动的驱动力矩J3,上身1向前摆动直至上身1与竖直线L的夹角β为预设的βMax,摆动腿向前摆动直至摆动腿与支撑腿的夹角α为0;
b4. The
b5、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,重新开始新的周期;
b5. The swinging leg lands slowly under the traction of the spring, and the
C、行走装置在平面上行走: C. The walking device walks on the plane:
c1、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D4,驱动电路16控制制动装置7控制松开摆动腿的大腿4与小腿8,同时锁闭支撑腿的大腿4与小腿8;
c1. The intelligent terminal 15 issues a control command D4 according to the data signals detected by the
c2、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D5,驱动电路16控制驱动装置2给摆动腿施加向前摆动的驱动力矩J4,使摆动腿向前摆动,直至摆动腿与支撑脚的夹角α为预设的αMax,同时给上身1施加向后摆动的驱动力矩J5,上身1向后摆动直至上身1与竖直线L的夹角β为预设的βMax;
c2. The intelligent terminal 15 issues a control instruction D5 according to the data signals detected by the
c3、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D6,驱动电路16控制制动装置7控制锁闭摆动腿的大腿4与小腿8,摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿;
c3, the
c4、智能终端15根据编码器5检测的数据信号发出控制指令D7,驱动电路16控制驱动装置2给上身1施加向前摆动的驱动力矩J5,上身1向前摆动直至上身1与竖直线L的夹角β为预设的βMax,同时,智能终端15根据倾角传感器13、压力传感器10和编码器5检测的数据信号发出控制指令D8,驱动电路16控制制动装置7控制松开摆动腿的大腿4与小腿8,控制驱动装置2给摆动腿施加向前摆动的驱动力矩J6,摆动腿向前摆动直至摆动腿与支撑腿的夹角α为0;
c4. The
c5、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,重新开始新的周期;
c5. The swinging leg lands slowly under the traction of the spring, and the
D、行走装置在复杂地面上行走: D. The walking device walks on complex ground:
若存在斜面与平面间切换或者倾角比较大的斜面与倾角比较小的斜面之间进行切换时,所述智能终端15根据陀螺仪3测得的角速度数据信号以及倾角传感器13测得的地面信号,经数据采集设备17传导至智能终端15,智能终端15可以根据这些数据信号得出装置的绝对姿态角度是否发生了变化,从而控制行走装置在斜面与平面间切换;
If there is a switch between an inclined plane and a plane or between an inclined plane with a relatively large inclination angle and an inclined plane with a relatively small inclination angle, the
d1、当行走装置是从大倾角斜面过渡到小倾角斜面时,智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D9,驱动电路16对摆动腿施加与其摆动方向相同的力矩J7,若行走装置继续在斜面上行走,则接下来的行走过程按照所述步骤b3至步骤b5;
d1. When the walking device transitions from a large slope to a small slope, the
d2、当行走装置是从小倾角斜面过渡到大倾角斜面时,智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D10,驱动电路16对摆动腿施加与其摆动方向相反的力矩J8,若行走装置继续在斜面上行走,则接下来的行走过程按照所述步骤b3至步骤b5;
d2. When the walking device transitions from a small inclination to a large inclination, the
d3、当行走装置是从斜面过渡到平面时,智能终端15发送控制指令D11,驱动电路16产生控制信号,使得摆动腿的大腿4与小腿8松开,接下来的行走过程按照所述步骤C;
d3. When the walking device transitions from an inclined plane to a flat plane, the
d4、当装置是从平面过渡到斜面时,智能终端15发送控制指令D12,驱动电路16产生控制信号,使得摆动腿的大腿4与小腿8锁闭,接下来的行走过程按照所述步骤B。
d4. When the device transitions from a plane to an inclined plane, the
在行走过程中,所述摆动腿与支撑脚的夹角α和上身(1)与竖直线L的夹角β满足以下关系式:2α=β。 During walking, the angle α between the swing leg and the supporting foot and the angle β between the upper body (1) and the vertical line L satisfy the following relationship: 2α=β.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310446974.8A CN103481965B (en) | 2013-09-27 | 2013-09-27 | A kind of low-power consumption running gear based on terminal and control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310446974.8A CN103481965B (en) | 2013-09-27 | 2013-09-27 | A kind of low-power consumption running gear based on terminal and control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103481965A true CN103481965A (en) | 2014-01-01 |
CN103481965B CN103481965B (en) | 2015-12-09 |
Family
ID=49822672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310446974.8A Active CN103481965B (en) | 2013-09-27 | 2013-09-27 | A kind of low-power consumption running gear based on terminal and control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103481965B (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104648515A (en) * | 2015-01-14 | 2015-05-27 | 重庆邮电大学 | Telescopic-leg energy-saving 2D under-actuated traveling device and control method thereof |
CN104986244A (en) * | 2015-07-21 | 2015-10-21 | 重庆足步科技有限公司 | Under-actuated walking apparatus and control method for same |
CN105015643A (en) * | 2015-07-21 | 2015-11-04 | 重庆邮电大学 | Semi-passive walker driven by single motor and walking control method thereof |
CN105947012A (en) * | 2016-05-10 | 2016-09-21 | 南京航空航天大学 | Differential gear driving robot leg mechanism and control method |
CN106821682A (en) * | 2017-03-14 | 2017-06-13 | 北京飞天时间科技发展有限公司 | A kind of wearable waist power assisting device |
CN106965872A (en) * | 2017-05-15 | 2017-07-21 | 黄国彬 | A kind of walking robot with gyrocontrol instrument |
CN107919164A (en) * | 2016-10-05 | 2018-04-17 | 松下知识产权经营株式会社 | Auxiliary device, householder method and program |
CN108361335A (en) * | 2017-12-18 | 2018-08-03 | 武汉滨湖电子有限责任公司 | A kind of control device of support leg |
CN111038614A (en) * | 2019-12-30 | 2020-04-21 | 深圳市优必选科技股份有限公司 | Robot and leg structure thereof |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5221883A (en) * | 1990-11-30 | 1993-06-22 | Honda Giken Kogyo Kabushiki Kaisha | System for controlling locomotion of legged walking robot |
US20040211603A1 (en) * | 2001-09-26 | 2004-10-28 | Takayuki Furuta | Bipedal humanoid |
JP2005081537A (en) * | 2003-09-11 | 2005-03-31 | Honda Motor Co Ltd | Joint moment estimating method of bipedal moving body |
US20080258669A1 (en) * | 2004-09-14 | 2008-10-23 | Toshio Fukuda | Walking Robot by Using Passive Changes in Joint Angles and Control Method Thereof |
CN101298260A (en) * | 2008-06-11 | 2008-11-05 | 清华大学 | Low-power consumption two-foot walking moving system and walking control method thereof |
-
2013
- 2013-09-27 CN CN201310446974.8A patent/CN103481965B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5221883A (en) * | 1990-11-30 | 1993-06-22 | Honda Giken Kogyo Kabushiki Kaisha | System for controlling locomotion of legged walking robot |
US20040211603A1 (en) * | 2001-09-26 | 2004-10-28 | Takayuki Furuta | Bipedal humanoid |
JP2005081537A (en) * | 2003-09-11 | 2005-03-31 | Honda Motor Co Ltd | Joint moment estimating method of bipedal moving body |
US20080258669A1 (en) * | 2004-09-14 | 2008-10-23 | Toshio Fukuda | Walking Robot by Using Passive Changes in Joint Angles and Control Method Thereof |
CN101298260A (en) * | 2008-06-11 | 2008-11-05 | 清华大学 | Low-power consumption two-foot walking moving system and walking control method thereof |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104648515A (en) * | 2015-01-14 | 2015-05-27 | 重庆邮电大学 | Telescopic-leg energy-saving 2D under-actuated traveling device and control method thereof |
CN104986244A (en) * | 2015-07-21 | 2015-10-21 | 重庆足步科技有限公司 | Under-actuated walking apparatus and control method for same |
CN105015643A (en) * | 2015-07-21 | 2015-11-04 | 重庆邮电大学 | Semi-passive walker driven by single motor and walking control method thereof |
CN104986244B (en) * | 2015-07-21 | 2018-03-16 | 广州足步医疗科技有限公司 | Drive lacking running gear and its control method |
CN105947012A (en) * | 2016-05-10 | 2016-09-21 | 南京航空航天大学 | Differential gear driving robot leg mechanism and control method |
CN107919164A (en) * | 2016-10-05 | 2018-04-17 | 松下知识产权经营株式会社 | Auxiliary device, householder method and program |
CN107919164B (en) * | 2016-10-05 | 2023-09-08 | 松下知识产权经营株式会社 | Auxiliary device, auxiliary method, and recording medium |
CN106821682A (en) * | 2017-03-14 | 2017-06-13 | 北京飞天时间科技发展有限公司 | A kind of wearable waist power assisting device |
CN106965872A (en) * | 2017-05-15 | 2017-07-21 | 黄国彬 | A kind of walking robot with gyrocontrol instrument |
CN108361335A (en) * | 2017-12-18 | 2018-08-03 | 武汉滨湖电子有限责任公司 | A kind of control device of support leg |
CN111038614A (en) * | 2019-12-30 | 2020-04-21 | 深圳市优必选科技股份有限公司 | Robot and leg structure thereof |
CN111038614B (en) * | 2019-12-30 | 2021-09-17 | 深圳市优必选科技股份有限公司 | Robot and leg structure thereof |
Also Published As
Publication number | Publication date |
---|---|
CN103481965B (en) | 2015-12-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103481965B (en) | A kind of low-power consumption running gear based on terminal and control method | |
CN105857437B (en) | The semi-passive walking device of biped and its ambulation control method | |
CN206781911U (en) | A kind of Hexapod Robot | |
CN106325273A (en) | Multi-phase gait switching control system and control method for power-assisted exoskeleton robot | |
CN202728394U (en) | spider robot | |
CN110262510B (en) | A humanoid robot mass center trajectory planning method to reduce walking energy consumption | |
CN108836757A (en) | A kind of assisted walk exoskeleton robot system with self-regulation | |
CN105213156A (en) | A powered exoskeleton and its control method | |
CN103707952B (en) | Narrow sufficient passive walking device and control method thereof | |
CN108248717A (en) | It is a kind of can operated tool have terminal stabilization control function quadruped robot | |
CN103895016A (en) | Method for controlling gait of robot | |
CN103722550A (en) | Embedded type system of outer skeleton robot | |
CN101298260A (en) | Low-power consumption two-foot walking moving system and walking control method thereof | |
CN208081848U (en) | A kind of fighter toy | |
CN109857131A (en) | A kind of two foot-four-footed posture changing control method of legged type robot | |
CN102431604A (en) | Humanoid robot with function of interchanging double-foot walking with wheeled moving | |
CN105662789B (en) | A kind of exoskeleton system based on sound limb motion monitoring, control deformed limb motion | |
CN105947012A (en) | Differential gear driving robot leg mechanism and control method | |
CN105799806B (en) | A kind of three-dimensional apery walking device and its control method | |
CN106112985A (en) | The ectoskeleton hybrid control system of lower limb walk help machine and method | |
CN111301552A (en) | A robot leg dynamic system and its control method | |
CN106859928A (en) | Gait rehabilitation training robot and the force-feedback control method for the robot | |
CN203149351U (en) | Distributed control system of tetrapod parallel leg waking robot | |
CN206123679U (en) | Humanoid robot is out of shape to high trafficability characteristic | |
CN104973160A (en) | Two-foot straight leg walker provided with upper body |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210426 Address after: 450018 1601, 16th floor, Henan enterprise union building, Shangxian street, Mingli Road, Zhengdong New District, Zhengzhou City, Henan Province Patentee after: Zhongyuan power intelligent robot Co., Ltd Address before: 400065 Chongqing Nan'an District huangjuezhen pass Chongwen Road No. 2 Patentee before: CHONGQING University OF POSTS AND TELECOMMUNICATIONS |