Susans algorithm from c4
Merge pull request #7 from smschwarz/master

Susans c4 algorithm