Implemented FAST corner detector