目錄
1.算法描述
2.仿真效果預(yù)覽
3.MATLAB核心程序
4.完整MATLAB
1.算法描述
? ? ? 一個(gè)可以活動(dòng)的小車上立著一根不穩(wěn)定隨時(shí)會(huì)倒下的桿。小車的輪子由電機(jī)控制，可以控制小車電機(jī)的轉(zhuǎn)動(dòng)力矩M。同時(shí)，也可以獲取小車輪子轉(zhuǎn)動(dòng)的圈數(shù)N（可以精確到小數(shù)）和桿相對(duì)于垂直位置的傾角α.
? ? ? 不考慮車輪打滑, 小車所受力大小等于電機(jī)力矩乘車輪半徑, 小車位置可以從轉(zhuǎn)動(dòng)圈數(shù)計(jì)算出, 小車可簡(jiǎn)化為最經(jīng)典的一階倒立擺:
?
?對(duì)小車水平方向:
Mx¨+bx˙+N=F
對(duì)擺水平方向:
N=md2dt(x+lsin?θ)
即:
N=mx¨+mlθ¨cos?θ¨?mlθ˙2sin?θ
對(duì)擺垂直方向:
P=mg+md2dt(lcos?θ)
即:
P=mg?mlθ¨sin?θ¨?mlθ˙2cos?θ
關(guān)節(jié)力矩:
?Plsin?θ?Nlcos?θ=Iθ¨
令 ?=π+θ
在工作點(diǎn) θ≈0 進(jìn)行線性化: sin?θ=0,cos?θ=1,θ˙2=0 經(jīng)過一頓操作化簡(jiǎn)之后能得到:
(I+ml2)?¨?mgl?=mlx¨ (M+m)x¨+bx˙?ml?¨=F=u
2.仿真效果預(yù)覽
matlab2022a仿真如下：
文章來源：http://www.zghlxwxcb.cn/news/detail-478406.html
3.MATLAB核心程序
function varargout = pendulum(varargin)
% PENDULUM M-file for pendulum.fig
% PENDULUM, by itself, creates a new PENDULUM or raises the existing
% singleton*.
%
% H = PENDULUM returns the handle to a new PENDULUM or the handle to
% the existing singleton*.
%
% PENDULUM('CALLBACK',hObject,eventData,handles,...) calls the local
% function named CALLBACK in PENDULUM.M with the given input arguments.
%
% PENDULUM('Property','Value',...) creates a new PENDULUM or raises the
% existing singleton*. Starting from the left, property value pairs are
% applied to the GUI before pendulum_OpeningFunction gets called. An
% unrecognized property name or invalid value makes property application
% stop. All inputs are passed to pendulum_OpeningFcn via varargin.
%
% *See GUI Options on GUIDE's Tools menu. Choose "GUI allows only one
% instance to run (singleton)".
%
% See also: GUIDE, GUIDATA, GUIHANDLES
% Copyright 2002-2003 The MathWorks, Inc.
% Edit the above text to modify the response to help pendulum
% Last Modified by SHE on 15-Dec-2008 22:08:58
% Begin initialization code - DO NOT EDIT
gui_Singleton = 1;
gui_State = struct('gui_Name', mfilename, ...
'gui_Singleton', gui_Singleton, ...
'gui_OpeningFcn', @pendulum_OpeningFcn, ...
'gui_OutputFcn', @pendulum_OutputFcn, ...
'gui_LayoutFcn', [] , ...
'gui_Callback', []);
if nargin && ischar(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
% End initialization code - DO NOT EDIT
% --- Executes just before pendulum is made visible.
function pendulum_OpeningFcn(hObject, eventdata, handles, varargin)
% This function has no output args, see OutputFcn.
% hObject handle to figure
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% varargin command line arguments to pendulum (see VARARGIN)
% Choose default command line output for pendulum
handles.output = hObject;
% Update handles structure
guidata(hObject, handles);
% UIWAIT makes pendulum wait for user response (see UIRESUME)
% uiwait(handles.figure1);
% --- Outputs from this function are returned to the command line.
function varargout = pendulum_OutputFcn(hObject, eventdata, handles)
% varargout cell array for returning output args (see VARARGOUT);
% hObject handle to figure
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Get default command line output from handles structure
varargout{1} = handles.output;
function edit1_Callback(hObject, eventdata, handles)
% hObject handle to edit1 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: get(hObject,'String') returns contents of edit1 as text
% str2double(get(hObject,'String')) returns contents of edit1 as a double
%以字符串的形式來存儲(chǔ)數(shù)據(jù)文本框1的內(nèi)容。如果字符串不是數(shù)字，則現(xiàn)實(shí)空白內(nèi)容
input =str2double(get(hObject,'String'));
%檢查輸入是否為空. 如果為空,則默認(rèn)顯示為0
if (isempty(input))
set(hObject,'String','0')
end
guidata(hObject, handles);
% --- Executes during object creation, after setting all properties.
function edit1_CreateFcn(hObject, eventdata, handles)
% hObject handle to edit1 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: edit controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function edit2_Callback(hObject, eventdata, handles)
% hObject handle to edit2 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: get(hObject,'String') returns contents of edit2 as text
% str2double(get(hObject,'String')) returns contents of edit2 as a double
%以字符串的形式來存儲(chǔ)數(shù)據(jù)文本框2的內(nèi)容。如果字符串不是數(shù)字，則現(xiàn)實(shí)空白內(nèi)容
input =str2double(get(hObject,'String'));
%檢查輸入是否為空. 如果為空,則默認(rèn)顯示為0
if (isempty(input))
set(hObject,'String','0')
end
guidata(hObject, handles);
% --- Executes during object creation, after setting all properties.
function edit2_CreateFcn(hObject, eventdata, handles)
% hObject handle to edit2 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: edit controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function edit3_Callback(hObject, eventdata, handles)
% hObject handle to edit3 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: get(hObject,'String') returns contents of edit3 as text
% str2double(get(hObject,'String')) returns contents of edit3 as a double
%以字符串的形式來存儲(chǔ)數(shù)據(jù)文本框3的內(nèi)容。如果字符串不是數(shù)字，則現(xiàn)實(shí)空白內(nèi)容
input =str2double(get(hObject,'String'));
%檢查輸入是否為空. 如果為空,則默認(rèn)顯示為0
if (isempty(input))
set(hObject,'String','0')
end
guidata(hObject, handles);
% --- Executes during object creation, after setting all properties.
function edit3_CreateFcn(hObject, eventdata, handles)
% hObject handle to edit3 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: edit controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function edit4_Callback(hObject, eventdata, handles)
% hObject handle to edit4 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: get(hObject,'String') returns contents of edit4 as text
% str2double(get(hObject,'String')) returns contents of edit4 as a double
%以字符串的形式來存儲(chǔ)數(shù)據(jù)文本框4的內(nèi)容。如果字符串不是數(shù)字，則現(xiàn)實(shí)空白內(nèi)容
input =str2double(get(hObject,'String'));
%檢查輸入是否為空. 如果為空,則默認(rèn)顯示為0
if (isempty(input))
set(hObject,'String','0')
end
guidata(hObject, handles);
% --- Executes during object creation, after setting all properties.
function edit4_CreateFcn(hObject, eventdata, handles)
% hObject handle to edit4 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: edit controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
function edit5_Callback(hObject, eventdata, handles)
% hObject handle to edit5 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: get(hObject,'String') returns contents of edit5 as text
% str2double(get(hObject,'String')) returns contents of edit5 as a double
%以字符串的形式來存儲(chǔ)數(shù)據(jù)文本框5的內(nèi)容。如果字符串不是數(shù)字，則現(xiàn)實(shí)空白內(nèi)容
input =str2double(get(hObject,'String'));
%檢查輸入是否為空. 如果為空,則默認(rèn)顯示為0
if (isempty(input))
set(hObject,'String','0')
end
guidata(hObject, handles);
% --- Executes during object creation, after setting all properties.
function edit5_CreateFcn(hObject, eventdata, handles)
% hObject handle to edit5 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: edit controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
% --- Executes on selection change in popupmenu1.
function popupmenu1_Callback(hObject, eventdata, handles)
% hObject handle to popupmenu1 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
% Hints: contents = get(hObject,'String') returns popupmenu1 contents as cell array
% contents{get(hObject,'Value')} returns selected item from popupmenu1
popup_sel_index = get(handles.popupmenu1, 'Value');
popup_sel_index = get(handles.popupmenu1, 'Value');
switch popup_sel_index
case 1
set(handles.text10 ,'String','期望極點(diǎn)');
set(handles.text11 ,'String',' -10 -10');
set(handles.text12 ,'String','-2+2*sqrt(3)*i -2-2*sqrt(3)*i');
case 2
set(handles.text10 ,'String','加權(quán)矩陣');
set(handles.text11 ,'String','Q=[1 0 0 0; 0 0 0 0; 0 0 1 0;0 0 0 0];');
set(handles.text12 ,'String',' R=1');
case 3
set(handles.text10 ,'String','參考輸入');
set(handles.text11 ,'String',' y_r=0.2*U(t)');
set(handles.text12 ,'String',' ');
case 4
set(handles.text10 ,'String','PID');
set(handles.text11 ,'String',' P=5，I=0.001，D=1');
set(handles.text12 ,'String',' ');
end
% --- Executes during object creation, after setting all properties.
function popupmenu1_CreateFcn(hObject, eventdata, handles)
% hObject handle to popupmenu1 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles empty - handles not created until after all CreateFcns called
% Hint: popupmenu controls usually have a white background on Windows.
% See ISPC and COMPUTER.
if ispc
set(hObject,'BackgroundColor','white');
else
set(hObject,'BackgroundColor',get(0,'defaultUicontrolBackgroundColor'));
end
% --- Executes on button press in pushbutton1.
function pushbutton1_Callback(hObject, eventdata, handles)
% hObject handle to pushbutton1 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
warning off
M = str2double(get(handles.edit1, 'String'));%小車質(zhì)量
m = str2double(get(handles.edit2, 'String'));%擺桿質(zhì)量
b = str2double(get(handles.edit3, 'String'));%小車阻尼
I = str2double(get(handles.edit4, 'String'));%擺桿轉(zhuǎn)動(dòng)慣量
l = str2double(get(handles.edit5, 'String'));%擺桿長(zhǎng)度
g=9.8; %重力加速度
%%%%%%%%%%%%%%%%%%%%%%%%計(jì)算系統(tǒng)狀態(tài)矩陣%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
A=[ 0 1 0 0;...
(M+m)*m*g*l/((M+m)*I+M*m*l^2) 0 0 m*l*b/((M+m)*I+M*m*l^2);...
0 0 0 1;...
-m^2*l^2*g/((M+m)*I+M*m*l^2) 0 0 -(I+m*l^2)*b/((M+m)*I+M*m*l^2)];
B=[0;-m*l/(((M+m)*I+M*m*l^2));0;(I+m*l^2)/((M+m)*I+M*m*l^2)];
C=[0 0 1 0;1 0 0 0];
D=zeros(2,1);
E=zeros(4,1);
%%%%%%%%%%%%%%%%%%%%將狀態(tài)矩陣轉(zhuǎn)存到狀態(tài)空間%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
assignin('base','A',A);
assignin('base','B',B);
assignin('base','C',C);
assignin('base','D',D);
assignin('base','E',E);
%%%%%%%%%%%%%%%%%%%%%%選擇倒立擺的控制方式%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
popup_sel_index = get(handles.popupmenu1, 'Value');
switch popup_sel_index
case 1 %%極點(diǎn)配置法
Qc=ctrb(A,B);
EA=[-10 0 0 0;...
0 -10 0 0;...
0 0 -2-2*sqrt(3)*i 0;...
0 0 0 -2+2*sqrt(3)*i];
PP=polyvalm(poly(EA),A);
Ks=[0 0 0 1]*inv(Qc)*PP; %%計(jì)算反饋矩陣
[t,x,y]=sim('jwgcqp.mdl'); %%調(diào)用降維觀測(cè)器的simulink模塊
axes(handles.axes1);
plot(t,y(:,1));
axes(handles.axes2);
plot(t,y(:,3));
axes(handles.axes3)
plot([-0.02;0.02],[-0.8;-0.8],'color','k','linestyle','-','linewidth',2);
axis([-0.02 0.02 -1.2 1.2]);
car1=line([-0.004;0.004],[-0.5;-0.5],'color','k','linestyle','-','erasemode','xor','linewidth',25);
car21=line(-0.004,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
car22=line( 0.004,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
pendulum1=line([0;0],[-0.3;0.6],'color','r','linestyle','-','erasemode','xor','linewidth',10);
pendulum2=line(0,-0.27,'color','g','linestyle','-','erasemode','xor','markersize',30);
for s=1:length(t)
set(car21,'xdata',-0.004+y(s,3),'ydata',-0.72);
set(car22,'xdata', 0.004+y(s,3),'ydata',-0.72);
set(car1,'xdata',[-0.004+y(s,3);0.004+y(s,3)],'ydata',[-0.5;-0.5]);
set(pendulum2,'xdata',y(s,3),'ydata',-0.27);
set(pendulum1,'xdata',[y(s,3);sin(y(s,1))+y(s,3)],'ydata',[-0.3;-0.3+cos(y(s,1))]);
drawnow;
end
case 2 %%LQR最優(yōu)控制器
QQ=diag([1,0,1,0]);
RR=1;
Ks=lqr(A,B,QQ,RR); %%計(jì)算反饋矩陣
[t,x,y]=sim('jwgcql.mdl'); %%調(diào)用降維觀測(cè)器的simulink模塊
% figure(2)
% subplot(4,2,1)
% plot(t,y(:,1))
% title('系統(tǒng)狀態(tài)變化')
% subplot(4,2,2)
% plot(t,y(:,5))
% title('降維觀測(cè)器結(jié)果')
% subplot(4,2,3)
% plot(t,y(:,2))
% subplot(4,2,4)
% plot(t,y(:,6))
% subplot(4,2,5)
% plot(t,y(:,3))
% subplot(4,2,6)
% plot(t,y(:,7))
% subplot(4,2,7)
% plot(t,y(:,4))
% subplot(4,2,8)
% plot(t,y(:,8))
axes(handles.axes1);
plot(t,y(:,1));
axes(handles.axes2);
plot(t,y(:,3));
axes(handles.axes3);
plot([-0.3;0.3],[-0.8;-0.8],'color','k','linestyle','-','linewidth',2);
axis([-0.3 0.3 -1.2 1.2]);
car1=line([-0.06;0.06],[-0.5;-0.5],'color','k','linestyle','-','erasemode','xor','linewidth',25);
car21=line(-0.06,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
car22=line( 0.06,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
pendulum1=line([0;0],[-0.3;0.6],'color','r','linestyle','-','erasemode','xor','linewidth',10);
pendulum2=line(0,-0.27,'color','g','linestyle','-','erasemode','xor','markersize',30);
for s=1:length(t)
set(car21,'xdata',-0.06+y(s,3),'ydata',-0.72);
set(car22,'xdata', 0.06+y(s,3),'ydata',-0.72);
set(car1,'xdata',[-0.06+y(s,3);0.06+y(s,3)],'ydata',[-0.5;-0.5]);
set(pendulum2,'xdata',y(s,3),'ydata',-0.27);
set(pendulum1,'xdata',[y(s,3);sin(y(s,1))+y(s,3)],'ydata',[-0.3;-0.3+cos(y(s,1))]);
drawnow;
end
case 3
% A=[ 0 1 0 0;...
% (M+m)*m*g*l/((M+m)*I+M*m*l^2) 0 0 m*l*b/((M+m)*I+M*m*l^2);...
% 0 0 0 1;...
% -m^2*l^2*g/((M+m)*I+M*m*l^2) 0 0 -(I+m*l^2)*b/((M+m)*I+M*m*l^2)];
% B=[0;-m*l/(((M+m)*I+M*m*l^2));0;(I+m*l^2)/((M+m)*I+M*m*l^2)];
% C=[0 0 1 0;1 0 0 0];
% p=[-10,-7,-1.901,-1.9];
% Kysw=place(A,B,p);
[x,y]=sim('pedulumpid.mdl');
axes(handles.axes1);
plot(t,y(:,1));
axes(handles.axes2);
plot(t,y(:,3));
axes(handles.axes3);
plot([-0.3;0.3],[-0.8;-0.8],'color','k','linestyle','-','linewidth',2);
axis([-0.3 0.3 -1.2 1.2]);
car1=line([-0.06;0.06],[-0.5;-0.5],'color','k','linestyle','-','erasemode','xor','linewidth',25);
car21=line(-0.06,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
car22=line( 0.06,-0.72,'color','k','linestyle','-','erasemode','xor','markersize',40);
pendulum1=line([0;0],[-0.3;0.6],'color','r','linestyle','-','erasemode','xor','linewidth',10);
pendulum2=line(0,-0.27,'color','g','linestyle','-','erasemode','xor','markersize',30);
for s=1:length(t)
set(car21,'xdata',-0.06+y(s,3),'ydata',-0.72);
set(car22,'xdata', 0.06+y(s,3),'ydata',-0.72);
set(car1,'xdata',[-0.06+y(s,3);0.06+y(s,3)],'ydata',[-0.5;-0.5]);
set(pendulum2,'xdata',y(s,3),'ydata',-0.27);
set(pendulum1,'xdata',[y(s,3);sin(y(s,1))+y(s,3)],'ydata',[-0.3;-0.3+cos(y(s,1))]);
drawnow;
end
end
% --- Executes on button press in pushbutton4.
function pushbutton4_Callback(hObject, eventdata, handles)
% hObject handle to pushbutton4 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
pause;
% --- Executes on button press in pushbutton5.
function pushbutton5_Callback(hObject, eventdata, handles)
% hObject handle to pushbutton5 (see GCBO)
% eventdata reserved - to be defined in a future version of MATLAB
% handles structure with handles and user data (see GUIDATA)
close(gcbf);
clc,clear,close all
A874.完整MATLAB
V文章來源地址http://www.zghlxwxcb.cn/news/detail-478406.html
到了這里，關(guān)于基于MATLAB的一級(jí)倒立擺控制仿真,帶GUI界面操作顯示倒立擺動(dòng)畫，控制器控制輸出的文章就介紹完了。如果您還想了解更多內(nèi)容，請(qǐng)?jiān)谟疑辖撬阉鱐OY模板網(wǎng)以前的文章或繼續(xù)瀏覽下面的相關(guān)文章，希望大家以后多多支持TOY模板網(wǎng)！
