一种水动力智能机器人及其控制方法与流程

文档序号:18736708发布日期:2019-09-21 01:17阅读:来源:国知局

技术特征:

1.一种水动力智能机器人,其特征在于,包括:姿态平衡系统、导航系统和动力控制系统;

所述姿态平衡系统,用于通过传感器组和卡尔曼滤波算法,确定水动力平台的实际测量角度和实际测量角速度;并根据实际测量角度、预期角度和实际测量角速度,通过双层PID控制算法,确定水动力平台的姿态平衡和运行控制的最终控制量;

所述导航系统,用于根据UWB标签和毫米波雷达,结合巡航轨迹,通过单层PID控制算法,确定水动力平台的预期角度;

所述动力控制系统:用于根据最终控制量,控制高压水泵通过水动力平台上的喷嘴向下喷水。

2.如权利要求1所述的水动力智能机器人,其特征在于,所述姿态平衡系统包括:传感器组、无线通讯模块和MCU微处理器,所述传感器组和所述无线通讯模块均与所述MCU微处理器电连接。

3.如权利要求1或2所述的水动力智能机器人,其特征在于,所述传感器组包括:陀螺仪、磁力传感器、加速度传感器和气压传感器。

4.如权利要求2所述的水动力智能机器人,其特征在于,所述姿态平衡系统还包括:电源模块,所述电源模块与所述MCU微处理器电连接。

5.如权利要求1所述的水动力智能机器人,其特征在于,所述导航系统包括:UWB标签、毫米波雷达和第一CPU处理器,所述UWB标签和所述毫米波雷达均与所述第一CPU处理器电连接。

6.如权利要求5所述的水动力智能机器人,其特征在于,所述导航系统还包括:第一RAM存储器,所述第一RAM存储器和所述第一CPU处理器电连接。

7.如权利要求1所述的水动力智能机器人,其特征在于,所述动力控制系统包括:水动力平台、喷嘴、第二CPU处理器、变频器、高压水泵和控制器,所述水动力平台底面的边缘均匀布设有若干喷嘴;

所述第二CPU处理器依次与所述变频器和所述高压水泵电连接,所述第二CPU处理器依次与所述控制器和若干喷嘴电连接。

8.如权利要求7所述的水动力智能机器人,其特征在于,所述喷嘴的数量为四个。

9.如权利要求7所述的水动力智能机器人,其特征在于,所述动力控制系统还包括:第二RAM存储器,所述第二RAM存储器和所述第二CPU处理器电连接。

10.一种水动力智能机器人的控制方法,其特征在于,包括:

通过传感器组和卡尔曼滤波算法,确定水动力平台的实际测量角度和实际测量角速度;并根据实际测量角度、预期角度和实际测量角速度,通过双层PID控制算法,确定水动力平台的姿态平衡和运行控制的最终控制量;

根据UWB标签和毫米波雷达,结合巡航轨迹,通过单层PID控制算法,确定水动力平台的预期角度;

根据最终控制量,控制高压水泵通过水动力平台上的喷嘴向下喷水。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1