【技术实现步骤摘要】
本专利技术涉及机器人，具体涉及一种四足履带机器人控制平衡与修正导航方向的行进方法。
技术介绍
1、当前国内甚少有能够在复杂的地形下能够进行救援以及进行补给的机器人，轮式机器人和四足式机器人是其中的两种，其中轮式机器人主要有轮子或履带等结构驱动，其动力较为强劲，实用性广泛；而四足式机器人有更强的灵活性，但行进速度相对较慢，机器人的背部可以承载一定重量的物资，在一些自然灾害中可以为提供补给援助。
2、而中国专利申请号为202210366509.2，公布日为2022.07.08的专利文献，其公开了一种四足机器人基于trot步态的平衡控制算法，该方法包括以下步骤：s1、设计四足机器人的步态，并给出步态时序图；s2、搭建平衡控制框图，从期望状态的输入到期望关节力矩的输出，根据四足机器人期望状态的导数和当前状态，求得期望的地面反作用力，地面反作用力包括沿x、y轴的摩擦力和沿z轴的支撑力，再根据期望的地面反作用力和四足机器人单腿的雅可比矩阵求得期望的关节力矩的大小，用以保证四足机器人最基本的平衡控制，解决了四足机器人在任一时刻下都处于自不稳定的状态的问题。
3、该专利文献通过搭建平衡控制框图，根据四足机器人期望状态的导数和当前状态，期望的地面反作用力和四足机器人单腿的雅可比矩阵求得期望的关节力矩的大小，用以保证四足机器人基本的平衡控制，但是该方法在机器人出现路线偏离需要修正而做出姿态调整时，但是该方法主要是通过trot算法对姿态进行调整，而对于不同的机器人其由于腿部长度的区别从而使得不同机器人能转动角度上有所区别，从而
技术实现思路
1、本专利技术的目的在于提供一种四足履带机器人控制平衡与修正导航方向的行进方法，使得机器人在修正偏离路线时，能实现姿态修正，且通用性好，且方法可靠性好。
2、为达到上述目的，一种四足履带机器人控制平衡与修正导航方向的行走方法，四足履带机器人包括躯体和腿部结构，所述腿部结构包括舵机驱动装置、第一限位连接组件、第二限位连接组件和履带驱动装置，所述舵机驱动装置通过舵机连接件设置在所述躯体的两侧，所述舵机驱动装置包括舵机一、u形连接件、舵机固定板和舵机二，所述舵机二的输出轴端通过连接外壳与所述履带驱动装置转动连接，所述u形连接件的一端与所述舵机一的输出轴端转动连接，所述u形连接件的另一端通过舵机固定板与所述舵机二固定连接，所述履带驱动装置通过连接外壳与所述舵机驱动装置转动连接；
3、所述方法包括以下步骤：
4、（1）预设行进路线，开启行进指令，驱使机器人开始行进；
5、（2）传感器实时监测机器人是否偏离路线，包括（2.1）-（2.3）；
6、（2.1）陀螺仪实时检测加速度，获取加速度的大小和方向；
7、（2.2）判别加速度出现偏移现象或加速度方向与预设行进路线的方向不在同一水平线上，则识别为机器人偏离了预设的行进路线；
8、（2.3）若识别到机器人偏离了预设的行进路线，陀螺仪记录当前状态加速度的大小和方向，并将数据传送给控制模块；
9、（3）控制模块发出修正指令；
10、（4）检测舵机一和舵机二的状态，并修正机器人的路线；（4）具体包括（4.1）-（4.3）；
11、（4.1）建立xyz空间坐标系，根据小腿长度、大腿长度、小腿与大腿之间的连接长度以及足端坐标计算舵机一转角和舵机二转角；
12、（4.2）将舵机一转角和舵机二转角以及trot步态算法，进而转换为舵机一和舵机二的修正角度，同时舵机一和舵机二在向修正角度转动时，在行进的前t/4处于加速状态，在行进中的t/2处于匀速状态，在行进的后t/4处于减速状态，t为trot步态算法中预设的一个步态周期，完成平衡控制下的行进姿态调整，实现修正路线；
13、（4.3）当通过舵机一和舵机二转角与trot步态算法结合调整行进姿态时，若检测到机器人前方具有障碍物，确定腿部结构的力矩的大小，若腿部结构的力矩大于最高堵转力矩，则退出trot步态算法调整行进姿态或使得腿部结构切换到trot行走周期中的摆动项。
14、以上设置，通过设置舵机连接件将舵机驱动安装连接在躯体的两侧，能够通过腿部结构带动躯体行进；在舵机一与舵机二之间设置u形连接件，通过u形连接件将舵机一和舵机二转动连接，从而能够通过舵机一带动舵机二进行转动；而舵机驱动装置通过连接外壳与履带驱动连接，进而通过舵机二转动带动履带驱动实现仿生步态行进，并且可以灵活地转换成履带驱动，舵机驱动装置静止，同时保持履带与地面紧贴，通过驱动电机带动履带转动，从而实现机器人稳定高效行进，同时在四足行进过程中，根据腿部的长度以及足端的坐标确定大腿的驱动舵机二以及大腿与小腿之间驱动舵机一的转动角度，然后根据转动角度确定期待的姿势，并通过trot算法得到之后的姿势修正，这样能在根据不同的机器人之后无需对机器人的转动角度的设置进行逐一设置，通用性强，另外通过确定舵机一和舵机二的转动角度之后可以确定为了实现足端坐标下确保在行进路线下进行行进方向的调整，然后结合trot算法进行姿态调整，从而使得姿态调整更加可靠有效，另外由于在遇到障碍物时，通过计算腿部结构的力矩是否超出预设值，在超出预设值之后将不再进行步态调整或使得腿部结构切换到trot行走周期中的摆动项，这样使得超负荷的腿部结构不再受到过多的支撑力的冲击从而损坏机器人，可靠性高。
15、进一步的，所述第一限位连接组件包括第一连接杆、第一限位环、第一圆盘，所述第一圆盘通过横杆与所述舵机固定板固定连接，所述第一圆盘上设有第一凸块，所述第一限位环套接在第一凸块上，第一限位环的一端与第一连接杆的一端相连，所述第一连接杆的另一端与所述u形连接件连接，所述第二限位连接组件包括第二连接杆、第二限位环、第二圆盘，所述第二圆盘通过横杆与所述舵机固定板固定连接，所述第二圆盘上设有第二凸块，所述第二限位环套接在第二凸块上，第二限位环的一端与第二连接杆的一端相连，所述第二连接杆的另一端与第二舵盘连接，所述舵机二的输出轴端通过连接外壳与所述履带驱动装置转动连接。
16、以上设置，当需要通过四足进行行走时，通过驱动舵机一和舵机二进行工作从而腿部姿态之间切换进而实现四足进行行走，当需要通过履带进行行进时，舵机驱动装置静止，同时保持履带与地面紧贴，由于第一限位连接组件中第一连接杆的另一端与u形连接件相连，第一连接杆的一端与第一限位环套接，第二限位连接组件具有相同结构设置，从而使得履带与底面相贴合时，受到底面向上的力时，第一凸块和第二凸块分别在第一限位环以及第二限位环移动到最顶端，从而防止躯体受到地面本文档来自技高网...
【技术保护点】
1.一种四足履带机器人控制平衡与修正导航方向的行进方法，四足履带机器人包括躯体和腿部结构，其特征在于：所述腿部结构包括舵机驱动装置、第一限位连接组件、第二限位连接组件和履带驱动装置，所述舵机驱动装置通过舵机连接件设置在所述躯体的两侧，所述舵机驱动装置包括舵机一、U形连接件、舵机固定板和舵机二，所述舵机二的输出轴端通过连接外壳与所述履带驱动装置转动连接，所述U形连接件的一端与所述舵机一的输出轴端转动连接，所述U形连接件的另一端通过舵机固定板与所述舵机二固定连接，所述履带驱动装置通过连接外壳与所述舵机驱动装置转动连接；
2.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述第一限位连接组件包括第一连接杆、第一限位环、第一圆盘，所述第一圆盘通过横杆与所述舵机固定板固定连接，所述第一圆盘上设有第一凸块，所述第一限位环套接在第一凸块上，第一限位环的一端与第一连接杆的一端相连，所述第一连接杆的另一端与所述U形连接件连接，所述第二限位连接组件包括第二连接杆、第二限位环、第二圆盘，所述第二圆盘通过横杆与所述舵机固定板固定连接，所述第二圆盘上设有第
3.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述躯体上设置有控制模块；在所述躯体的顶部设置有用于识别和检测前方的行进路况的摄像头，摄像头与控制模块电连接；所述履带驱动装置包括履带、履带固定件和驱动电机，所述履带固定件设置在所述履带上并设有通孔，所述驱动电机的输出端穿过通孔与所述履带转动连接，用于驱动所述履带转动；
4.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述舵机固定板包括第一舵机固定板和第二舵机固定板；所述舵机连接件上设有通孔，所述舵机连接件的一端与所述躯体连接，所述舵机连接件的另一端通过第一舵机固定板与所述舵机一固定连接；
5.根据权利要求4所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述U形连接件上设置有通孔，所述U形连接件的一端与所述舵机一的输出轴端转动连接，所述U形连接件的另一端通过第二舵机固定板与所述舵机二固定连接。
6.根据权利要求5所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述舵机二的输出轴端与第二舵盘转动连接，所述连接外壳的一端与第二舵盘连接，所述连接外壳的另一端与履带固定件连接。
7.根据权利要求6所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述第二舵盘与所述第二连接杆的一端连接，所述第二连接杆的另一端与所述第二限位环的一端连接，所述第二限位环的另一端套接在第二凸块上。
8.根据权利要求4所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述U形连接件靠近所述舵机一输出轴端的一端与所述第一连接杆的一端固定连接，舵机一的输出轴端通过第一舵机与U形连接件转动连接，所述第一连接杆的另一端与所述第一限位环的一端连接，所述第一限位环的另一端套接在第一凸块上。
9.根据权利要求4所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：第二连接件包括第二一连接杆和第二二连接杆，第二一连接杆的一端与第二限位环铰接，第二一连接杆的另一端与第二二连接杆的一端固定连接，第二二连接杆的另一端设置有第二弧形杆，第二弧形杆与第二舵盘的外周壁相贴，第二弧形杆固定在设置连接外壳上，第二一连接杆的另一端与第二二连接杆一端具有夹角。
10.根据权利要求4所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：第一连接件包括第一一连接杆和第一二连接杆，第一一连接杆的一端与第一限位环铰接，第一一连接杆的另一端与第一二连接杆的一端固定连接，第一二连接杆的另一端设置有第一弧形杆，第一弧形杆与第一舵盘的外周壁相贴，第一弧形杆固定在设置U形连接件上，第一一连接杆的另一端与第一二连接杆一端具有夹角。
...【技术特征摘要】
1.一种四足履带机器人控制平衡与修正导航方向的行进方法，四足履带机器人包括躯体和腿部结构，其特征在于：所述腿部结构包括舵机驱动装置、第一限位连接组件、第二限位连接组件和履带驱动装置，所述舵机驱动装置通过舵机连接件设置在所述躯体的两侧，所述舵机驱动装置包括舵机一、u形连接件、舵机固定板和舵机二，所述舵机二的输出轴端通过连接外壳与所述履带驱动装置转动连接，所述u形连接件的一端与所述舵机一的输出轴端转动连接，所述u形连接件的另一端通过舵机固定板与所述舵机二固定连接，所述履带驱动装置通过连接外壳与所述舵机驱动装置转动连接；
2.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述第一限位连接组件包括第一连接杆、第一限位环、第一圆盘，所述第一圆盘通过横杆与所述舵机固定板固定连接，所述第一圆盘上设有第一凸块，所述第一限位环套接在第一凸块上，第一限位环的一端与第一连接杆的一端相连，所述第一连接杆的另一端与所述u形连接件连接，所述第二限位连接组件包括第二连接杆、第二限位环、第二圆盘，所述第二圆盘通过横杆与所述舵机固定板固定连接，所述第二圆盘上设有第二凸块，所述第二限位环套接在第二凸块上，第二限位环的一端与第二连接杆的一端相连，所述第二连接杆的另一端与第二舵盘连接，所述舵机二的输出轴端通过连接外壳与所述履带驱动装置转动连接。
3.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述躯体上设置有控制模块；在所述躯体的顶部设置有用于识别和检测前方的行进路况的摄像头，摄像头与控制模块电连接；所述履带驱动装置包括履带、履带固定件和驱动电机，所述履带固定件设置在所述履带上并设有通孔，所述驱动电机的输出端穿过通孔与所述履带转动连接，用于驱动所述履带转动；
4.根据权利要求1所述的一种四足履带机器人控制平衡与修正导航方向的行进方法，其特征在于：所述舵机固定板包括第一舵机固定板和第二舵机固定板；所述舵机连接件上设有通孔，所述舵机连接件的一端与所述躯体连接，所述舵机连接件的另一端通过第一舵机固定板...
【专利技术属性】
技术研发人员：缪文南，王子林，张亚楠，王豪，朱彦晓，杜龙飞，严仲宇，叶天淇，
申请(专利权)人：广州城市理工学院，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。