智能陀螺仪的动量轮转速调节杆平衡性控制系统及方法技术方案

本发明专利技术涉及智能惯性测量单元的动量轮转速调节杆平衡性控制系统，包含惯性测量单元

【技术实现步骤摘要】
智能陀螺仪的动量轮转速调节杆平衡性控制系统及方法


[0001]本专利技术涉及陀螺仪平衡控制
，具体地涉及智能陀螺仪的动量轮转速调节杆平衡性控制系统及方法
。

技术介绍

[0002]杆的平衡性源于一个基本的物理问题，即：杆如何保持平衡
。
平衡需要考虑杆质量
、
形状和支撑力等一系列的物理因素
。
具体来说，一个简单的杆保持平衡的条件就是，其重心位于支持力的正上方，且支撑力的大小等于重力的大小，也就是说，在水平方向上各个方向的力相等，这样杆就保持在一个稳定且平衡的状态
。
[0003]传统的系统利用了一种经典的反馈控制算法，它由比例
(P)、
积分
(I)
和微分
(D)
三个组成部分组成，以下简称
PID
，用于控制系统的稳定性和响应速度
。
杆的
PID
控制可以对杆子的平衡进行快速
、
准确
、
稳定的控制
。
通过实时测量杆子的偏离角度与目标角度的差距
(
误差
)
，根据比例
、
积分
、
微分三个控制器的输出来调整杆子的位置，最终使其保持在垂直状态
。
[0004]具体地，比例控制器会根据实时误差大小，产生一个与误差成比例的控制信号；积分控制器则会累计误差，产生一个随时间累积的控制信号；微分控制器则会根据误差变化率，产生一个随时间变化的控制信号
。
这三个控制器的输出信号经过加权计算后，作为杆子的控制输入量，使得杆子能够快速且稳定地回到垂直状态
。
[0005]例如，当杆子向右侧倾斜时，比例控制器会产生一个向左的控制信号，用于抵消杆子的倾斜角度；积分控制器则会产生一个随时间逐渐增加的控制信号，用于消除杆子的持续误差；微分控制器则会根据杆子倾斜角度的变化率产生一个控制信号，用于更快地调整杆子的位置
。
[0006]而部分传统系统利用了非线性控制，杆的非线性控制是一种针对非线性系统的控制方法，它可以有效地解决杆子平衡控制问题
。
与传统的线性控制方法不同，非线性控制方法不仅考虑系统的局部特性，还要兼顾整个系统的全局动态特性，从而在更广泛的场景下实现杆的平衡控制
。
[0007]针对杆子的非线性控制，首先需要建立杆子的动态模型，并根据模型的特点选择适当的控制策略
。
以双摆杆为例，杆的运动状态可以用两个自由度的角度来描述，因此可以利用状态空间法建立杆子的动态方程
。
根据状态空间模型建立的系统动态方程，可以应用不同的非线性控制算法来实现杆子的平衡控制
。
[0008]一种常见的非线性控制方法是基于反馈线性化技术的控制方法
。
该方法将非线性系统通过反馈线性化技术转化为一个线性系统，然后应用线性控制方法进行设计和优化
。
具体地，可以根据杆子的动态特点，选择适当的反馈线性化函数，如反正切函数
、
双曲正切函数等，将杆子的非线性项进行抵消，使得系统的动态方程近似为一个线性系统，然后应用经典的线性控制方法，在这个线性系统基础上设计控制器
。
[0009]此外，还有一些其他的非线性控制方法，如自适应控制
、
滑模控制
、
神经网络控制
等，这些方法都可以有效地应对杆的非线性特性，实现杆子的快速稳定控制
。
但需要注意的是，非线性控制算法的参数调整和优化比较困难，需要针对具体问题进行深入研究和实验验证
。
[0010]综上所述，本专利技术通过结合传统控制方法和先进的智能算法，提供了一种更高效
、
精确
、
稳定的杆平衡动态控制系统
。
该系统可以广泛应用于工业自动化
、
机器人技术等领域，具有重要的实际应用价值
。
[0011]现有技术的缺陷在于：
[0012]1.
高度模块化，增加了系统的适用性和可用性，避免了一部分损坏就得整体替换导致的资源浪费，且为后续系统的更新迭代留下了接口，可根据使用者的想法进行模块的选用
。
[0013]2.
传统的系统都较为复杂，大部分不具有便携性，本系统小巧
、
轻便
、
实用性强，可做到“即拆即走”，不占用较大的占地面积
。
[0014]3.
传统的平衡性系统所平衡的杆都是固定的，杆的物理参数是不可改变的，本系统可以根据杆的质量
、
大小等更换不同型号的配件，以实现对杆的动态平衡调节
。
[0015]4.
传统平衡性系统的控制方法一般采用经典的
PID
控制方法，这种方法对于复杂
、
非线性系统的动态响应能力有限
。
而本专利中引入了非线性控制方法，可以更好地应对杆子的非线性特性，提高平衡性的控制精度和稳定性
。
[0016]5.
传统系统在面对局部和全局动态特性时，缺乏对不同特性的考虑和适应能力
。
而本系统可以根据杆子的动态特性建立相应的模型，并选择适当的控制方法，从而实现对局部和全局动态特性的优化
。
[0017]6.
传统平衡性调节系统很少采用智能化控制，无法根据环境变化和需求调整自身的控制参数
。
本系统采用了智能算法，可以根据实时的测量数据和环境条件进行自适应调节，提高了控制的灵活性和适应性
。

