Added formatting to output.
Added message checking, first packet type (SensorML packet) already processed.