#65 Removed dead code, updated arrays to Points, finished writing functi...

...ons