Planning Plausible Human Motions For Navigation And Collision Avoidance