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