Kp = [0.5;0.6;0.65]
J = [0.0322922262119573;0.0322891822494427;0.0323120654875711]
A = [Kp(1)*Kp(1) Kp(1) 1;Kp(2)*Kp(2) Kp(2) 1;Kp(3)*Kp(3) Kp(3) 1]
Ainv = inv(A)
[a] = Ainv*J
Kpmin = -a(2)/(2*a(1))
Jmin = a(1)*Kpmin*Kpmin + a(2)*Kpmin + a(3)