Working on changing algorithm to detect lines from point clouds generated by goodFeaturesToTrack.