【运动学】基于matlab GUI平衡车一阶倒立摆仿真【含Matlab源码 1258期】

举报
海神之光 发表于 2022/05/29 03:38:09 2022/05/29
【摘要】 一、获取代码方式 获取代码方式1： 完整代码已上传我的资源：【运动学】基于matlab GUI平衡车一阶倒立摆仿真【含Matlab源码 1258期】 获取代码方式2： 通过订阅紫极神光博客付费专栏，凭...

一、获取代码方式

获取代码方式1：
完整代码已上传我的资源：【运动学】基于matlab GUI平衡车一阶倒立摆仿真【含Matlab源码 1258期】

获取代码方式2：
通过订阅紫极神光博客付费专栏，凭支付凭证，私信博主，可获得此代码。

备注：
订阅紫极神光博客付费专栏，可免费获得1份代码（有效期为订阅日起，三天内有效）；

二、直线型一阶倒立摆模型建立

一级倒立摆系统是一个不稳定的系统，需要对其进行机理建模。 在研究过程中，应忽略空气摩擦、等，而后可将倒立摆系统进行抽象化，认为其由小车和匀质刚性杆两部分组成并对这两部分进行如图所示的受力分析:
在这里插入图片描述
其中为小车的质量和摆杆的质量；b、F 和 x分别为小车的摩擦系数、施加在小车上的作用力和小车的位置[8]；I和 分别为摆杆的惯量和摆杆转动轴心到质心的长度； 和 分别为摆杆与竖直向上方向和竖直向下方向的夹角；N 和P 分别为摆杆作用力的水平与竖直分量。
小车水平方向的合力：
在这里插入图片描述
摆杆水平方向的合力:
在这里插入图片描述
摆杆水平方向运动方程：
在这里插入图片描述
摆杆力矩平衡方程：
在这里插入图片描述
可得到摆杆在竖直方向的运动方程：
在这里插入图片描述
摆杆竖直方向运动方程：
在这里插入图片描述
将作用力 F 用 u代替,同时进行线性化,即得到:
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

三、部分源代码

function varargout = dlb(varargin)   % GUI主程序
gui_Singleton = 1;
gui_State = struct('gui_Name',       mfilename, ...
                   'gui_Singleton',  gui_Singleton, ...
                   'gui_OpeningFcn', @dlb_OpeningFcn, ...
                   'gui_OutputFcn',  @dlb_OutputFcn, ...
                   'gui_LayoutFcn',  [] , ...
                   'gui_Callback',   []);
if nargin & isstr(varargin{1})
    gui_State.gui_Callback = str2func(varargin{1});
end
if nargout
    [varargout{1:nargout}] = gui_mainfcn(gui_State, varargin{:});
else
    gui_mainfcn(gui_State, varargin{:});
end 
%-----------------------打开界面------------------------%
function dlb_OpeningFcn(hObject, eventdata, handles, varargin) 
handles.output = hObject;
guidata(hObject, handles);
global h1 h2 h3;
axes(handles.sys1);
axis equal;
axis([0 5 -20 20 0 20]);
grid on;
view(80,30);
reall=15;
ll=4+reall;
v=[0 0 0;0 5 0;3 5 0;3 0 0;0 0 3;0 5 3;3 5 3;3 0 3];
f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
g_v=[1 2 3;1 3 3;2 3 3;2 2 3;1 2 ll;1 3 ll;2 3 ll;2 2 ll];
g_f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
h1=patch('Faces',f,'Vertices',v,'FaceColor','b');
h2=patch('Faces',g_f,'Vertices',g_v,'FaceColor','r');
hold on;
[ballx,bally,ballz]=sphere(8);
ballo=[1.5 2.5 ll];
h3=surf(ballx*1.1+ballo(1),bally*1.1+ballo(2),ballz*1.1+ballo(3));
colormap(autumn);

axes(handles.sys3);
sys3data=imread('model.jpg');    %打开倒立摆示意图
image(sys3data);
set(gca,'Xtick',[],'Ytick',[],'box','on');

function varargout = dlb_OutputFcn(hObject, eventdata, handles)   %输出函数
varargout{1} = handles.output;
function normal(hObject, eventdata, handles) %公共调用函数
if ispc
    set(hObject,'BackgroundColor','white');
