I used your code and changed it a little bit to make it work with the screen of my arduino. And it works but not as it's suppossed to I think. If I make a room with 4 sides it only shows 3 and 1 is always the default color. and the walls seem to go infinitely far.

[Mjerten64]