u = pid.pi(x_cur[0])