An adequate robot modelling for rapid and good 3D collision-free path planning