add new avoid algorithm VFH*