ECE498A Fourth year design project - miscellaneous stuff design of a formation control system for object collision avoidance just pasting some misc algorithms here