Add Zhanhy step setector algorithm