技术实现思路

[0018]本专利技术针对上述问题，提供智能陀螺仪的动量轮转速调节杆平衡性控制系统及方法，其目的在于通过线性反馈来实时并且智能的处理获取数据，使系统自动对不同环境进行参数调节；降低维修成本，提高系统的可携带性和适用性实现快速配置和灵活性的使用；具备更高的适应性和可靠性，能够在各种复杂环境下正常运行；在不同环境中快速适应并提供稳定的性能；大大减轻的操作负担，并提高系统的性能稳定性和可靠性；使得用户能够轻松上手并且便捷地操作系统
。
[0019]为解决上述问题，本专利技术提供的技术方案为：
[0020]一种智能惯性测量单元的动量轮转速调节杆平衡性控制系统，其特征在于：包含惯性测量单元
、
磁编码器
、
动量轮
、
主控板，其中：
[0021]所述惯性测量单元包含
X
轴
、Y
轴
、Z
轴，用于将自身测得的角度数据传输到所述主控板，并根据预先设定好的条件对3个所述无刷电机进行不同的脉冲脉宽调制分配，实现对所述无刷电机的速度的增加或者抑制作用；
[0022]所述磁编码器用于对本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种智能惯性测量单元的动量轮转速调节杆平衡性控制系统，其特征在于：包含惯性测量单元
、
磁编码器
、
动量轮
、
主控板，其中：所述惯性测量单元包含
X
轴
、Y
轴
、Z
轴，用于将自身测得的角度数据传输到所述主控板，并根据预先设定好的条件对3个所述无刷电机进行不同的脉冲脉宽调制分配，实现对所述无刷电机的速度的增加或者抑制作用；所述磁编码器用于对无刷电机进行计数，将数据传输到所述主控板，以实现对所述无刷电机的速度控制；所述动量轮用于通过自身的质量决定本控制系统所能控制的杆的大小，以及质量的最大值，通过调节转速来实现对杆的动态平衡控制；所述主控板用于实时处理来自所述惯性测量单元和所述磁编码器的数据，进行快速响应，并作出调节
。2.
根据权利要求1所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：所述主控板采用
ESP32
芯片；所述惯性测量单元采用陀螺仪
(1)
；所述磁编码器采用
AS5600
磁编码器
。3.
根据权利要求2所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：所述陀螺仪
(1)
采用
MPU6050
陀螺仪
(1)
；所述动量轮有3个，分别为第一动量轮
(CH1)、
第二动量轮
(CH2)、
第三动量轮
(CH3)
；所述第一动量轮
(CH1)、
所述第二动量轮
(CH2)、
所述第三动量轮
(CH3)
组成的平面
I(2)
与底面
II(3)
平行
。4.
根据权利要求3所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：所述陀螺仪
(1)
的
X
轴与
Y
轴组成的平面
III(4)
与所述底面
II(3)
平行；所述陀螺仪
(1)
的
X
轴
、Y
轴
、Z
轴的交点投影到所述底面
II(3)
上与支点重合；立方体的经过所述支点的边分别与所述底面
II(3)
的夹角为
35.3
°
；所述第一动量轮
(CH1)
的中点
、
所述第二动量轮
(CH2)
的中点
、
所述第三动量轮
(CH3)
的中点投影到所述底面
II(3)
上，并分别与所述支点形成线段，相互之间的夹角都为
120
°
。5.
根据权利要求4所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：所述陀螺仪
(1)
的
Y
轴投影到所述底面
II(3)
上，并经过所述支点；所述第一动量轮
(CH1)
的转动速度方向，与所述第一动量轮
(CH1)
的中点投影到所述底面
II(3)
上并与所述支点组成的线段垂直；所述第二动量轮
(CH2)
的转动速度方向，与所述第二动量轮
(CH2)
的中点投影到所述底面
II(3)
上并与所述支点组成的线段垂直；所述第三动量轮
(CH3)
的转动速度方向，与所述第三动量轮
(CH3)
的中点投影到所述底面
II(3)
上并与所述支点组成的线段垂直
。6.
根据权利要求5所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：立方体的角度按下式表达：
θ
＝
angle
x
‑
angle
e
其中：
θ
为所述立方体的角度；
angle
x
为所述陀螺仪
(1)
沿
X
轴方向测量得到的角度值；
angle
e
为所述动量轮的旋转轴与平衡边在同一平面上测得的角度值；立方体的角速度按下式表达：
θ
'
＝
gyro
x
其中：
θ
'
为所述立方体的角速度；
gyro
x
为通过所述陀螺仪
(1)
沿
X
轴方向得到的角速度
。7.
根据权利要求6所述的智能陀螺仪的动量轮转速调节杆平衡性控制系统，其特征在于：所述动量轮的角速度按下式表达：
w'
＝
motorspeed
x...

【专利技术属性】
技术研发人员：王波云，华方亮，余华清，曾庆栋，李耿，
申请(专利权)人：湖北工程学院，
类型：发明
国别省市：