control law and matrix calculation