Managed to get the move_base_inflated action client working, goes to exact position of waypoint though