Design of Connectivity Preserving Flocking Using Control Lyapunov Function

Algorithm 1

Main algorithm.

initialization all variables and constants

while    do

  capture position ;

  for   to   do

    compute , ;

    if    then

      build ;

      compute ;

    end

  end

  compute , , ;

  compute

  update ;

  update ;

end