Work for demo and other small things

-Added display of corners
-Added a default return
-Changed two things to stack memory rather than heap
-Reallocation of imagePoints