Colony

#include "localization.h"

void addSensor (int maxBom, int self, int other, int NUM_BOTS)

{

    //make sure you don't add to the diagonal

    if(self == other) {

      //lcd_putchar('w');

      return;

    }

    if(self >= NUM_BOTS || other >= NUM_BOTS)

    {

      // lcd_putchar('y');

      return;

    }

    //lcd_putchar('a');

    //lcd_putchar(self+48);

    //lcd_putchar(':');

    //lcd_putchar(other+48);

    //lcd_putchar('.');

    //add this robot to your own row's sensor numbers

    //row = your index

    //column = robotNum (input)

    sensors[self][other] = maxBom;

}

unsigned char getSelfSensor (unsigned char self, unsigned char other, int NUM_BOTS)

{

    if(other < NUM_BOTS){

        return sensors[self][other];

    }

    else {

        return 9;

    }

}

/*

void printSensorsMatrix (void)

{

    //print table

    int y = 1;

    lcd_gotoxy(0, y);

    int i, j;

    for(i = 0; i < NUM_BOTS; i++) {

        for(j = 0; j < NUM_BOTS; j++) {

            lcd_putchar( getSelfSensor(i, j, NUM_BOTS) + 48);

            lcd_putchar(' ');

        }

        y++;

        lcd_gotoxy(0, y);

    }

    delay_ms(1000);

}

*/

/*

SensorRow getSelfSensorRow (int self)

{

    SensorRow sr;

    int i;

    sr.len = NUM_BOTS;

    for(i = 0; i < NUM_BOTS; i++) {

        sr.row[i] = sensors[

}

*/