一种基于STM32控制的六足十八自由度的探险机器人制造技术

技术编号:13155785 阅读:102 留言:0更新日期:2016-05-09 18:35
一种基于STM32控制的六足十八自由度的探险机器人,其机体主要有腹板I和腹板II以及六个大腿和六个小腿组成,六足分为三组,构成并排侧链系统,在前胸、中胸和后胸各有一对,大腿和小腿之间用舵机链接,每一个链接处设为一个基节,腿节是最长最粗的一节,行走是以三条腿为一组进行的,即一侧的前、后足与另一侧的中足为一组,形成一个三角形支架结构,当这三条腿放在地面分别于舵机基准零度持平向后蹬的动作时,另外三条腿相应被驱动基节位于30度,即抬起向前准备替换,前足用爪固定物体后拉动机体向前,中足用来支持并举起所属一侧的身体,后足则推动虫体前进,同时使机体转向,这种行走方式使机体可以随时随地停息下来,能够在复杂地形保持稳态而使中心平稳。

【技术实现步骤摘要】
【专利说明】
:机械制造、自动化装备与五金设备领域。
技术介绍
:由于复杂地形或危险作业环境下,对于施工人员和维修人员存在着很大的安全隐患,尤其在火灾现场和核污染源地抢险作业的时,需要更高的技术和更精确度的测量数据。所以复杂地智能机器人的应用必不可少。
技术实现思路
:一种六足十八自由度的探险机器人,机器人主要应用仿生学,其机体主要有腹板I和腹板II以及六个大腿和六个小腿组成;六足分为三组,构成并排侧链系统,足是整个系统的运动器官。机器人共有3对足,在前胸、中胸和后胸各有一对。大腿和小腿之间用舵机链接,每一个链接处设为一个基节。大腿节和机体腹部转节紧密相连而实现紧凑和灵活的自由度需求。腿节是最长最粗的一节。行走是以三条腿为一组进行的,即一侧的前、后足与另一侧的中足为一组。这样就形成了一个三角形支架结构,当这三条腿放在地面分别于舵机基准零度持平表示向后蹬的动作时,另外三条腿相应被驱动基节于30度,即抬起向前准备替换。前足用爪固定物体后拉动机体向前,中足用来支持并举起所属一侧的身体,后足则推动虫体前进,同时使机体转向。这种行走方式使机体可以随时随地停息下来,因为重心总是落在三角支架之内。能够在复杂地形保持稳态而使中心平稳。六足机器人控制板可以分为电源模块、步进电机驱动电路模块、通讯模块和MP3模块,同时六组机器人还搭载摄像头模块。电源模块分为两部分,分别为步进电机供电电源和控制板供电电源,一点接地,采用两个电源可以有效的减小电机对控制板上芯片的干扰;步进电机驱动电路模块主要由PS0C最小系统板组成;通讯模块包括蓝牙模块和路由器模块。方案一、供电系统系统采用两个7.6V的大容量电池供电,通过电源芯片转换为所需的电源。其中,电池为TPS5430供电,TPS5430是D⑶C电源芯片,能提供3安培的电流输出,可以满足除步进电机以外其他部分的供电要求,PS0C芯片采用5伏供电,而蓝牙模块使用3.3伏供电,所以使用LM1117将5伏转为3.3伏。而19路步进电机的供电则相对麻烦,舵机在启动瞬间的启动电流可达7A,普通的稳压源无法满足要求,因此采用购买的电源模块,该模块能够提供8安培的持续电流,满足电机的供电要求。控制电路和舵机的供电也可以由一块锂电池,通过开关可以选择控制电路的供电来源。方案二、PS0C最小系统板电路方案三、步进电机驱动电路步进电机控制电路以PS0C最小板为核心,利用PS0C可编程的优点,在PS0CCreator中调用PWM、Timer模块,对个模块进行配置,由于有19路步进电机,所以使用10个PWM模块,每个模块对应两个步进电机,能够很方便的对步进电机进行控制。方案四、通信模块通信模块主要是蓝牙和路由器模块,主要用于和控制板进行通信,接受控制板的控制指令,构建一个局域网,实现将摄像头采集的信息发送到电脑终端,另一方面利用局域网实现android设备对六足机器人的控制,实现控制的多样化。MP3模块主要用于实现六足机器人的语音应答功能,在语音控制模式下实现六足机器人与控制者的互动,同时具备娱乐,播放音乐等功能。Mp3电路图主要有机部分组成:电源管理,STM32芯片,LD3320语音芯片和SD卡,其中SD卡存放音乐文件,LD3320实现音乐的播放。方案六、步态分析六足机器人共有8种步态:前进、后退、左转、右转、左移、右移、站立和休息状态。步态需要18个舵机之间进行相互配合才可以完成,为使容易扩展步态,此处采用了状态点数组的方式,所谓状态点数组的方式是指将每一个步态分割成几个独立的具有先后顺序的状态点,然后记录每个状态点的每个舵机的舵角值,然后存为数组,那么要完成一种步态就只需要按照数组的数据依次将每一舵机转至特定的状态点即可。六足机器人的步态数组由电脑客户端程序调试得到。站立和修状态只有一种状态,因此数组较为简单,但是”前进“、”后退“等动作由多个状态点组成,因此数组为多维数组。状态点数组的方式的优点就是容易进行步态的扩展,当需要一种新的步态时则只需要增加新的状态点数组即可,而不需要复杂的数学计算,但是其缺点也很明显,那就是步态的适用性差,当硬件发生变化时,步态数组就不准确,需要重新调整。本专利的核心内容:一种基于STM控制的六足十八自由度的探险机器人,设置机器人机体下腹板机构,上腹板结构,I组侧足左前转向基节分别和机体下腹板和上腹板链接,I组左中转向基节分别和机体下腹板和上腹板链接,I组左后转向基节分别和机体下腹板和上腹板链接,设置左前大腿和左前基节项链接,左中大腿和左中转向基节项链接,左后大腿和左后转向基节相连接,设置左如小腿和左肖U大腿基节相链,左中小腿和左中大腿基相链接,左后小腿和左后大腿基节相连接;至此I组左侧的侧向活动关节系统的结构设计完成组右前转向基节分别和机体下腹板和上腹板链接,I组右中转向基节分别和机体下腹板和上腹板链接,II组右后转向基节分别和机体下腹板和上腹板链接,设置右前大腿和右前转向基节项链接,右中大腿和右中转向基节项链接,右后大腿和右后转向基节相连接,设置右前小腿和右如大腿基节相链,右中小腿和右中大腿基相链接,右后小腿和右后大腿基节相连接;至此II组右侧的侧向活动关节系统的结构设计完成;其中左侧I组小腿基节、左前小腿基节1、左中小腿基节1、左后小腿基节分别和小腿、左前足小腿1、左中足小腿1、左后足小腿I相链接,右侧II组小腿基节、右前小腿基节I1、右中小腿基节I1、右后小腿基节II分别和右侧小腿、右前足小腿I1、右中足小腿I1、右后足小腿II相链接。一种基于STM控制的六足十八自由度的探险机器人,开启供电系统,为六足机器人提供动力源,下面详细分解其动作的实现过程,前进动作时,右侧II组系统的右前大腿基节,右后大腿基节,以及左侧系统的左中大腿基节分别驱动度,右侧II组系统的右前转向基节,右后转向基节,以及左侧系统的左中转向基节分别前移位度,右侧系统的右前大腿基节,右后大腿基节,以及左侧系统的左中大腿基节移位30度,右侧系统的右中大腿基节,左侧系统的左如大腿基节,以及左后大腿基节分别启动抬起度,右侧系统的右中转向基节,左侧系统的左前转向基节,以及左后转向基节分别前移度,同时右侧II组系统的右前大腿基节,右后大腿基节,以及左侧系统的左中大腿基节分别归位即为移动-度,右侧系统的右中大腿基节,左侧系统的左前大腿基节,以及左后足大腿基节分别放下即为移动30度;右侧II组系统的右前大腿基节,右后大腿基节,以及左侧系统的左中大腿基节分别再次抬起度,右侧II组系统的右前转向基节,右后转向基节,以及左侧系统的左中转向基节分别前移动度,同时右侧系统的右中大腿基节,左侧系统的左前大腿基节以及左后大腿基节分别归位;后退动作,左移动作,右移动作,左转动作,右转动作,在前进动作的基础上改变十八自由度的分步骤动作即可实现六足机器人的自由行使。一种六足十八自由度的探险机器人,机器人越障物理结构,包括转向子系统和摆腿子系统两部分。摆腿长度为240_,因此,当十八自由度的六足机器人所装备的超声传感器检测到障碍物高度低于300_时,控制系统控制摆腿与机体协调动作,越过障碍物。当检测到障碍物高度高于300_时,控制系统控制转向系统运动,实现机器人转向功能规避障碍物。调倾系统机器人的调倾系统是整体移动机本文档来自技高网...

