三角形避障算法，有栅格和连续两种，编组在避障时自动分离，避障后没有障碍物后回复正确状态。