Control Law Test in Matlab