Added some dev and graphics code

- Added dev code to show Field of Views
- Added some graphics functionality to plot pixels and draw the borders
of rectangles.