add and create grid map working, getting neighbors is buggy