四轴飞行器1.4 姿态解算和Matlab实时姿态显示

最新推荐文章于 2023-12-21 00:05:31 发布

Claire_ljy

最新推荐文章于 2023-12-21 00:05:31 发布

阅读量1.3k

点赞数 5

文章标签： matlab

原文链接：http://www.cnblogs.com/adfjhg/p/3918316.html

版权

本文介绍了如何使用MPU6050传感器进行姿态解算，并在Matlab中实现串口通信及实时显示姿态数据。作者通过优化串口通信和数据处理，解决了数据速率限制问题，并探讨了CPU使用率、四元素坐标变化、欧拉角的关系以及数据采集线程与处理线程的协调。文章展示了Matlab的串口初始化、数据处理方法，以及利用四元素进行坐标旋转的简化代码。

摘要由CSDN通过智能技术生成

原创文章，欢迎转载，转载请注明出处

MPU6050数据读取出来后，经过一个星期的努力，姿态解算和在matlab上的实时显示姿态终于完成了。

1：完成matlab的串口，并且实时通过波形显示数据

2：添加RTT查看CPU使用率的扩展功能，MPU6050读取数据的优化

3：四元素表示的坐标变化，四元素与欧拉角的关系和Madgwick的IMUupdate算法

4：飞控数据采集线程和数据处理线程的安排，类似于生产者与消费者的关系。

先放个效果视频。。。

如果看不了视频，请打开视屏网址：http://v.youku.com/v_show/id_XNzU3MTk0MTAw.html

1：matlab串口初始化还是比较简单的，网上的资料也很多，这里就直接贴初始化代码了。

 1 % --- Executes on button press in pb_OpenSerialPort.
 2 function pb_OpenSerialPort_Callback(hObject, eventdata, handles)
 3 % hObject    handle to pb_OpenSerialPort (see GCBO)
 4 % eventdata  reserved - to be defined in a future version of MATLAB
 5 % handles    structure with handles and user data (see GUIDATA)
 6 %
 7 global o_SerialPort;
 8 %______________________________________________
 9 %GUI全局变量
10 
11 
12 %---------------------串口初始化-----------------------
13 %%%COM端口初始化
14 int_Index_COM=get(handles.pop_SerialPort,'Value');
15 string_COM=get(handles.pop_SerialPort,'String');
16 string_Select_COM=string_COM{int_Index_COM};
17 o_SerialPort=serial(string_Select_COM);
18 %%%Baud初始化
19 int_Index_Baud=get(handles.pop_BaudRate,'Value');
20 string_Baud=get(handles.pop_BaudRate,'String');
21 string_Select_Baud=string_Baud{int_Index_Baud};
22 double_Baud=str2double(string_Select_Baud);
23 set(o_SerialPort,'BaudRate',double_Baud);
24 %%%设置数据长度
25 int_Index_DataBit=get(handles.pop_DataBit,'Value');