else
    set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
%----------------------------倒立摆模型参数创建---------------------------%
function mc_CreateFcn(hObject, eventdata, handles)  %M,小车质量
normal(hObject, eventdata, handles);
function mc_Callback(hObject, eventdata, handles)   
function l_CreateFcn(hObject, eventdata, handles)   %L，摆杆长度
normal(hObject, eventdata, handles);
function l_Callback(hObject, eventdata, handles)
function mq_CreateFcn(hObject, eventdata, handles)  %m，摆杆质量
normal(hObject, eventdata, handles);
function mq_Callback(hObject, eventdata, handles)
%-------------------------LQR参数创建-------------------------%
function q1_CreateFcn(hObject, eventdata, handles)  %q1
normal(hObject, eventdata, handles);
function q1_Callback(hObject, eventdata, handles)
function q2_CreateFcn(hObject, eventdata, handles)  %q2
normal(hObject, eventdata, handles);
function q2_Callback(hObject, eventdata, handles)   
function q3_CreateFcn(hObject, eventdata, handles)  %q3
normal(hObject, eventdata, handles);
function q3_Callback(hObject, eventdata, handles)
function q4_CreateFcn(hObject, eventdata, handles)  %q4
normal(hObject, eventdata, handles);
function q4_Callback(hObject, eventdata, handles)
function r_CreateFcn(hObject, eventdata, handles)   %R
normal(hObject, eventdata, handles);
function r_Callback(hObject, eventdata, handles)
%-----------------采用LQR,计算增益K------------------%
function lqrok_Callback(hObject, eventdata, handles) 
global A B C D K;
M_str=get(handles.mc,'string');   
M=str2double(M_str);              %获取小车质量M
m_str=get(handles.mq,'string');    
m=str2double(m_str);              %获取摆杆质量m
L_str=get(handles.l,'string');
L=str2double(L_str);              %获取摆杆长度L
q1_str=get(handles.q1,'string');
q1=str2double(q1_str);
q2_str=get(handles.q2,'string');
q2=str2double(q2_str);
q3_str=get(handles.q3,'string');
q3=str2double(q3_str);
q4_str=get(handles.q4,'string');
q4=str2double(q4_str);
R_str=get(handles.r,'string');
R=str2double(R_str);
Q=[q1,0,0,0;0,q2,0,0;0,0,q3,0;0,0,0,q4];
%Inverted Pendulum Model
g=9.8;
I=1/12*m*L^2;  
l=1/2*L;
t1=m*(M+m)*g*l/[(M+m)*I+M*m*l^2];
t2=-m^2*g*l^2/[(m+M)*I+M*m*l^2];
t3=-m*l/[(M+m)*I+M*m*l^2];
t4=(I+m*l^2)/[(m+M)*I+M*m*l^2];

A=[0,1,0,0;t1,0,0,0;0,0,0,1;t2,0,0,0];
B=[0;t3;0;t4];
C=[0,0,1,0];
D=[0];

[K,sz,ez]=lqr(A,B,Q,R);    %利用LQR方法计算K值
set(handles.k1,'string',K(1));
set(handles.k2,'string',K(2));
set(handles.k3,'string',K(3));
set(handles.k4,'string',K(4));  
%--------------------K的创建-----------------------%
function k1_CreateFcn(hObject, eventdata, handles)  %K1
normal(hObject, eventdata, handles);
function k1_Callback(hObject, eventdata, handles)
function k2_CreateFcn(hObject, eventdata, handles)  %K2
normal(hObject, eventdata, handles);
function k2_Callback(hObject, eventdata, handles)
function k3_CreateFcn(hObject, eventdata, handles)  %K3
normal(hObject, eventdata, handles);
function k3_Callback(hObject, eventdata, handles)
function k4_CreateFcn(hObject, eventdata, handles)  %K4
normal(hObject, eventdata, handles);
function k4_Callback(hObject, eventdata, handles)
%------------------------摆角度和小车位置初始值设定-----------------------%
function in_po_CreateFcn(hObject, eventdata, handles) %小车水平位置创建
normal(hObject, eventdata, handles);
function in_po_Callback(hObject, eventdata, handles)  %小车水平位置回调
Current_Val=str2num(get(hObject,'string'));
set(handles.slider_po,'Value',Current_Val);
function slider_po_CreateFcn(hObject, eventdata, handles) %小车水平拖动条创建
usewhitebg = 1;
if usewhitebg
    set(hObject,'BackgroundColor',[.9 .9 .9]);
