changed code quite a bit. Main now loads in the camera params
and found corner points