Main study areas for robotics research can be given as: mapping, localization, navigation and exploration. Given a robot’s current position, partial map of the environment and a goal position; navigation problem can be defined as optimal path planning and path following. Path planning and path following problem should be handled according to environment being static or dynamic, robot's mobility capabilities, sensors used on the robot and the roughness of the environment. In the study a four wheeled, skid-steering robot with laser range finder and depth sensor is built for Gazebo simulation environment. Also a statically structured labyrinth that consists of 15 degree continuous ramps, 15 degree discontinuous ramps, amorphous holes that robot cannot autonomously escape from if fallen into, walls and discontinuous obstacles that are below the robot laser height. 2D simultaneous localization and mapping, 3D mapping, path planning and path following with respect to the 3D map are implemented on Robot Operating System (ROS). Optimal path planning in rough terrain is accomplished by combining A* heuristic with a function of height difference of the 3D map nodes. Path following is carried out by turning-to and moving-towards actions on each sequential path node pairs. Tests performed on the labyrinth shows that obstacle avoidance, path planning and path following can be carried out successfully with the given implementation.