Add general rotation to step calculation and criterion.
Add general rotation to step calculation and criterion.

oscarlorentzon/OpenSfM,onecue/OpenSfM,oscarlorentzon/OpenSfM,onecue/OpenSfM,edgarriba/OpenSfM,mapillary/OpenSfM,onecue/OpenSfM,BrookRoberts/OpenSfM,edgarriba/OpenSfM,onecue/OpenSfM,BrookRoberts/OpenSfM,oscarlorentzon/OpenSfM,sunbingfengPI/OpenSFM_Test,BrookRoberts/OpenSfM,edgarriba/OpenSfM,NicWayand/OpenSfM,onecue/OpenSfM,mapillary/OpenSfM,edgarriba/OpenSfM,BrookRoberts/OpenSfM,mapillary/OpenSfM,mapillary/OpenSfM,mapillary/OpenSfM,oscarlorentzon/OpenSfM,sunbingfengPI/OpenSFM_Test,NicWayand/OpenSfM,sunbingfengPI/OpenSFM_Test,BrookRoberts/OpenSfM,NicWayand/OpenSfM,edgarriba/OpenSfM,sunbingfengPI/OpenSFM_Test,oscarlorentzon/OpenSfM,NicWayand/OpenSfM,sunbingfengPI/OpenSFM_Test,NicWayand/OpenSfM