Basic PRM algorithm