Major overhaul, everything now in one file, configuration done with ros parameters.
Added launch file.