Made the code terrible to read

1. Well actually so as to remove the functions themselves.
2. MATLAB is so not for procedural programming.
3. Vectors, vector & more vectors.