else
    set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function slider_po_Callback(hObject, eventdata, handles) %小车水平拖动条回调
global h1 h2 h3;
Value=get(hObject,'Value');
set(handles.in_po,'String',Value);
axes(handles.sys1);
axis equal;
axis([0 5 -20 20 0 20]);
reall=15;
ll=4+reall;
v=[0 0 0;0 5 0;3 5 0;3 0 0;0 0 3;0 5 3;3 5 3;3 0 3];
f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
g_v=[1 2 3;1 3 3;2 3 3;2 2 3;1 2 ll;1 3 ll;2 3 ll;2 2 ll];
g_f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
delete(h1);delete(h2);delete(h3);
i=get(handles.slider_po,'Value')*10;
bbb=[0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;];
v1=v+bbb;
af=get(handles.slider_ag,'Value');
gt1=0.5*cos(-af)-0.5;
gt2=0.5*sin(-af)-0;
gt3=0.5/cos(af)+(ll-0.5*tan(af))*sin(af)-cos(af)+0.5;
gt4=(ll-0.5*tan(af))*cos(af)+sin(af)-ll;
gt5=0.5/cos(af)+(ll-0.5*tan(af))*sin(af)-0.5;
gt6=(ll-0.5*tan(af))*cos(af)-ll;
jiao=[0 -gt1 -gt2;0 gt1 gt2;0 gt1 gt2;0 -gt1 -gt2;0 gt3 gt4;0 gt5 gt6;0 gt5 gt6;0 gt3 gt4];
g_v1=g_v+jiao+bbb;
h1=patch('Faces',f,'Vertices',v1,'FaceColor','b');
h2=patch('Faces',g_f,'Vertices',g_v1,'FaceColor','r');
hold on;
[ballx,bally,ballz]=sphere(8);
ballo=[1.5 2.5 ll];
bally_1=bally*1.1+i+ballo(2)+ll*sin(af);
ballz_1=ballz*1.1+ll*cos(af);
h3=surf(ballx*1.1+ballo(1),bally_1,ballz_1);
colormap(autumn);

function in_ag_CreateFcn(hObject, eventdata, handles) %摆杆角度创建
normal(hObject, eventdata, handles);
function in_ag_Callback(hObject, eventdata, handles)  %摆杆角度回调
Current_Val=str2num(get(hObject,'string'));
set(handles.slider_ag,'Value',Current_Val);
function slider_ag_CreateFcn(hObject, eventdata, handles) %摆杆角度拖动条创建
usewhitebg = 1;
if usewhitebg
    set(hObject,'BackgroundColor',[.9 .9 .9]);
else
    set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function slider_ag_Callback(hObject, eventdata, handles) %摆杆角度拖动条回调
