An algorithm for planning collision-free paths among polyhedral objects