CN104679005B - 基于智能终端控制的行走载物装置及控制方法 - Google Patents
基于智能终端控制的行走载物装置及控制方法 Download PDFInfo
- Publication number
- CN104679005B CN104679005B CN201510079539.5A CN201510079539A CN104679005B CN 104679005 B CN104679005 B CN 104679005B CN 201510079539 A CN201510079539 A CN 201510079539A CN 104679005 B CN104679005 B CN 104679005B
- Authority
- CN
- China
- Prior art keywords
- control
- minimum system
- chip minimum
- knee joint
- hip joint
- 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.)
- Expired - Fee Related
Links
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了一种基于智能终端控制的行走载物装置及方法,包括智能终端,用于发送控制指令;载物平台,用于搭载物品;四条腿,用于行走且支撑载物平台,每个腿包括髋关节和膝关节,在各髋关节和各膝关节上均设有舵机;超声波传感器,设置在载物平台的前边缘;传感器模块,由加速度计和陀螺仪组成,安装在载物平台的下方;单片机最小系统,该单片机最小系统分别与超声波传感器、传感器模块以及各舵机连接,基于超声波传感器及传感器模块所采集的数据对各舵机进行控制;单片机最小系统还与智能终端进行无线通信,接收智能终端所发出的控制指令,并基于该控制指令对各舵机进行控制。本发明具有稳定性强、速度快、行走距离长,并能够在复杂环境中行走。
Description
技术领域
本发明涉及一种机器人,具体涉及一种基于智能终端控制的行走载物装置及控制方法。
背景技术
随着网络时代的到来以及第四代通信技术的发展,各种智能移动终端相继问世,以Android 5.0平台为代表的智能手机正伴随着3G/4G技术开始获得人们的广泛接受。在这场移动设备的革命中,移动终端设备己经跨越了仅仅将通信作为唯一目标的模式,如今变成了具有广泛应用价值的计算、控制、管理的综合服务平台。将智能手机与控制系统相结合,使传统的PC机工作平台具备便携能力,为实现真正的移动通信提供了可能。Android手机可利用周围无线网络资源与行走载物装置进行交互并实施控制,不仅为现有智能控制系统提供了新的控制方法,也为实现机器与人的信息交换提供了新的交互手段。特别是在我国酝酿的物联网开发与应用的大潮中,这样一种新型的控制方法,将对人们的工作方式及生活方式,甚至对世界都将产生巨大的影响。
目前,有十余项专利与Android手机控制的行走载物装置及控制方法有关:如公开号:CN 102655012 A公开了“一种基于Android平台控制碟机的装置及方法”,该装置包括Android设备,所述基于Android平台控制碟机的装置还包括碟机;所述碟机包括用于读碟的MPEG模块;所述Android设备包括用于检测碟机状态且在碟机中有碟片时控制碟机的MPEG模块读碟并将读取的碟片内容转发的MCU模块和与所述MPEG模块连接的用于播放MCU模块转发过来的MPEG模块读取的碟片内容的播放模块。又如公开号CN 101916201 A公开了“一种基于Android移动终端冷启动的方法和装置”,该方法包括在快速冷启动模式下,当关闭移动终端的电源后,移动终端在待机状态下将需要保存的数据备份到非易失存储设备中,然后将移动终端断电;当重新启动移动终端后,将备份在非易失存储设备中的数据恢复到相应的物理内存。又如公开号为CN 103019746 A公开了“基于Android平台的软件交互控制方法及系统”,该控制方法包括以下步骤:步骤S01、当监听到触发事件时,获取预置的界面组件及相应的系统底层数据;步骤S02、根据所述预置的界面组件及相应的系统底层数据,按照预先设置的显示逻辑在顶层显示相应的界面;步骤S03、监测到外部指令时,响应外部指令,并将所述指令写入系统底层,并返回执行步骤S02。
以上专利申请均存在以下缺点:
(1)机械结构复杂:行走装置机械结构复杂,成本高,不利于现代化的智能控制。
(2)仿生性差:上述装置均不是基于动物的行走姿势模仿制造而得,使得装置的运行比较笨拙,不能达到仿生装置的灵活运动状态。
(3)软件控制流程复杂:基于Android手机控制的程序十分复杂,造成系统响应速度慢。
发明内容
本发明的目的是提供一种基于智能终端控制的行走载物装置及控制方法,它具有稳定性强、速度快、行走距离长,并能在复杂环境中行走。
本发明所述的基于智能终端控制的行走载物装置,
智能终端,用于发送控制指令;
载物平台,用于搭载物品;
四条腿,对称设置在载物平台的左右两边,用于行走且支撑载物平台,每个所述腿包括髋关节和膝关节,在各髋关节和各膝关节上均设有舵机;
超声波传感器,该超声波传感器设置在载物平台的前边缘,用于探测前方障碍物;
传感器模块,由加速度计和陀螺仪组成,该传感器模块安装在载物平台的下方,用于检测载物平台的倾斜角度值;
单片机最小系统,该单片机最小系统分别与超声波传感器、传感器模块以及各舵机连接,基于超声波传感器及传感器模块所采集的数据对各舵机进行控制;单片机最小系统还与智能终端进行无线通信,接收智能终端所发出的控制指令,并基于该控制指令对各舵机进行控制;
无线通信模块,该无线通信模块与单片机最小系统连接,用于实现单片机最小系统与智能终端的无线通信;
电源模块,该电源模块经5V稳压模块稳压后为单片机最小系统、无线通信模块、声波传感器、传感器模块供电,电源模块还经6V稳压模块稳压后为各舵机供电。
在每条腿的足底均设有橡胶。
所述单片机最小系统采用的控制芯片为STC12C5A60S2。
所述舵机的型号为MG995。
所述超声波传感器的型号为HC-SR04。
所述传感器模块的型号为MPU-6050。
所述智能终端为Android手机。在Android手机上设置有六个指令键,其中:“S1”表示启动,“S2”表示停止,“S3”表示前进,“S4”表示后退,“S5”表示左转,“S6”表示右转;Android手机通过这六个指令键来发送控制指令给单片机最小系统。
还包括与单片机最小系统连接的模式切换按键和模式指示灯,当模式指示灯亮表示手动控制模式,当模式指示灯灭为自动控制模式。
本发明所述的基于智能终端控制的行走载物装置的控制方法,
包括自动控制模式和手动控制模式;
在自动控制模式下:
a、传感器模块检测载物平台的倾斜角度值T_ANGEL并传送给单片机最小系统,超声波传感器探测前方是否有障碍物并传送给单片机最小系统;
所述倾斜角度值T_ANGEL的计算公式如下:
T_ANGEL=(G_VALUE-G_OFFSET)*Kgyro+ΣD_VALUE*(1/T);
其中:G_VALUE为陀螺仪采集的值,G_OFFSET为陀螺仪的零偏值,Kgyro为陀螺仪的比例值,D_VALUE为加速度计所获得的倾斜角度,T为积分时间常数;
b、单片机最小系统基于该倾斜角度值T_ANGEL控制PWM波的占空比实现对各舵机转动角度的控制,从而控制髋关节和膝关节的摆动角度,使行走载物装置循环执行前进动作;当超声波传感器探测到前方有障碍物时,单片机最小系统控制行走载物装置执行右转或左转动作,绕过障碍物后再循环执行前进动作;
在手动控制模式下:
单片机最小系统基于智能终端所发送的控制指令控制PWM波的占空比实现对各舵机输出轴旋转角度的控制,从而控制髋关节和膝关节的摆动角度,使行走载物装置完成该控制指令所对应的动作,该控制指令包括前进、后退、左转、右转、启动及停止动作。
行走载物装置的前进通过五个步态完成:
步态1、单片机最小系统控制左前腿和右后腿的髋关节向前摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态2、单片机最小系统控制右前腿和左后腿的髋关节向前摆动角度为θ,右前腿和左后腿的膝关节保持直立;
步态3、单片机最小系统控制左前腿和右后腿的髋关节和膝关节保持直立;
步态4、单片机最小系统控制左前腿和右后腿的髋关节向前摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态5、单片机最小系统控制右前腿和左后腿的髋关节和膝关节保持直立,左前腿和右后腿的髋关节和膝关节保持直立。
行走载物装置的后退通过五个步态完成:
步态1:单片机最小系统控制左前腿和右后腿的髋关节向后摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态2:单片机最小系统控制右前腿和左后腿的髋关节向后摆动角度为θ,右前腿和左后腿的膝关节保持直立;
步态3、单片机最小系统控制左前腿和右后腿的髋关节和膝关节保持直立;
步态4、单片机最小系统控制左前腿和右后腿的髋关节向后摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态5、单片机最小系统控制右前腿和左后腿的髋关节和膝关节保持直立,左前腿和右后腿的髋关节和膝关节保持直立;
行走载物装置的左转通过四个步态完成:
步态1、单片机最小系统控制右前腿和左后腿的髋关节向前摆动角度为θ,右前腿和左后腿的膝关节保持直立;
步态2、单片机最小系统控制左前腿和右后腿的髋关节向前摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态3、单片机最小系统控制右前腿和左后腿的髋关节和膝关节保持直立;
步态4、单片机最小系统控制左前腿和右后腿的髋关节和膝关节保持直立;
行走载物装置的右转通过四个步态完成:
步态1、单片机最小系统控制左前腿和右后腿的髋关节向前摆动角度为θ,左前腿和右后腿的膝关节保持直立;
步态2、单片机最小系统控制右前腿和左后腿的髋关节向前摆动角度为θ,右前腿和左后腿的膝关节保持直立;
步态3、单片机最小系统控制左前腿和右后腿的髋关节和膝关节保持直立;
步态4、单片机最小系统控制右前腿和左后腿的髋关节和膝关节保持直立。
本发明具有以下优点:
(1)本发明采用腿式结构,机械结构简单;四条腿(每条腿的两个关节:髋关节和膝关节),每个腿关节上装有舵机;稳定性强、速度快、行走距离长,能够在复杂环境中行走;
(2)软硬件控制简单方便,系统响应速度快;微处理采用STC12C5A60S2单片机芯片;该芯片属于8051系列单片机的一种,但与普通51单片机相比有以下特点:同样晶振的情况下,速度是普通51的8~12倍;有8路10位AD;有4个16位定时器,2路PWM;有SPI接口;有EEPROM;有1K内部扩展RAM;有WATCH_DOG;双串口;IO口可以定义(含四种状态);中断优先级有四种状态可定义;软件采用模糊PID的控制算法,提高了行走载物装置的稳定性和可靠性;
(3)仿生性强;本发明步态采用模拟哺乳动物行走姿态,使基于Android手机控制的行走载物装置能够快速稳定的行走在复杂的环境中;根据行走载物装置要完成的任务(运动控制、稳定控制)及当前运行的地形环境(不平整地形、斜坡地形等)信息对受力腿步态和运动腿步态进行规划;受力腿,指的是将两条对角线上的两条腿分别等效为一条受力腿;将受力腿步态分解到对角线前、后两条腿上,完成支撑的步态;剩下两条腿为运动退,运动腿完成踢腿的步态;
(4)使用Android手机控制便于携带,移动性强;该控制系统性能可靠,成本低,不依赖网络,能够很好地实现对行走载物装置运动的控制;Android手机使用频率十分高,早已融入人们的日常生活,所以使用Android手机控制十分的方便,避免了出现因遗忘携带控制器而不能操作控制装置的情况;
综上所述,本发明具有运动灵活、稳定性好,能够以静态步行方式实现不平地面及复杂地形上的行走,在抢险救灾、排雷、探险、娱乐及军事等许多方面有很好的应用前景。
附图说明
图1是本发明的原理框图;
图2是本发明中的正常行走状态下的前进步态图;
图3是本发明的控制流程图;
图4是本发明的自动控制模式流程图;
图5是本发明的手动控制模式流程图;
图6是本发明中单片机最小系统的原理图;
图7是本发明中5V稳压模块的原理图;
图8是本发明中6V稳压模块的原理图;
图9是本发明中舵机的内部结构图。
具体实施方式
下面结合附图对本发明作进一步说明:
如图1所示的基于智能终端3控制的行走载物装置,包括智能终端3、载物平台16、四条腿、八个舵机8、超声波传感器6、传感器模块5、单片机最小系统9、无线通信模块4、5V稳压模块2、6V稳压模块7和电源模块1。
如表1所示,智能终端3采用Android手机,在Android手机上设置有六个指令键,其中:“S1”表示启动,“S2”表示停止,“S3”表示前进,“S4”表示后退,“S5”表示左转,“S6”表示右转;Android手机通过这六个指令键来发送控制指令给单片机最小系统9。
表1
智能终端3用于发送控制指令。载物平台16用于搭载物品。四条腿对称设置在载物平台16的左右两边,用于行走且支撑载物平台16,每个腿包括髋关节14和膝关节15,在各髋关节14和各膝关节15上均设有舵机8,并在每条腿的足底设有耐摩擦的橡胶17,使其行走时脚与地面的摩擦能够增大。超声波传感器6设置在载物平台16的前边缘,用于探测前方障碍物。传感器模块5由加速度计和陀螺仪组成,该传感器模块5安装在载物平台16的下方,用于检测载物平台16的倾斜角度值。单片机最小系统9分别与超声波传感器6、传感器模块5以及各舵机8连接,基于超声波传感器6及传感器模块5所采集的数据对各舵机8进行控制;单片机最小系统9还与智能终端3进行无线通信,接收智能终端3所发出的控制指令,并基于该控制指令对各舵机8进行控制。无线通信模块4与单片机最小系统9连接,用于实现单片机最小系统9与智能终端3的无线通信。电源模块1采用的是12V锂电池,12V锂电池经5V稳压模块2稳压后为单片机最小系统9、无线通信模块4、超声波传感器6、传感器模块5供电,12V锂电池还经6V稳压模块7稳压后为各舵机8供电。电源模块1为整个系统工作提供所需的电压,是系统执行任务的基础。电源模块1设计了一个开关,方便控制;另外,还有指示灯,可以检测电源是否正常供电。
如图1、图7和图8所示,在舵机8驱动过程中,将舵机驱动和单片机最小系统9分开供电,可以避免电流波动影响行走载物装置运动稳定性。单片机最小系统9的额定电压为5V,采用集成稳压芯片LM2956S-5.0供电;舵机8驱动部分的额定电压为6V,估算额定电流约5A,采用可调整型双路集成稳压芯片LM2596_ADJ供电,最大输出电流能够到达6A。行走载物装置使用的是大扭矩的MG995舵机8,参考电压为Vref=1.23V,因此实际输出电压Vout=Vref(1+R1/R2)=1.23(1+4.3K/1K)≈6.519V。
如图6所示,单片机最小系统9采用STC12C5A60S2单片机,STC12C5A60S2单片机的硬件结构具有功能部件种类全,功能强等特点。它有1个全双工的串行口,具有四种工作方式。其外围电路较为简单,包括外接12M无源晶振,用于指示的发光二极管。具有15个PWM12输出端子,最多可控制15个伺服电机。
本发明中所述传感器模块5的型号为MPU-6050,该传感器模块5整合了三轴传感器陀螺仪和加速度计,MPU-6050的角速度全格感测范围为±250、±500、±1000与±2000°/sec(dps),可准确追踪快速与慢速动作。传感器模块5安装在行走载物装置载物平台16的下方,通过传感器模块5来检测行走载物装置的载物平台16的倾斜角度值,从而得到行走载物装置的姿态。传输可通过最高至400kHz的I2C或最高达20MHz的SPI。它将感测到的髋关节14和膝关节15的偏向角度信号通过I2C端口传输到单片机最小系统9处理。
本发明中所述超声波传感器6的型号为HC-SR04,可提供2cm~400cm的非接触式距离感测功能,测距精度可达高到3mm;包括超声波发射器、接收器与控制电路。基本工作原理:(1)采用IO口TRIG触发测距,给至少10us的高电平信号;(2)模块自动发送8个40khz的方波,自动检测是否有信号返回;(3)有信号返回,通过IO口ECHO输出一个高电平,高电平持续的时间就是超声波从发射到返回的时间。测试距离=(高电平时间*声速(340M/S))/2。
由于超声波遇到障碍物时发生像光一样的反射和散射,在经过多次发射之后再回到超声波检测端口会产生较严重的路程差,从而影响对距离的检测进而影响对障碍物的较准确定位。本发明通过软件内部校准优化消除外部物理条件造成的误差从而达到对障碍物的较准确定位。采用双比器整形电路,Vm为峰值电压,设V1为比较器1的门限电压,V2为比较器2的门限电压,(其中(V2>V1,其值由实验设定),当超声波传感器6发射超声波时,最小系统定时器t1和t0同时开始计时,当比较器1翻转时,t0停止计时,此时t0所计的时间为t1,当较器2翻转时,t1停止计时,此时t1所计时间为t2,显然t2>t1,t是回波前沿所对应的传播时间,用t计算距离可减少由于反射和漫反射产生的误差。
如图9所示,本发明中所述舵机8的型号为MG995,由空心杯电机23、金属齿轮组24、双滚珠轴承20、传感器21和控制电路22组成,通过发送信号,指定输出轴旋转角度。舵机8的连接线长度为30厘米,尺寸为40mm*20mm*36.5mm,重62g,无负载时舵机8速度0.17秒/60度(4.8V)或是0.13秒/60度(6.0V),工作扭矩是13KG/cm,使用温度范围为-30至+60摄氏度,死区设定为4微秒,工作电压为3.0V-7.2V。舵机8进行降速处理可以避免的基于Android手机控制的行走载物装置关节运动产生的较大冲击。舵机8的可转角范围为:0~180°,可控脉宽范围:0.5~2.5ms,则脉宽每改变0.05ms,相应的舵机8转角将改变4.5°。若行走载物装置腿部关节需要转动27°,即脉宽需要变化0.3ms。那么将0.3ms脉宽分六次(每次延时时间为40ms)发送给舵机8内部的控制器,在宏观上就可以实现不同速度的变化,因此可以实现舵机8的降速。
本发明所述的基于智能终端3控制的行走载物装置还包括与单片机最小系统9连接的模式切换按键11和模式指示灯10,通过按下模式切换按键11来进行手动控制模式和自动控制模式的切换。当模式指示灯10亮表示手动控制模式,当模式指示灯10灭为自动控制模式。
如图3所示,本发明所述的基于智能终端3控制的行走载物装置的控制方法,包括自动控制模式和手动控制模式。
如图4所示,在自动控制模式下:
a、传感器模块5检测载物平台16的倾斜角度值T_ANGEL并传送给单片机最小系统9,超声波传感器6探测前方是否有障碍物并传送给单片机最小系统9。
b、单片机最小系统9基于该倾斜角度值T_ANGEL控制PWM波的占空比实现对各舵机8输出轴旋转角度的控制,从而控制髋关节14和膝关节15的摆动角度,使行走载物装置循环执行前进动作;当超声波传感器6探测到前方有障碍物时,单片机最小系统9控制行走载物装置执行右转(或左转)动作,绕过障碍物后再循环执行前进动作。
具体如下;行走载物装置向前爬行一个步态,再进行超声波距离检测,然后根据超声波所返回来的距离数据判断是否有障碍物。如果靠近障碍物距离过近,则行走载物装置调用右转步态程序,绕过障碍物,再又向前爬行。如果没有,则继续向前爬行。
载物物平台的倾斜角度值T_ANGEL的计算方法,利用两次获得的数据采用积分补偿法,进行积分混合运算得出载物平台16的倾角度。
载物物平台的倾斜角度值T_ANGEL的计算公式如下:
T_ANGEL=(G_VALUE-G_OFFSET)*Kgyro+ΣD_VALUE*(1/T);
其中:G_VALUE为陀螺仪采集的值,G_OFFSET为陀螺仪的零偏值,Kgyro为陀螺仪的比例值,D_VALUE为加速度计所获得的倾斜角度,T为积分时间常数;
如图5所示,在手动控制模式下:
单片机最小系统9基于智能终端3所发送的控制指令控制PWM波的占空比实现对各舵机8转动角度的控制,从而控制髋关节14和膝关节15的摆动角度,使行走载物装置完成该控制指令所对应的动作,该控制指令包括前进、后退、左转、右转、启动及停止动作。具体如下:首先用户打开手机调用蓝牙连接,使手机和单片机最小系统9连接,然后再按下手机上的启动S1按键启动手动控制模式。之后用户根据实际环境是否有障碍物来决定行走载物装置的前进/后退或者是左转/右转。
如图2所示,行走载物装置的前进通过五个步态完成:
步态1、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向前摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态2、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14向前摆动角度为θ,右前腿12和左后腿18的膝关节15保持直立。
步态3、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14和膝关节15保持直立。
步态4、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向前摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态5、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14和膝关节15保持直立,左前腿13和右后腿17的髋关节14和膝关节15保持直立。
行走载物装置的后退通过五个步态完成:
步态1:单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向后摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态2:单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14向后摆动角度为θ,右前腿12和左后腿18的膝关节15保持直立。
步态3、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14和膝关节15保持直立。
步态4、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向后摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态5、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14和膝关节15保持直立,左前腿13和右后腿17的髋关节14和膝关节15保持直立。
行走载物装置的左转通过四个步态完成。
步态1、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14向前摆动角度为θ,右前腿12和左后腿18的膝关节15保持直立。
步态2、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向前摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态3、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14和膝关节15保持直立。
步态4、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14和膝关节15保持直立。
行走载物装置的右转通过四个步态完成:
步态1、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14向前摆动角度为θ,左前腿13和右后腿17的膝关节15保持直立。
步态2、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14向前摆动角度为θ,右前腿12和左后腿18的膝关节15保持直立。
步态3、单片机最小系统9根据PWM波的占空比控制左前腿13和右后腿17的髋关节14和膝关节15保持直立。
步态4、单片机最小系统9根据PWM波的占空比控制右前腿12和左后腿18的髋关节14和膝关节15保持直立。
在手动控制模式下,用户可根据实际需要转向的角度来增加左转或左转按键的次数。
Claims (10)
1.一种基于智能终端控制的行走载物装置,包括:
智能终端(3),用于发送控制指令;
载物平台(16),用于搭载物品;
四条腿,对称设置在载物平台(16)的左右两边,用于行走且支撑载物平台(16),每个所述腿包括髋关节(14)和膝关节(15),在各髋关节(14)和各膝关节(15)上均设有舵机(8);
超声波传感器(6),该超声波传感器(6)设置在载物平台(16)的前边缘,用于探测前方障碍物;
传感器模块(5),由加速度计和陀螺仪组成,该传感器模块(5)安装在载物平台(16)的下方,用于检测载物平台(16)的倾斜角度值,该倾斜角度值T_ANGEL的计算公式如下:
T_ANGEL=(G_VALUE-G_OFFSET)*Kgyro+∑D_VALUE*(1/T);
其中:G_VALUE为陀螺仪采集的值,G_OFFSET为陀螺仪的零偏值,Kgyro为陀螺仪的比例值,D_VALUE为加速度计所获得的倾斜角度,T为积分时间常数;
单片机最小系统(9),该单片机最小系统(9)分别与超声波传感器(6)、传感器模块(5)以及各舵机(8)连接,单片机最小系统(9)基于倾斜角度值T_ANGEL控制PWM波的占空比实现对各舵机转动角度的控制,从而控制髋关节(14)和膝关节(15)的摆动角度,使行走载物装置循环执行前进动作;当超声波传感器(6)探测到前方有障碍物时,单片机最小系统(9)控制行走载物装置执行右转或左转动作,绕过障碍物后再循环执行前进动作;
单片机最小系统(9)还与智能终端(3)进行无线通信,单片机最小系统(9)基于智能终端(3)所发送的控制指令控制PWM波的占空比实现对各舵机输出轴旋转角度的控制,从而控制髋关节(14)和膝关节(15)的摆动角度,使行走载物装置完成该控制指令所对应的动作,该控制指令包括前进、后退、左转、右转、启动及停止动作;
无线通信模块(4),该无线通信模块(4)与单片机最小系统(9)连接,用于实现单片机最小系统(9)与智能终端(3)的无线通信;
电源模块(1),该电源模块(1)经5V稳压模块(2)稳压后为单片机最小系统(9)、无线通信模块(4)、超声波传感器(6)、传感器模块(5)供电,电源模块(1)还经6V稳压模块(7)稳压后为各舵机(8)供电。
2.根据权利要求1所述的基于智能终端控制的行走载物装置,其特征在于:在每条腿的足底均设有橡胶(19)。
3.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:所述单片机最小系统(9)采用的控制芯片为STC12C5A60S2。
4.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:所述舵机(8)的型号为MG995。
5.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:所述超声波传感器(6)的型号为HC-SR04。
6.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:所述传感器模块(5)的型号为MPU-6050。
7.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:所述智能终端(3)为Android手机,在Android手机上设置有六个指令键,其中:“S1”表示启动,“S2”表示停止,“S3”表示前进,“S4”表示后退,“S5”表示左转,“S6”表示右转;Android手机通过这六个指令键来发送控制指令给单片机最小系统(9)。
8.根据权利要求1或2所述的基于智能终端控制的行走载物装置,其特征在于:还包括与单片机最小系统(9)连接的模式切换按键(11)和模式指示灯(10)。
9.一种如权利要求1至8任一所述的基于智能终端控制的行走载物装置的控制方法,其特征在于:包括自动控制模式和手动控制模式;
在自动控制模式下:
a、传感器模块(5)检测载物平台(16)的倾斜角度值T_ANGEL并传送给单片机最小系统(9),超声波传感器(6)探测前方是否有障碍物并传送给单片机最小系统(9);
所述倾斜角度值T_ANGEL的计算公式如下:
T_ANGEL=(G_VALUE-G_OFFSET)*Kgyro+∑D_VALUE*(1/T);
其中:G_VALUE为陀螺仪采集的值,G_OFFSET为陀螺仪的零偏值,Kgyro为陀螺仪的比例值,D_VALUE为加速度计所获得的倾斜角度,T为积分时间常数;
b、单片机最小系统(9)基于该倾斜角度值T_ANGEL控制PWM波的占空比实现对各舵机转动角度的控制,从而控制髋关节(14)和膝关节(15)的摆动角度,使行走载物装置循环执行前进动作;当超声波传感器(6)探测到前方有障碍物时,单片机最小系统(9)控制行走载物装置执行右转或左转动作,绕过障碍物后再循环执行前进动作;
在手动控制模式下:
单片机最小系统(9)基于智能终端(3)所发送的控制指令控制PWM波的占空比实现对各舵机输出轴旋转角度的控制,从而控制髋关节(14)和膝关节(15)的摆动角度,使行走载物装置完成该控制指令所对应的动作,该控制指令包括前进、后退、左转、右转、启动及停止动作。
10.根据权利要求9所述的基于智能终端控制的行走载物装置的控制方法,其特征在于:行走载物装置的前进通过五个步态完成:
步态1、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向前摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态2、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)向前摆动角度为θ,右前腿(12)和左后腿(18)的膝关节(15)保持直立;
步态3、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
步态4、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向前摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态5、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)和膝关节(15)保持直立,左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
行走载物装置的后退通过五个步态完成:
步态1:单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向后摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态2:单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)向后摆动角度为θ,右前腿(12)和左后腿(18)的膝关节(15)保持直立;
步态3、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
步态4、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向后摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态5、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)和膝关节(15)保持直立,左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
行走载物装置的左转通过四个步态完成:
步态1、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)向前摆动角度为θ,右前腿(12)和左后腿(18)的膝关节(15)保持直立;
步态2、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向前摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态3、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)和膝关节(15)保持直立;
步态4、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
行走载物装置的右转通过四个步态完成:
步态1、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)向前摆动角度为θ,左前腿(13)和右后腿(17)的膝关节(15)保持直立;
步态2、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)向前摆动角度为θ,右前腿(12)和左后腿(18)的膝关节(15)保持直立;
步态3、单片机最小系统(9)控制左前腿(13)和右后腿(17)的髋关节(14)和膝关节(15)保持直立;
步态4、单片机最小系统(9)控制右前腿(12)和左后腿(18)的髋关节(14)和膝关节(15)保持直立。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510079539.5A CN104679005B (zh) | 2015-02-14 | 2015-02-14 | 基于智能终端控制的行走载物装置及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510079539.5A CN104679005B (zh) | 2015-02-14 | 2015-02-14 | 基于智能终端控制的行走载物装置及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104679005A CN104679005A (zh) | 2015-06-03 |
CN104679005B true CN104679005B (zh) | 2017-05-17 |
Family
ID=53314233
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510079539.5A Expired - Fee Related CN104679005B (zh) | 2015-02-14 | 2015-02-14 | 基于智能终端控制的行走载物装置及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104679005B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106331624B (zh) * | 2016-08-29 | 2019-01-29 | 国网山东省电力公司鄄城县供电公司 | 一种变电站无死角监控装置 |
CN107200010B (zh) * | 2017-05-08 | 2020-04-14 | 纳恩博(北京)科技有限公司 | 一种控制方法、驱动装置、载物装置及车辆 |
CN108194399A (zh) * | 2018-01-08 | 2018-06-22 | 广东工业大学 | 一种风扇控制的方法以及智能风扇 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101746431A (zh) * | 2010-02-03 | 2010-06-23 | 常爱军 | 一种可以由内燃机刚性传递驱动力的四足步行机器人 |
CN101758867A (zh) * | 2010-02-03 | 2010-06-30 | 常爱军 | 一种采用复合驱动方式的四足步行机器人 |
CN201673409U (zh) * | 2010-05-28 | 2010-12-15 | 王建中 | 智能蜘蛛机器人装置 |
CN202130526U (zh) * | 2011-06-14 | 2012-02-01 | 北京工业大学 | 一种具有多传感器的桌面型智能六足机器人 |
CN103273982A (zh) * | 2013-04-27 | 2013-09-04 | 东莞市华虹电子有限公司 | 一种多功能全地形仿生机器人 |
CN203211418U (zh) * | 2013-04-27 | 2013-09-25 | 东莞市华虹电子有限公司 | 一种多功能全地形仿生机器人 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4513320B2 (ja) * | 2003-12-17 | 2010-07-28 | ソニー株式会社 | ロボット装置、並びにロボット装置の運動制御方法 |
TWI412467B (zh) * | 2011-04-11 | 2013-10-21 | Univ Nat Kaohsiung Applied Sci | 六足機械行走裝置 |
CN102591344B (zh) * | 2012-03-05 | 2013-12-11 | 中国人民解放军国防科学技术大学 | 四足仿生机器人的时位控制方法 |
-
2015
- 2015-02-14 CN CN201510079539.5A patent/CN104679005B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101746431A (zh) * | 2010-02-03 | 2010-06-23 | 常爱军 | 一种可以由内燃机刚性传递驱动力的四足步行机器人 |
CN101758867A (zh) * | 2010-02-03 | 2010-06-30 | 常爱军 | 一种采用复合驱动方式的四足步行机器人 |
CN201673409U (zh) * | 2010-05-28 | 2010-12-15 | 王建中 | 智能蜘蛛机器人装置 |
CN202130526U (zh) * | 2011-06-14 | 2012-02-01 | 北京工业大学 | 一种具有多传感器的桌面型智能六足机器人 |
CN103273982A (zh) * | 2013-04-27 | 2013-09-04 | 东莞市华虹电子有限公司 | 一种多功能全地形仿生机器人 |
CN203211418U (zh) * | 2013-04-27 | 2013-09-25 | 东莞市华虹电子有限公司 | 一种多功能全地形仿生机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN104679005A (zh) | 2015-06-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105599821B (zh) | 具有环境感知能力的电驱动仿生四足机器人及控制方法 | |
WO2021247292A1 (en) | Systems and methods for a compressed controller for an active exoskeleton | |
CN104679005B (zh) | 基于智能终端控制的行走载物装置及控制方法 | |
CN101673116B (zh) | 仿人机器人初始位置精确复位系统 | |
CN103481965B (zh) | 一种基于智能终端的低功耗行走装置及控制方法 | |
CN105005249A (zh) | 一种全自动四轮双核高速灭火机器人伺服控制器 | |
US20220031552A1 (en) | Systems and methods for bilateral wireless communication | |
CN107914789B (zh) | 移动终端控制的智能仿生步行机器人 | |
CN204929965U (zh) | 宠物智能穿戴装置 | |
CN106267781A (zh) | 用于体育训练的防水型动作捕捉系统 | |
CN102372042A (zh) | 一种双足机器人的运动规划系统 | |
CN117021106A (zh) | 机器人的步态控制方法和机器人 | |
CN203535485U (zh) | 基于arm9两轮微电脑鼠探索控制器 | |
CN103600786A (zh) | 一种智能机器猫 | |
CN209878995U (zh) | 一种基于窄带物联网的运动物体姿态定位装置 | |
CN106363625A (zh) | 一种基于操控员足部位姿传感器的四足机器人遥操作方式 | |
CN208132976U (zh) | 一种六足仿生机器人控制系统 | |
Li et al. | Design and implementation of a boxing robot based on fuzzy control | |
Krause et al. | Gaussian process regression for sim-to-real transfer of hopping gaits | |
CN220575934U (zh) | 一种基于机器视觉的健康管理桌面机器人及其控制系统 | |
CN206288109U (zh) | 自适应运动多关节行走机器人 | |
CN110077183A (zh) | 一种三栖机器人 | |
CN221794772U (zh) | 一种球形足式两用机器人及侦测系统 | |
CN203535487U (zh) | 基于双核四轮极速微电脑鼠对角线冲刺系统 | |
Wang et al. | Design of control algorithm of wheeled robot based on Wi-Fi and inertial navigation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170517 Termination date: 20190214 |