global h1 h2 h3;
Value=get(hObject,'Value');
set(handles.in_ag,'String',Value);
axes(handles.sys1);
axis equal;
axis([0 5 -20 20 0 20]);
v=[0 0 0;0 5 0;3 5 0;3 0 0;0 0 3;0 5 3;3 5 3;3 0 3];
f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
reall=15;
ll=4+reall;
g_v=[1 2 3;1 3 3;2 3 3;2 2 3;1 2 ll;1 3 ll;2 3 ll;2 2 ll];
g_f=[1 2 3 4;2 6 7 3;4 3 7 8;1 5 8 4;1 2 6 5;5 6 7 8];
delete(h1);delete(h2);delete(h3);
i=get(handles.slider_po,'Value')*10;
bbb=[0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;0 i 0;];
v1=v+bbb;
af=get(handles.slider_ag,'Value');
gt1=0.5*cos(-af)-0.5;
gt2=0.5*sin(-af)-0;
gt3=0.5/cos(af)+(ll-0.5*tan(af))*sin(af)-cos(af)+0.5;
gt4=(ll-0.5*tan(af))*cos(af)+sin(af)-ll;
gt5=0.5/cos(af)+(ll-0.5*tan(af))*sin(af)-0.5;
gt6=(ll-0.5*tan(af))*cos(af)-ll;
jiao=[0 -gt1 -gt2;0 gt1 gt2;0 gt1 gt2;0 -gt1 -gt2;0 gt3 gt4;0 gt5 gt6;0 gt5 gt6;0 gt3 gt4];
g_v1=g_v+jiao+bbb;
h1=patch('Faces',f,'Vertices',v1,'FaceColor','b');
h2=patch('Faces',g_f,'Vertices',g_v1,'FaceColor','r');
hold on;

  
 
    
  
  • 1
    • 
  
  • 2
    • 
  
  • 3
    • 
  
  • 4
    • 
  
  • 5
    • 
  
  • 6
    • 
  
  • 7
    • 
  
  • 8
    • 
  
  • 9
    • 
  
  • 10
    • 
  
  • 11
    • 
  
  • 12
    • 
  
  • 13
    • 
  
  • 14
    • 
  
  • 15
    • 
  
  • 16
    • 
  
  • 17
    • 
  
  • 18
    • 
  
  • 19
    • 
  
  • 20
    • 
  
  • 21
    • 
  
  • 22
    • 
  
  • 23
    • 
  
  • 24
    • 
  
  • 25
    • 
  
  • 26
    • 
  
  • 27
    • 
  
  • 28
    • 
  
  • 29
    • 
  
  • 30
    • 
  
  • 31
    • 
  
  • 32
    • 
  
  • 33
    • 
  
  • 34
    • 
  
  • 35
    • 
  
  • 36
    • 
  
  • 37
    • 
  
  • 38
    • 
  
  • 39
    • 
  
  • 40
    • 
  
  • 41
    • 
  
  • 42
    • 
  
  • 43
    • 
  
  • 44
    • 
  
  • 45
    • 
  
  • 46
    • 
  
  • 47
    • 
  
  • 48
    • 
  
  • 49
    • 
  
  • 50
    • 
  
  • 51
    • 
  
  • 52
    • 
  
  • 53
    • 
  
  • 54
    • 
  
  • 55
    • 
  
  • 56
    • 
  
  • 57
    • 
  
  • 58
    • 
  
  • 59
    • 
  
  • 60
    • 
  
  • 61
    • 
  
  • 62
    • 
  
  • 63
    • 
  
  • 64
    • 
  
  • 65
    • 
  
  • 66
    • 
  
  • 67
    • 
  
  • 68
    • 
  
  • 69
    • 
  
  • 70
    • 
  
  • 71
    • 
  
  • 72
    • 
  
  • 73
    • 
  
  • 74
    • 
  
  • 75
    • 
  
  • 76
    • 
  
  • 77
    • 
  
  • 78
    • 
  
  • 79
    • 
  
  • 80
    • 
  
  • 81
    • 
  
  • 82
    • 
  
  • 83
    • 
  
  • 84
    • 
  
  • 85
    • 
  
  • 86
    • 
  
  • 87
    • 
  
  • 88
    • 
  
  • 89
    • 
  
  • 90
    • 
  
  • 91
    • 
  
  • 92
    • 
  
  • 93
    • 
  
  • 94
    • 
  
  • 95
    • 
  
  • 96
    • 
  
  • 97
    • 
  
  • 98
    • 
  
  • 99
    • 
  
  • 100
    • 
  
  • 101
    • 
  
  • 102
    • 
  
  • 103
    • 
  
  • 104
    • 
  
  • 105
    • 
  
  • 106
    • 
  
  • 107
    • 
  
  • 108
    • 
  
  • 109
    • 
  
  • 110
    • 
  
  • 111
    • 
  
  • 112
    • 
  
  • 113
    • 
  
  • 114
    • 
  
  • 115
    • 
  
  • 116
    • 
  
  • 117
    • 
  
  • 118
    • 
  
  • 119
    • 
  
  • 120
    • 
  
  • 121
    • 
  
  • 122
    • 
  
  • 123
    • 
  
  • 124
    • 
  
  • 125
    • 
  
  • 126
    • 
  
  • 127
    • 
  
  • 128
    • 
  
  • 129
    • 
  
  • 130
    • 
  
  • 131
    • 
  
  • 132
    • 
  
  • 133
    • 
  
  • 134
    • 
  
  • 135
    • 
  
  • 136
    • 
  
  • 137
    • 
  
  • 138
    • 
  
  • 139
    • 
  
  • 140
    • 
  
  • 141
    • 
  
  • 142
    • 
  
  • 143
    • 
  
  • 144
    • 
  
  • 145
    • 
  
  • 146
    • 
  
  • 147
    • 
  
  • 148
    • 
  
  • 149
    • 
  
  • 150
    • 
  
  • 151
    • 
  
  • 152
    • 
  
  • 153
    • 
  
  • 154
    • 
  
  • 155
    • 
  
  • 156
    • 
  
  • 157
    • 
  
  • 158
    • 
  
  • 159
    • 
  
  • 160
    • 
  
  • 161
    • 
  
  • 162
    • 
  
  • 163
    • 
  
  • 164
    • 
  
  • 165
    • 
  
  • 166
    • 
  
  • 167
    • 
  
  • 168
    • 
  
  • 169
    • 
  
  • 170
    • 
  
  • 171
    • 
  
  • 172
    • 
  
  • 173
    • 
  
  • 174
    • 
  
  • 175
    • 
  
  • 176
    • 
  
  • 177
    • 
  
  • 178
    • 
  
  • 179
    • 
  
  • 180
    • 
  
  • 181
    • 
  
  • 182
    • 
  
  • 183
    • 
  
  • 184
    • 
  
  • 185
    • 
  
  • 186
    • 
  
  • 187
    • 
  
  • 188
    • 
  
  • 189
    • 
  
  • 190
    • 
  
  • 191
    • 
  
  • 192
    • 
  
  • 193
    • 
  
  • 194
    • 
  
  • 195
    • 
  
  • 196
    • 
  
  • 197
    • 
  
  • 198
    • 
  
  • 199
    • 
  
  • 200
    • 
  
  • 201
    • 
  
  • 202
    • 
  
  • 203
    • 
  
  • 204
    • 
  
  • 205
    • 
  
  • 206
    • 
  
  • 207
    • 
  
  • 208
    • 
  
  • 209
    • 
  
  • 210
    • 
  
  • 211
    • 
  
  • 212
    • 
  
  • 213
    • 
  
  • 214
    • 
  
  • 215
    • 
  
  • 216
    • 
  
  • 217
    • 
  
  • 218
    • 
  
  • 219
    • 
  
  • 220
    • 
  
  • 221
    •

