Merge with 3dfdbcf78de082edb66a8994ffb604c84945df0d

This commit is contained in:
nic
2011-05-10 10:09:04 +02:00
2 changed files with 57 additions and 50 deletions
@@ -33,6 +33,7 @@ public class SensorUtils {
/**
* Extract one unsigned short from a big endian byte array.
*
* @param buffer the buffer to extract the short from
* @param index the first byte to be interpreted as part of the short
* @return The unsigned short at the given index in the buffer
@@ -45,6 +46,7 @@ public class SensorUtils {
/**
* Extract one unsigned short from a little endian byte array.
*
* @param buffer the buffer to extract the short from
* @param index the first byte to be interpreted as part of the short
* @return The unsigned short at the given index in the buffer
@@ -56,36 +58,40 @@ public class SensorUtils {
}
/**
* Returns CRC8 (polynomial 0x8C) from byte array buffer[start] until (including) buffer[end]
* Returns CRC8 (polynomial 0x8C) from byte array buffer[start] until
* (including) buffer[end]
*
* @param buffer the byte array of data (payload)
* @param start the position in the byte array where the payload begins
* @param end the position in the byte array where the payload ends
* @return CRC8 value
*/
public static int getCrc8(byte[] buffer, int start, int end) {
int[] crc = { 0x0 };
int crc = 0x0;
for (int i = start; i < (end + 1); i++) {
crc8PushByte(crc, buffer[i]);
crc = crc8PushByte(crc, buffer[i]);
}
return crc[0];
return crc;
}
/**
* Updates a CRC8 value by using the next byte passed to this method
* @param crc int of crc value (as an array to pass it as reference)
*
* @param crc int of crc value
* @param add the next byte to add to the CRC8 calculation
*/
private static void crc8PushByte(int[] crc, byte add) {
private static int crc8PushByte(int crc, byte add) {
int addInt = (add & 0x000000FF);
crc[0] = crc[0] ^ addInt;
crc = crc ^ addInt;
for (int i = 0; i < 8; i++) {
if ((crc[0] & 0x00000001) != 0x00000000) {
crc[0] = (crc[0] >> 1) ^ 0x0000008C;
if ((crc & 0x00000001) != 0x00000000) {
crc = (crc >> 1) ^ 0x0000008C;
} else {
crc[0] = (crc[0] >> 1);
crc = (crc >> 1);
}
}
return crc;
}
public static String getStateAsString(Sensor.SensorState state, Context c) {
@@ -21,19 +21,19 @@ import com.google.android.apps.mytracks.Constants;
import com.google.android.apps.mytracks.content.Sensor;
/**
* An implementation of a SensorData parser for Zephyr HRM.
* An implementation of a Sensor MessageParser for Zephyr.
*
* @author Sandor Dornbush
*/
public class ZephyrMessageParser implements MessageParser {
@Override
public Sensor.SensorDataSet parseBuffer(byte[] buffer) {
StringBuilder sb = new StringBuilder();
for (int i = 0; i < buffer.length; i++) {
sb.append(String.format("%02X", buffer[i]));
}
Log.w(Constants.TAG, "Got zephyr data: " + sb);
// The provided units are 1/16 strides per minute.
// Heart Rate
Sensor.SensorData.Builder heartrate = Sensor.SensorData.newBuilder()
.setValue(buffer[12] & 0xFF)
@@ -46,9 +46,6 @@ public class ZephyrMessageParser implements MessageParser {
.setValue(SensorUtils.unsignedShortToIntLittleEndian(buffer, 56) / 16)
.setState(Sensor.SensorState.SENDING);
// Cadence
//.setCadence(cadence / 16)
//.build();
Sensor.SensorDataSet sds =
Sensor.SensorDataSet.newBuilder()
.setCreationTime(System.currentTimeMillis())
@@ -60,16 +57,20 @@ public class ZephyrMessageParser implements MessageParser {
return sds;
}
@Override
public boolean isValid(byte[] buffer) {
// Changes Nico Laum
// Check STX, ETX and CRC Checksum
return (buffer[0] == 0x02 && buffer[59] == 0x03 && (SensorUtils.getCrc8(buffer, 3, 57) == (int) (buffer[58] & 0xFF)));
return buffer[0] == 0x02
&& buffer[59] == 0x03
&& SensorUtils.getCrc8(buffer, 3, 57) == (int) (buffer[58] & 0xFF);
}
@Override
public int getFrameSize() {
return 60;
}
@Override
public int findNextAlignment(byte[] buffer) {
// TODO test or understand this code.
for (int i = 0; i < buffer.length - 1; i++) {