← 返回列表

一种基于陀螺仪的智能地锁控制方法

申请号: CN202410122683.1
申请人: 深圳市长戈科技有限公司
更新日期: 2026-03-17

专利详细信息

项目 内容
专利名称 一种基于陀螺仪的智能地锁控制方法
专利类型 发明授权
申请号 CN202410122683.1
申请日 2024/1/30
公告号 CN117647927B
公开日 2024/3/29
IPC主分类号 G05B11/42
权利人 深圳市长戈科技有限公司
发明人 万正伟; 方雪海
地址 广东省深圳市南山区粤海街道铜鼓路大冲城市花园9栋24b

摘要文本

本发明公开了一种基于陀螺仪的智能地锁控制方法,用于地锁控制领域,该方法包括以下步骤:利用陀螺仪监测地锁的倾斜角度,并将角度数据传输至主控芯片;分析地锁状态并判断是否需调整角度;若判断地锁需要角度调节,则结合PID控制算法与卡尔曼滤波器,计算地锁的调整角度和方向;根据计算结果,发送调整指令,调整地锁至预设状态;分析并修复无法达到预设状态的地锁,并整合故障数据;定期对陀螺仪和电机进行能耗评估,同时根据故障数据制定安全监测方案,为管理人员提供可视化展示界面;实施远程操控。本发明结合PID控制和卡尔曼滤波器的方法,提高了控制系统的鲁棒性,增强了在复杂环境下的可靠性。

专利主权项内容

1.一种基于陀螺仪的智能地锁控制方法,其特征在于,该智能地锁控制方法包括以下步骤:S1、利用陀螺仪监测地锁的倾斜角度,并将角度数据传输至主控芯片;S2、主控芯片接收倾斜角度数据,分析地锁状态并判断是否需调整角度;S3、若判断地锁需要进行角度调节,则结合PID控制算法与卡尔曼滤波器,计算地锁的调整角度和方向;S4、根据计算结果,主控芯片向电机发送调整指令,并调整地锁至预设状态;S5、分析并修复无法达到预设状态的地锁,并整合故障数据;S6、定期对陀螺仪和电机进行能耗评估,同时根据故障数据制定安全监测方案,识别未授权干预行为及破坏行为,并为管理人员提供可视化展示界面;S7、通过可视化界面远程监控地锁状态,并实施远程操控;所述主控芯片接收倾斜角度数据,分析地锁状态并判断是否需调整角度包括以下步骤:S21、收集地锁的倾斜角度数据;S22、利用历史的地锁倾斜角度训练决策树模型;S23、根据地锁的设计需求,设置倾斜角度的阈值;S24、当主控芯片接收到新的倾斜角度数据时,使用训练好的决策树模型分析新的倾斜角度数据;S25、根据分析结果,与倾斜角度的阈值比较,并判断地锁是否处于理想状态及是否需要进行角度调整;所述若判断地锁需要进行角度调节,则结合PID控制算法与卡尔曼滤波器,计算地锁的调整角度和方向包括以下步骤:S31、定义PID控制器的参数初始化范围,并使用粒子群优化算法对PID控制器的参数进行优化;S32、使用卡尔曼滤波器处理从陀螺仪传入的倾斜角度数据;S33、根据优化后PID控制器的参数和卡尔曼滤波器处理后的倾斜角度数据计算地锁当前倾斜角度与倾斜角度的阈值之间的误差,并根据误差计算地锁的调整角度和方向;S34、监测地锁调整的角度和方向,若角度和方向不满足倾斜角度的阈值,则运行粒子群优化算法对PID参数进行调整;S35、根据计算得到的调整角度和方向生成控制指令,并将控制指令输出给主控芯片。