void readEEPROM() { if (serialPort1.BytesToRead < 256) { return; } StreamWriter CSV = new StreamWriter("EEPROM_DATA.CSV", true); byte[] newBytes = new byte[256]; serialPort1.Read(newBytes, 0, 256); string Str = BitConverter.ToString(newBytes, 0, 256); richTextBox1.Invoke(new MethodInvoker(delegate() { richTextBox1.AppendText(Str + Environment.NewLine + Environment.NewLine); })); TelemetryPacket packet = new TelemetryPacket(); for (int i = 0; i <= 12; i++) { if (newBytes[21 * i] == 0x03 && newBytes[21 * i + 1] == 0xE9) { packet.team_id = 1001; packet.time = ((int)newBytes[21 * i + 2] << 8) + (int)newBytes[21 * i + 3]; packet.altitude = unchecked ((short)(((ushort)newBytes[21 * i + 4] << 8) + newBytes[21 * i + 5])); packet.outside_temp = (((int)newBytes[21 * i + 6] << 8) + (int)newBytes[21 * i + 7]) / 10; packet.inside_temp = (((int)newBytes[21 * i + 8] << 8) + (int)newBytes[21 * i + 9]) / 10; packet.voltage = unchecked ((ushort)(((ushort)newBytes[21 * i + 10] << 8) + newBytes[21 * i + 11])); packet.voltage = unchecked ((float)(((packet.voltage) / 65535) * (maxVoltage * voltageScale))); packet.state = packet.stateName((int)newBytes[21 * i + 12]); packet.x_accel = unchecked ((short)(((ushort)newBytes[21 * i + 13] << 8) + newBytes[21 * i + 14])); packet.x_accel = unchecked ((float)(packet.x_accel / 16384)); packet.y_accel = unchecked ((short)(((ushort)newBytes[21 * i + 15] << 8) + newBytes[21 * i + 16])); packet.y_accel = unchecked ((float)(packet.y_accel / 16384)); packet.z_accel = unchecked ((short)(((ushort)newBytes[21 * i + 17] << 8) + newBytes[21 * i + 18])); packet.z_accel = unchecked ((float)(packet.z_accel / 16384)); packet.count = ((int)newBytes[21 * i + 19] << 8) + (int)newBytes[21 * i + 20]; string[] packetStr = HandleData.packetToString(packet); string row = String.Format("{0, 8}, {1, 8}, {2, 8}, {3, 14}, {4, 14}, {5, 8}, {6, 6}, {7, 6}, {8, 6}, {9, 6}, {10, 6}", packetStr[0], packetStr[1], packetStr[2], packetStr[3], packetStr[4], packetStr[5], packetStr[6], packetStr[7], packetStr[8], packetStr[9], packetStr[10]); CSV.WriteLine(row); } } CSV.Close(); //MessageBox.Show("Done"); }
void parsePacket(ref TelemetryPacket packet, byte[] fullData) { packet.team_id = ((int)fullData[15] << 8) + (int)fullData[16]; packet.time = ((int)fullData[17] << 8) + (int)fullData[18]; packet.altitude = unchecked ((short)(((ushort)fullData[19] << 8) + fullData[20])); packet.outside_temp = (((int)fullData[21] << 8) + (int)fullData[22]) / 10; packet.inside_temp = (((int)fullData[23] << 8) + (int)fullData[24]) / 10; packet.voltage = unchecked ((ushort)(((ushort)fullData[25] << 8) + fullData[26])); packet.voltage = unchecked ((float)(((packet.voltage) / 65536) * (maxVoltage * voltageScale))); packet.state = packet.stateName((int)fullData[27]); packet.x_accel = unchecked ((short)(((ushort)fullData[28] << 8) + fullData[29])); packet.x_accel = unchecked ((float)(packet.x_accel / 16384)); packet.y_accel = unchecked ((short)(((ushort)fullData[30] << 8) + fullData[31])); packet.y_accel = unchecked ((float)(packet.y_accel / 16384)); packet.z_accel = unchecked ((short)(((ushort)fullData[32] << 8) + fullData[33])); packet.z_accel = unchecked ((float)(packet.z_accel / 16384)); packet.count = ((int)fullData[34] << 8) + (int)fullData[35]; }