Tidied up FeatureTable implementation, should be more robust to erroneous feature points.
Tidied up feature algorithm to deal with RGB data for testing.