Updated consensus code. Tested and working. Changed neighbor range to reflect new robots in use.