Zaslat SMS: CORAL: Fast, parallel multi model fitting with applications to mapping, perception and scene reconstruction and understanding