working copy of find corners from lines

src/corner_finder.cpp

@@ -21,7 +21,18 @@ int CornerFinder::findCorners( const Eigen::MatrixXs & _points, std::list<lasers
 
 int CornerFinder::findCorners( const std::list<laserscanutils::LineSegment> & _lines, std::list<laserscanutils::CornerPoint> & _corner_list) const
 {
-    //TODO
+//     //local vars
+//     std::list<laserscanutils::LineSegment>::iterator line_i, line_j; 
+//     
+//     //loop over all lines , ij, and look for vertices greater than some threshold
+//     for (line_i = _lines.begin(); line_i != _lines.end(); line_i++)
+//     {
+//         for (line_j = _lines.begin(); line_j != _lines.end(); line_j++)
+//         {
+//             
+//         }
+//     }
+    
 }
 
 }//namespace