Finished Rewrite of Graph Drawing. Works nicely communicating with Matlab (Remember to make sure the function is on Matlabs Path)