因為在跑一些實驗~遇到困難

下面是每一個Node都會知道他的位子然後算出自己位在哪一個grid(網格)裡，如grid＜X,Y＞我再把它轉成一個值grid ID

int
GPSRAgent::getMyGrid(double x, double y)
{
int grid_x;
int grid_y;
if (x > maxX || y > maxY) return(-1);

grid_x = (int) x/gridsize_; //x座標除以自己設定的gridsize大小
grid_y = (int) y/gridsize_; //y座標除以自己設定的gridsize大小

return(grid_y*gridX grid_x); //uniqe grid ID

}


問題來了
因為會有很多node ，每個node都會去執行上面那程式，我想知道哪些grid上面是有node的，(grid可能是4X4，16格中有些裡面有node，有些沒有)，然後把這些有用到的gird存起來(不要重複的)

那這些有用grid看成一個點;然後這些點有邊相鄰可以變成矩陣然後去求一條最短的grid path

如:(矩陣)

.... 21 33 12 43 <==gird ID
--------------------------
21| 1 1 1 1
... |
33| 1 1 1 1 <==grid ID有邊相鄰，
... |
12| 1 1 1 1
... |
43| 1 1 1 1

請問高手要如何寫?
grid ID是不是應該是要用global的static去寫~因為會用到的grid會一直變

有高手可以幫我寫個初步的程式嗎??
感激不盡