collision detect ogm collision detect sat polygon opencv cirlce obstacle collision detect gjk sat opencv