Add matplotlib, plotting of points
Add documentation, debug statements