Susans c4 algorithm