Matlab codes : Dynamic_Walking