Added simulink and matlab files, work in progress