using PYDY to calculate dynamics &design LQR controller