To Sor — Convert Msor

u1 = -k1 * (y1 - r1)