Added DataPort as reference to Serial for arduino micro compatability
Fixed main routine
Some fixes, also changed packet format to all floats