clear all
clc
% param
m=10;
M=100;
L=1;
g=9.81;
KP = 0
KI = 0
KD = 0
