corrected position calculation for NxN points

src/image_handler.cpp

@@ -1,4 +1,14 @@
-#include <msckf_vio/image_handler.h>
+#include <iostream>
+#include <algorithm>
+#include <set>
+#include <Eigen/Dense>
+
+#include <sensor_msgs/image_encodings.h>
+#include <random_numbers/random_numbers.h>
+
+#include <msckf_vio/CameraMeasurement.h>
+#include <msckf_vio/TrackingInfo.h>
+#include <msckf_vio/image_processor.h>
 
 namespace msckf_vio {
 namespace image_handler {