Documentation for matlab files, added comments to each file to describe current state of code

Added documentation describing the scripts and functions in the controls/matlab directory. Also added a comment to the top of each matlab file with a general status of the script, such as if the code is working or if it is unfinished.