Add enhance 2 algorithm which swap sensors