public void OnBroadcast(object sender, MesgBroadcastEventArgs e) { float[] calibratedXYZ; int count; List <Mesg> mesgs = e.mesgs; int[] rawXYZ = new int[NUM_AXIS]; foreach (Mesg mesg in mesgs) { switch (mesg.Num) { case MesgNum.AccelerometerData: if (haveAccelCal) { AccelerometerDataMesg accelData = new AccelerometerDataMesg(mesg); count = accelData.GetNumAccelX(); for (int i = 0; i < count; i++) { //Extract the uncalibrated accel data from incoming message rawXYZ[X_AXIS_OFFSET] = Convert.ToInt32(accelData.GetAccelX(i)); rawXYZ[Y_AXIS_OFFSET] = Convert.ToInt32(accelData.GetAccelY(i)); rawXYZ[Z_AXIS_OFFSET] = Convert.ToInt32(accelData.GetAccelZ(i)); // Apply calibration to the values calibratedXYZ = AdjustSensorData(rawXYZ, accelCalParams); // Update the message ProcessCalibrationFactor(mesg, accelDataFieldNameXYZ, calibratedXYZ, accelDataFieldNum); } } break; case MesgNum.GyroscopeData: if (haveGyroCal) { GyroscopeDataMesg gyroData = new GyroscopeDataMesg(mesg); count = gyroData.GetNumGyroX(); for (int i = 0; i < count; i++) { //Extract the uncalibrated gyro data from incoming message rawXYZ[X_AXIS_OFFSET] = Convert.ToInt32(gyroData.GetGyroX(i)); rawXYZ[Y_AXIS_OFFSET] = Convert.ToInt32(gyroData.GetGyroY(i)); rawXYZ[Z_AXIS_OFFSET] = Convert.ToInt32(gyroData.GetGyroZ(i)); // Apply calibration to the values calibratedXYZ = AdjustSensorData(rawXYZ, gyroCalParams); // Update the message ProcessCalibrationFactor(mesg, gyroDataFieldNameXYZ, calibratedXYZ, gyroDataFieldNum); } } break; case MesgNum.MagnetometerData: if (haveMagCal) { MagnetometerDataMesg magData = new MagnetometerDataMesg(mesg); count = magData.GetNumMagX(); for (int i = 0; i < count; i++) { //Extract the uncalibrated mag data from incoming message rawXYZ[X_AXIS_OFFSET] = Convert.ToInt32(magData.GetMagX(i)); rawXYZ[Y_AXIS_OFFSET] = Convert.ToInt32(magData.GetMagY(i)); rawXYZ[Z_AXIS_OFFSET] = Convert.ToInt32(magData.GetMagZ(i)); // Apply calibration to the values calibratedXYZ = AdjustSensorData(rawXYZ, magCalParams); // Update the message ProcessCalibrationFactor(mesg, magDataFieldNameXYZ, calibratedXYZ, magDataFieldNum); } } break; default: break; } // switch } // foreach }
public void OnBroadcast(object sender, MesgBroadcastEventArgs e) { List <Mesg> mesgs = e.mesgs; if (isActivityFile && (hr_start_index != HrToRecordMesgBroadcastPlugin.INVALID_INDEX)) { float? hr_anchor_event_timestamp = 0.0f; DateTime hr_anchor_timestamp = new DateTime(0); bool hr_anchor_set = false; byte? last_valid_hr = 0; DateTime last_valid_hr_time = new DateTime(0); for (int mesgCounter = 0; mesgCounter < mesgs.Count; mesgCounter++) { Mesg mesg = mesgs[mesgCounter]; if (mesg.Num == MesgNum.Record) { long hrSum = 0; long hrSumCount = 0; // Cast message to record message RecordMesg recordMesg = new RecordMesg(mesg); // Obtain the time for which the record message is valid DateTime record_range_end_time = new DateTime(recordMesg.GetTimestamp()); // Need to determine timestamp range which applies to this record bool findingInRangeHrMesgs = true; // Start searching HR mesgs where we left off int hr_mesg_counter = hr_start_index; int hr_sub_mesg_counter = hr_start_sub_index; while (findingInRangeHrMesgs && (hr_mesg_counter < mesgs.Count)) { // Skip over any non HR messages if (mesgs[hr_mesg_counter].Num == MesgNum.Hr) { HrMesg hrMesg = new HrMesg(mesgs[hr_mesg_counter]); // Update HR timestamp anchor, if present if (hrMesg.GetTimestamp() != null && hrMesg.GetTimestamp().GetTimeStamp() != 0) { hr_anchor_timestamp = new DateTime(hrMesg.GetTimestamp()); hr_anchor_set = true; if (hrMesg.GetFractionalTimestamp() != null) { hr_anchor_timestamp.Add((double)hrMesg.GetFractionalTimestamp()); } if (hrMesg.GetNumEventTimestamp() == 1) { hr_anchor_event_timestamp = hrMesg.GetEventTimestamp(0); } else { throw new FitException("FIT HrToRecordMesgBroadcastPlugin Error: Anchor HR mesg must have 1 event_timestamp"); } } if (hr_anchor_set == false) { // We cannot process any HR messages if we have not received a timestamp anchor throw new FitException("FIT HrToRecordMesgBroadcastPlugin Error: No anchor timestamp received in a HR mesg before diff HR mesgs"); } else if (hrMesg.GetNumEventTimestamp() != hrMesg.GetNumFilteredBpm()) { throw new FitException("FIT HrToRecordMesgBroadcastPlugin Error: HR mesg with mismatching event timestamp and filtered bpm"); } for (int j = hr_sub_mesg_counter; j < hrMesg.GetNumEventTimestamp(); j++) { // Build up timestamp for each message using the anchor and event_timestamp DateTime hrMesgTime = new DateTime(hr_anchor_timestamp); float? event_timestamp = hrMesg.GetEventTimestamp(j); // Deal with roll over case if (event_timestamp < hr_anchor_event_timestamp) { if ((hr_anchor_event_timestamp - event_timestamp) > (1 << 21)) { event_timestamp += (1 << 22); } else { throw new FitException("FIT HrToRecordMesgBroadcastPlugin Error: Anchor event_timestamp is greater than subsequent event_timestamp. This does not allow for correct delta calculation."); } } hrMesgTime.Add((double)(event_timestamp - hr_anchor_event_timestamp)); // Check if hrMesgTime is gt record start time // and if hrMesgTime is lte to record end time if ((hrMesgTime.CompareTo(record_range_start_time) > 0) && (hrMesgTime.CompareTo(record_range_end_time) <= 0)) { hrSum += (long)hrMesg.GetFilteredBpm(j); hrSumCount++; last_valid_hr_time = new DateTime(hrMesgTime); } // check if hrMesgTime exceeds the record time else if (hrMesgTime.CompareTo(record_range_end_time) > 0) { // Remember where we left off hr_start_index = hr_mesg_counter; hr_start_sub_index = j; findingInRangeHrMesgs = false; if (hrSumCount > 0) { // Update record heart rate last_valid_hr = (byte?)System.Math.Round((((float)hrSum) / hrSumCount), MidpointRounding.AwayFromZero); recordMesg.SetHeartRate(last_valid_hr); mesgs[mesgCounter] = (Mesg)recordMesg; } // If no stored HR is available, fill in record messages with the // last valid filtered hr for a maximum of 5 seconds else if ((record_range_start_time.CompareTo(last_valid_hr_time) > 0) && ((record_range_start_time.GetTimeStamp() - last_valid_hr_time.GetTimeStamp()) < 5)) { recordMesg.SetHeartRate(last_valid_hr); mesgs[mesgCounter] = (Mesg)recordMesg; } // Reset HR average hrSum = 0; hrSumCount = 0; record_range_start_time = new DateTime(record_range_end_time); // Breaks out of looping within the event_timestamp array break; } } } hr_mesg_counter++; hr_sub_mesg_counter = 0; } } } } }