四、运行结果

在这里插入图片描述

五、matlab版本及参考文献

1 matlab版本
2014a

2 参考文献
[1] 门云阁.MATLAB物理计算与可视化[M].清华大学出版社，2013.

文章来源: qq912100926.blog.csdn.net，作者：海神之光，版权归原作者所有，如需转载，请联系作者。

原文链接：qq912100926.blog.csdn.net/article/details/119940350

【版权声明】本文为华为云社区用户转载文章，如果您发现本社区中有涉嫌抄袭的内容，欢迎发送邮件进行举报，并提供相关证据，一经查实，本社区将立刻删除涉嫌侵权内容，举报邮箱： cloudbbs@huaweicloud.com
UI MATLAB
  • 点赞
  • 收藏
  • 关注作者

评论（0）

0/1000
抱歉，系统识别当前为高风险访问，暂不支持该操作

全部回复

上滑加载中

设置昵称

在此一键设置昵称，即可参与社区互动！

*长度不超过10个汉字或20个英文字符，设置后3个月内不可修改。

*长度不超过10个汉字或20个英文字符，设置后3个月内不可修改。

确认 取消

加入云驻计划，成为创作者

  • 华为云周边好礼
  • 免费体验产品
  • 特殊身份标识
  • 线下官方门票
  • 内部专家零距离
  • 与10000+优质创作者共同成长
立即加入