FAST corner detection added and segmentation fault solved