Added skeleton mapper node
Now creating map matrix
Can now set points in map
Now rendering map to rviz. Some camera centering problems and rviz goes down to 2 fps for big grids :(
Fixed so plane is in origo now (Misunderstood gridcells message
Rendered map now looks damn awesome
Can now send robot position messages to mapper in order to move around the robot in the map. Now map also puts the robot in the origo of the map
Changed place of dummy data