【技术保护点】
一种基于STM控制的六足十八自由度的探险机器人,其特征为:设置机器人机体下腹板机构,上腹板结构,I组侧足左前转向基节分别和机体下腹板和上腹板链接,I组左中转向基节分别和机体下腹板和上腹板链接,I组左后转向基节分别和机体下腹板和上腹板链接,设置左前大腿和左前基节项链接,左中大腿和左中转向基节项链接,左后大腿和左后转向基节相连接,设置左前小腿和左前大腿基节相链,左中小腿和左中大腿基相链接,左后小腿和左后大腿基节相连接;至此I组左侧的侧向活动关节系统的结构设计完成;II组右前转向基节分别和机体下腹板和上腹板链接,I组右中转向基节分别和机体下腹板和上腹板链接,II组右后转向基节分别和机体下腹板和上腹板链接,设置右前大腿和右前转向基节项链接,右中大腿和右中转向基节项链接,右后大腿和右后转向基节相连接,设置右前小腿和右前大腿基节相链,右中小腿和右中大腿基相链接,右后小腿和右后大腿基节相连接;至此II组右侧的侧向活动关节系统的结构设计完成;其中左侧I组小腿基节、左前小腿基节I、左中小腿基节I、左后小腿基节分别和小腿、左前足小腿I、左中足小腿I、左后足小腿I相链接,右侧II组小腿基节、右前小腿基节II、右中小腿基节II、右后小腿基节II分别和右侧小腿、右前足小腿II、右中足小腿II、右后足小腿II相链接。...

【技术特征摘要】

【专利技术属性】
技术研发人员:张浩源尚心蕊王涛
申请(专利权)人:无锡津天阳激光电子有限公司
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1