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 PDF

Info

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
Application number
CN201310446974.8A
Other languages
Chinese (zh)
Other versions
CN103481965B (en
Inventor
李清都
曾光
杨芳艳
刁建
唐俊
李永
赵武斌
周婷婷
曾洪正
郭建丽
冷家丽
曹永民
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhongyuan Power Intelligent Robot Co Ltd
Original Assignee
Chongqing University of Post and Telecommunications
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Chongqing University of Post and Telecommunications filed Critical Chongqing University of Post and Telecommunications
Priority to CN201310446974.8A priority Critical patent/CN103481965B/en
Publication of CN103481965A publication Critical patent/CN103481965A/en
Application granted granted Critical
Publication of CN103481965B publication Critical patent/CN103481965B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Rehabilitation Tools (AREA)

Abstract

本发明公开了一种基于智能终端的低功耗行走装置及控制方法,包括一对腿部;驱动装置,制动装置;在髋关节的上端设有倾角传感器,在两只大腿及两只小腿的内侧分别设有编码器;在髋关节的左右两侧分别设有陀螺仪,且陀螺仪固定在连接腿部与髋关节的第一转轴上;在两只足部的底部分别设有压力传感器;还包括上身,上身包括支撑架以及安装在支撑架上的智能终端、驱动电路和数据采集设备;支撑架的下端通过第二转轴与髋关节连接;数据采集设备分别与智能终端、驱动电路、倾角传感器、四个编码器、两只陀螺仪和两只压力传感器相连接;驱动电路分别与驱动装置和制动装置相连接。本发明具有更合理的仿人形态,同时还具有被动行走器的低能耗和步态自然。

Figure 201310446974

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.

Figure 201310446974

Description

一种基于智能终端的低功耗行走装置及控制方法A low-power consumption walking device and control method based on an intelligent terminal

技术领域 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的夹角β为预设的βMaxc2. 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 thigh 4 And the lower leg 8, the thigh 4 and the lower leg 8 are connected through the knee joint 6, and the lower end of each lower leg 8 is connected with a foot 9.

驱动装置2,其设在所述髋关节11处。 The driving device 2 is arranged at the hip joint 11 .

制动装置7,其设在所述两只腿部的膝关节6处,能将所述大腿4和小腿8锁在一起。 The braking device 7, which is arranged at the knee joints 6 of the two legs, can lock the thigh 4 and the lower leg 8 together.

在髋关节11的上端设有倾角传感器13,用于检测腿部姿态角初值及地面倾斜角。 An inclination sensor 13 is provided on the upper end of the hip joint 11 for detecting the initial value of the leg attitude angle and the ground inclination angle.

在两只大腿4及两只小腿8的内侧分别设有编码器5,位于两只大腿4的编码器5用于检测两只大腿4之间的角度,位于同一只腿部的两个编码器5用于检测该腿部的大腿4与小腿8之间的角度。 Encoders 5 are respectively arranged on the insides of the two thighs 4 and the two shanks 8, the encoders 5 positioned at the two thighs 4 are used to detect the angle between the two thighs 4, and the two encoders positioned at the same leg 5 is used to detect the angle between the thigh 4 and the calf 8 of the leg.

在髋关节11的左右两侧分别设有陀螺仪3,且陀螺仪3固定在连接腿部与髋关节11的第一转轴上,用于检测腿部运动的角速度。 Gyroscopes 3 are respectively provided on the left and right sides of the hip joint 11, and the gyroscope 3 is fixed on the first rotating shaft connecting the leg and the hip joint 11 for detecting the angular velocity of the leg movement.

在两只足部9的底部分别设有压力传感器10,用于检测足部9与地面的接触力。 The bottoms of the two feet 9 are respectively provided with pressure sensors 10 for detecting the contact force between the feet 9 and the ground.

还包括上身1,所述上身1包括支撑架14以及安装在支撑架14上的智能终端15、驱动电路16和数据采集设备17。 The upper body 1 is also included, and the upper body 1 includes a support frame 14 and an intelligent terminal 15 installed on the support frame 14 , a drive circuit 16 and a data collection device 17 .

所述支撑架14的下端通过第二转轴与髋关节11连接。 The lower end of the support frame 14 is connected with the hip joint 11 through the second rotating shaft.

所述数据采集设备17分别与智能终端15、驱动电路16、倾角传感器13、四个编码器5、两只陀螺仪3和两只压力传感器10电连接,所述数据采集设备17用于采集各传感器检测的数据信号并传送给智能终端15,所述智能终端15基于数据采集设备17采集的数据信号发出控制指令经数据采集设备17后输入驱动电路16。 The data acquisition device 17 is electrically connected with the intelligent terminal 15, the drive circuit 16, the inclination sensor 13, four encoders 5, two gyroscopes 3 and two pressure sensors 10 respectively, and the data acquisition device 17 is used to collect each The data signal detected by the sensor is sent to the smart terminal 15, and the smart terminal 15 sends a control instruction based on the data signal collected by the data collection device 17 and then enters the drive circuit 16 through the data collection device 17.

所述驱动电路16分别与驱动装置2和制动装置7相连接,驱动电路16控制所述驱动装置2产生驱动大腿4和上身1摆动的力矩以及控制制动装置7将大腿4和小腿8松开/锁闭。 The driving circuit 16 is connected with the driving device 2 and the braking device 7 respectively, and the driving circuit 16 controls the driving device 2 to generate a moment to drive the swing of the thigh 4 and the upper body 1 and controls the braking device 7 to loosen the thigh 4 and the lower leg 8. Open/Lock.

所述支撑架14的左右两侧分别通过一弹簧11与同侧的大腿4连接,当检测到撞地压力过大时,调整弹簧11弹性系数,使弹簧11收集能量的能力更强,从而可以避免过多的足底碰撞能量损失。 The left and right sides of the support frame 14 are respectively connected with the thigh 4 on the same side by a spring 11. When it is detected that the pressure of hitting the ground is too large, the elastic coefficient of the spring 11 is adjusted so that the ability of the spring 11 to collect energy is stronger, so that it can Avoid excessive plantar impact energy losses.

所述制动装置7为键控式制动器。 The brake device 7 is a keyed brake.

所述第二转轴与两只所述第一转轴同轴设置。以使每一腿腿都可以作为摆动腿摆动,同时使上身可以根据两腿部间的相对角度变化调整前后摆动角度。 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 intelligent terminal 15 obtains the absolute attitude angle of the device according to the data signal detected by the inclination sensor 13, the gyroscope 3 and the pressure sensor 10, thereby judging that the walking device is on an inclined plane/plane;

B、行走装置在斜面上行走: B. The walking device walks on the slope:

b1、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D1,驱动电路16控制制动装置7分别将摆动腿的大腿4与小腿8以及支撑腿的大腿4与小腿8锁闭;  b1. The intelligent terminal 15 sends out a control instruction D1 according to the data signals detected by the inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the drive circuit 16 controls the braking device 7 to separate the thigh 4 and the calf 8 of the swinging leg and the thigh 4 of the supporting leg. Locking with shank 8;

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 inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the drive circuit 16 controls the drive device 2 to apply a driving torque J 1 for swinging forward to the swing leg, so that the swing leg Swing forward until the angle α between the swinging leg and the supporting foot is the preset α Max , and at the same time apply a driving moment J 2 for swinging backwards to the upper body 1, and the upper body 1 swings backward until the angle between the upper body 1 and the vertical line L β is the preset β Max ;

b3、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿; b3. The swing leg lands slowly under the traction of the spring, and the upper body 1 returns slowly 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;

b4、智能终端15根据编码器5检测的数据信号发出控制指令D3,驱动电路16控制驱动装置2给上身1施加向前摆动的驱动力矩J3,上身1向前摆动直至上身1与竖直线L的夹角β为预设的βMax,摆动腿向前摆动直至摆动腿与支撑腿的夹角α为0; b4. The intelligent terminal 15 sends a control command D3 according to the data signal detected by the encoder 5, and the driving circuit 16 controls the driving device 2 to apply a driving torque J 3 for swinging forward to the upper body 1, and the upper body 1 swings forward until the upper body 1 is in line with the vertical line The included angle β of L is the preset β Max , and the swing leg swings forward until the included angle α between the swing leg and the support leg is 0;

b5、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,重新开始新的周期; b5. The swinging leg lands slowly under the traction of the spring, and the upper body 1 slowly returns to its position under the action of the spring, and a new cycle starts again;

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 inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the drive circuit 16 controls the brake device 7 to control the loosening of the thigh 4 and the calf 8 of the swinging leg, and locks the support at the same time Thigh 4 and calf 8 of the leg;

c2、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D5,驱动电路16控制驱动装置2给摆动腿施加向前摆动的驱动力矩J4,使摆动腿向前摆动,直至摆动腿与支撑脚的夹角α为预设的αMax,同时给上身1施加向后摆动的驱动力矩J5,上身1向后摆动直至上身1与竖直线L的夹角β为预设的βMaxc2. The intelligent terminal 15 issues a control instruction D5 according to the data signals detected by the inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the driving circuit 16 controls the driving device 2 to apply a driving torque J 4 for swinging forward to the swinging leg, so that the swinging leg Swing forward until the angle α between the swing leg and the supporting foot is the preset α Max , and at the same time apply a driving moment J 5 for swinging backward to the upper body 1 , and swing the upper body 1 backward until the angle between the upper body 1 and the vertical line L β is the preset β Max ;

c3、智能终端15根据倾角传感器13、陀螺仪3和压力传感器10检测的数据信号发出控制指令D6,驱动电路16控制制动装置7控制锁闭摆动腿的大腿4与小腿8,摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,此时,原摆动腿转换为支撑腿,原支撑腿转换为摆动腿; c3, the intelligent terminal 15 sends out the control instruction D6 according to the data signals detected by the inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the driving circuit 16 controls the braking device 7 to control the locking of the thigh 4 and the calf 8 of the swing leg, and the swing leg is in the spring The upper body 1 slowly returns to its position under the traction 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、智能终端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 intelligent terminal 15 sends a control command D7 according to the data signal detected by the encoder 5, and the driving circuit 16 controls the driving device 2 to apply a forward swinging driving torque J5 to the upper body 1, and the upper body 1 swings forward until the upper body 1 is in line with the vertical line The included angle β of L is the preset β Max . At the same time, the intelligent terminal 15 sends a control command D8 according to the data signals detected by the inclination sensor 13, the pressure sensor 10 and the encoder 5, and the drive circuit 16 controls the braking device 7 to control the loosening swing. For the thigh 4 and the lower leg 8 of the leg, control the driving device 2 to apply a driving moment J 6 for swinging forward to the swinging leg, and the swinging leg swings forward until the angle α between the swinging leg and the supporting leg is 0;

c5、摆动腿在弹簧的牵引下缓慢着地,上身1在弹簧的作用下缓慢回位,重新开始新的周期; c5. The swinging leg lands slowly under the traction of the spring, and the upper body 1 slowly returns to its position under the action of the spring, and starts a new cycle;

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 intelligent terminal 15 is based on the angular velocity data signal measured by the gyroscope 3 and the ground signal measured by the inclination sensor 13, Conducted to the smart terminal 15 through the data acquisition device 17, the smart terminal 15 can obtain whether the absolute attitude angle of the device has changed according to these data signals, thereby controlling the walking device to switch between the inclined plane and the plane;

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 intelligent terminal 15 sends a control command D9 according to the data signals detected by the slope sensor 13, the gyroscope 3 and the pressure sensor 10, and the drive circuit 16 applies a swing to the swing leg. Moment J 7 in the same direction, if the walking device continues to walk on the slope, the next walking process will follow the steps b3 to b5;

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 intelligent terminal 15 sends a control command D10 according to the data signals detected by the inclination sensor 13, the gyroscope 3 and the pressure sensor 10, and the driving circuit 16 applies the swing direction to the swing leg. For the opposite moment J 8 , if the walking device continues to walk on the slope, the next walking process will follow the steps b3 to b5;

d3、当行走装置是从斜面过渡到平面时,智能终端15发送控制指令D11,驱动电路16产生控制信号,使得摆动腿的大腿4与小腿8松开,接下来的行走过程按照所述步骤C; d3. When the walking device transitions from an inclined plane to a flat plane, the intelligent terminal 15 sends a control command D11, and the driving circuit 16 generates a control signal, so that the thigh 4 and the calf 8 of the swinging leg are released, and the following walking process follows the step C ;

d4、当装置是从平面过渡到斜面时,智能终端15发送控制指令D12,驱动电路16产生控制信号,使得摆动腿的大腿4与小腿8锁闭,接下来的行走过程按照所述步骤B。 d4. When the device transitions from a plane to an inclined plane, the smart terminal 15 sends a control command D12, and the drive circuit 16 generates a control signal, so that the thigh 4 and the calf 8 of the swinging leg are locked, and the next walking process follows step B.

在行走过程中,所述摆动腿与支撑脚的夹角α和上身(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)

1. the low-power consumption running gear based on terminal comprises:
A pair of shank, every described shank is connected with hip joint (11) by the first rotating shaft respectively, every described shank comprises thigh (4) and shank (8), and described thigh (4) is connected by knee joint (6) with shank (8), and every shank (8) lower end is connected with foot (9);
Actuating device (2), it is located at described hip joint (11) and locates;
Brake equipment (7), its knee joint (6) that is located at described two shanks is located, and described thigh (4) and shank (8) can be locked together;
It is characterized in that:
Be provided with obliquity sensor (13) in the upper end of hip joint (11), for detection of shank attitude angle initial value and terrain slope angle;
Inboard at two thighs (4) and two shanks (8) is respectively equipped with coder (5), be positioned at the coder (5) of two thighs (4) for detection of the angle between two thighs (4), be positioned at two coders (5) of same shank for detection of the thigh (4) of this shank and the angle between shank (8);
Be respectively equipped with gyroscope (3) in the left and right sides of hip joint (11), and gyroscope (3) is fixed in the first rotating shaft that connects shank and hip joint (11), for detection of the cireular frequency of leg exercise;
Be respectively equipped with pressure sensor (10) in the bottom of two foots (9), the contact force for detection of foot (9) with ground;
Also comprise upper body (1), described upper body (1) comprises bracing frame (14) and is arranged on terminal (15), driving circuit (16) and the data acquisition equipment (17) on bracing frame (14);
The lower end of support frame as described above (14) is connected with hip joint (11) by the second rotating shaft;
Described data acquisition equipment (17) is electrically connected to terminal (15), driving circuit (16), obliquity sensor (13), four coders (5), two gyroscopes (3) and two pressure sensors (10) respectively, described data acquisition equipment (17) is for the data-signal that gathers each sensor and detect and send terminal (15) to, and the data-signal that described terminal (15) based on data collecting device (17) gathers sends control command input driving circuit (16) after data acquisition equipment (17);
Described driving circuit (16) is connected with brake equipment (7) with actuating device (2) respectively, and driving circuit (16) is controlled described actuating device (2) and produced the moment that drives thigh (4) and upper body (1) to swing and control brake equipment (7) by thigh (4) and unclamp/locking of shank (8).
2. the low-power consumption running gear based on terminal according to claim 1 is characterized in that: the left and right sides of support frame as described above (14) is connected with the thigh (4) of homonymy by a spring respectively.
3. the low-power consumption running gear based on terminal according to claim 1 and 2, it is characterized in that: described brake equipment (7) is keying formula drg.
4. the low-power consumption running gear based on terminal according to claim 1 and 2, it is characterized in that: described the second rotating shaft and two described the first rotating shafts coaxially arrange.
5. the control method of the described low-power consumption running gear based on terminal as arbitrary as claim 1 to 4, is characterized in that, comprises the following steps:
The data-signal that A, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10), draw the absolute attitude angle of device, thereby judge that this running gear is on inclined-plane/plane;
B, running gear are walked on inclined-plane:
The data-signal that b1, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D1, and driving circuit (16) is controlled brake equipment (7) thigh (4) and shank (8) locking with shank (8) and supporting leg by the thigh (4) of leading leg respectively;
The data-signal that b2, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D2, and driving circuit (16) accessory drive (2) is given to lead leg and applied the drive torque J swung forward 1, make to lead leg forward and to swing, until the angle α led leg with feet is default α max, apply the drive torque J swung backward to upper body (1) simultaneously 2, upper body (1) backward swinging direct to the angle β of upper body (1) and vertical curve L be default β max;
B3, lead leg slowly lands under the traction of spring, upper body (1) slow return under the effect of spring, and now, former leading leg is converted to supporting leg, and former supporting leg is converted to leads leg;
The data-signal that b4, terminal (15) detect according to coder (5) sends control command D3, and driving circuit (16) accessory drive (2) applies the drive torque J swung forward to upper body (1) 3, upper body (1) forward swinging direct to the angle β of upper body (1) and vertical curve L be default β max, lead leg forward swinging direct to the angle α led leg with supporting leg be 0;
B5, lead leg slowly lands under the traction of spring, and upper body (1) slow return under the effect of spring, restart the new cycle;
C, running gear are walked in the plane:
The data-signal that c1, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D4, driving circuit (16) is controlled brake equipment (7) control and is unclamped the thigh (4) and shank (8) of leading leg, the thigh (4) of locking supporting leg and shank (8) simultaneously;
The data-signal that c2, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D5, and driving circuit (16) accessory drive (2) is given to lead leg and applied the drive torque J swung forward 4, make to lead leg forward and to swing, until the angle α led leg with feet is default α max, apply the drive torque J swung backward to upper body (1) simultaneously 5, upper body (1) backward swinging direct to the angle β of upper body (1) and vertical curve L be default β max;
The data-signal that c3, terminal (15) detect according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D6, driving circuit (16) is controlled brake equipment (7) and is controlled the thigh (4) and shank (8) that locking is led leg, lead leg and slowly land under the traction of spring, upper body (1) is slow return under the effect of spring, now, former leading leg is converted to supporting leg, and former supporting leg is converted to leads leg;
The data-signal that c4, terminal (15) detect according to coder (5) sends control command D7, and driving circuit (16) accessory drive (2) applies the drive torque J swung forward to upper body (1) 5, upper body (1) forward swinging direct to the angle β of upper body (1) and vertical curve L be default β maxsimultaneously, the data-signal that terminal (15) detects according to obliquity sensor (13), pressure sensor (10) and coder (5) sends control command D8, driving circuit (16) is controlled brake equipment (7) control and is unclamped the thigh (4) and shank (8) of leading leg, and accessory drive (2) is given to lead leg and applied the drive torque J swung forward 6, lead leg forward swinging direct to the angle α led leg with supporting leg be 0;
C5, lead leg slowly lands under the traction of spring, and upper body (1) slow return under the effect of spring, restart the new cycle;
D, running gear are walked on complicated ground:
If exist between the smaller inclined-plane in the larger inclined-plane in inclined-plane and interplanar switching or inclination angle and inclination angle while being switched, the ground signal that the angular velocity data signal that described terminal (15) records according to gyroscope (3) and obliquity sensor (13) record, conduct to terminal (15) through data acquisition equipment (17), terminal (15) can show whether the absolute attitude angle of device variation has occurred according to these data-signals, thereby controls running gear in inclined-plane and interplanar switching;
D1, when running gear be during from the high spud angle chamfered transition to the small inclination inclined-plane, the data-signal that terminal (15) detects according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D9, and driving circuit (16) applies the moment J identical with its swaying direction to leading leg 7if running gear continues to walk on inclined-plane, ensuing walking process according to described step b3 to step b5;
D2, when running gear be during from the small inclination chamfered transition to the high spud angle inclined-plane, the data-signal that terminal (15) detects according to obliquity sensor (13), gyroscope (3) and pressure sensor (10) sends control command D10, and driving circuit (16) applies the moment J contrary with its swaying direction to leading leg 8if running gear continues to walk on inclined-plane, ensuing walking process according to described step b3 to step b5;
D3, when running gear be during from chamfered transition to plane, terminal (15) sending controling instruction D11, driving circuit (16) produces control signal, makes the thigh (4) of leading leg unclamp with shank (8), and ensuing walking process is according to described step C;
D4, when device be while from plane, being transitioned into inclined-plane, terminal (15) sending controling instruction D12, driving circuit (16) produces control signal, makes the thigh (4) and shank (8) locking of leading leg, ensuing walking process is according to described step B.
6. the control method of the low-power consumption running gear based on terminal according to claim 5, it is characterized in that: in the process of walking, described leading leg meets following relational expression: 2 α=β with angle α and the upper body (1) of feet with the angle β of vertical curve L.
CN201310446974.8A 2013-09-27 2013-09-27 A kind of low-power consumption running gear based on terminal and control method Active CN103481965B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (5)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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