added simulink control code and sample model