gd-ant-plus
Version:
A node module for ANT+ - forked from longhorn/ant-plus
139 lines • 5.98 kB
JavaScript
"use strict";
/*
* ANT+ profile: https://www.thisisant.com/developer/ant-plus/device-profiles/#523_tab
* Spec sheet: https://www.thisisant.com/resources/bicycle-speed-and-cadence/
*/
Object.defineProperty(exports, "__esModule", { value: true });
exports.SpeedCadenceScanner = exports.SpeedCadenceSensor = void 0;
const Ant = require("./ant");
const Messages = Ant.Messages;
const Constants = Ant.Constants;
class SpeedCadenceSensorState {
constructor(deviceID) {
this.DeviceID = deviceID;
}
}
class SpeedCadenceScanState extends SpeedCadenceSensorState {
}
class SpeedCadenceSensor extends Ant.AntPlusSensor {
constructor(stick) {
super(stick);
this.wheelCircumference = 2.118; //This is my 700c wheel, just using as default
this.decodeDataCbk = this.decodeData.bind(this);
}
setWheelCircumference(wheelCircumference) {
this.wheelCircumference = wheelCircumference;
}
attach(channel, deviceID) {
super.attach(channel, 'receive', deviceID, SpeedCadenceSensor.deviceType, 0, 255, 8086);
this.state = new SpeedCadenceSensorState(deviceID);
}
decodeData(data) {
if (data.readUInt8(Messages.BUFFER_INDEX_CHANNEL_NUM) !== this.channel) {
return;
}
switch (data.readUInt8(Messages.BUFFER_INDEX_MSG_TYPE)) {
case Constants.MESSAGE_CHANNEL_BROADCAST_DATA:
case Constants.MESSAGE_CHANNEL_ACKNOWLEDGED_DATA:
case Constants.MESSAGE_CHANNEL_BURST_DATA:
if (this.deviceID === 0) {
this.write(Messages.requestMessage(this.channel, Constants.MESSAGE_CHANNEL_ID));
}
updateState(this, this.state, data);
break;
case Constants.MESSAGE_CHANNEL_ID:
this.deviceID = data.readUInt16LE(Messages.BUFFER_INDEX_MSG_DATA);
this.transmissionType = data.readUInt8(Messages.BUFFER_INDEX_MSG_DATA + 3);
this.state.DeviceID = this.deviceID;
break;
default:
break;
}
}
}
exports.SpeedCadenceSensor = SpeedCadenceSensor;
SpeedCadenceSensor.deviceType = 0x79;
class SpeedCadenceScanner extends Ant.AntPlusScanner {
constructor(stick) {
super(stick);
this.wheelCircumference = 2.118; //This is my 700c wheel, just using as default
this.states = {};
this.decodeDataCbk = this.decodeData.bind(this);
}
setWheelCircumference(wheelCircumference) {
this.wheelCircumference = wheelCircumference;
}
scan() {
super.scan('receive');
}
decodeData(data) {
if (data.length <= (Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 3) || !(data.readUInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN) & 0x80)) {
console.log('wrong message format');
return;
}
const deviceId = data.readUInt16LE(Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 1);
const deviceType = data.readUInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 3);
if (deviceType !== SpeedCadenceScanner.deviceType) {
return;
}
if (!this.states[deviceId]) {
this.states[deviceId] = new SpeedCadenceScanState(deviceId);
}
if (data.readUInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN) & 0x40) {
if (data.readUInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 5) === 0x20) {
this.states[deviceId].Rssi = data.readInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 6);
this.states[deviceId].Threshold = data.readInt8(Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 7);
}
}
switch (data.readUInt8(Messages.BUFFER_INDEX_MSG_TYPE)) {
case Constants.MESSAGE_CHANNEL_BROADCAST_DATA:
case Constants.MESSAGE_CHANNEL_ACKNOWLEDGED_DATA:
case Constants.MESSAGE_CHANNEL_BURST_DATA:
updateState(this, this.states[deviceId], data);
break;
default:
break;
}
}
}
exports.SpeedCadenceScanner = SpeedCadenceScanner;
SpeedCadenceScanner.deviceType = 0x79;
function updateState(sensor, state, data) {
//get old state for calculating cumulative values
const oldCadenceTime = state.CadenceEventTime;
const oldCadenceCount = state.CumulativeCadenceRevolutionCount;
const oldSpeedTime = state.SpeedEventTime;
const oldSpeedCount = state.CumulativeSpeedRevolutionCount;
let cadenceTime = data.readUInt16LE(Messages.BUFFER_INDEX_MSG_DATA);
const cadenceCount = data.readUInt16LE(Messages.BUFFER_INDEX_MSG_DATA + 2);
let speedEventTime = data.readUInt16LE(Messages.BUFFER_INDEX_MSG_DATA + 4);
const speedRevolutionCount = data.readUInt16LE(Messages.BUFFER_INDEX_MSG_DATA + 6);
if (cadenceTime !== oldCadenceTime) {
state.CadenceEventTime = cadenceTime;
state.CumulativeCadenceRevolutionCount = cadenceCount;
if (oldCadenceTime > cadenceTime) { //Hit rollover value
cadenceTime += (1024 * 64);
}
const cadence = ((60 * (cadenceCount - oldCadenceCount) * 1024) / (cadenceTime - oldCadenceTime));
if (!isNaN(cadence)) {
state.CalculatedCadence = cadence;
sensor.emit('cadenceData', state);
}
}
if (speedEventTime !== oldSpeedTime) {
state.SpeedEventTime = speedEventTime;
state.CumulativeSpeedRevolutionCount = speedRevolutionCount;
if (oldSpeedTime > speedEventTime) { //Hit rollover value
speedEventTime += (1024 * 64);
}
const distance = sensor.wheelCircumference * (speedRevolutionCount - oldSpeedCount);
state.CalculatedDistance = distance;
//speed in m/sec
const speed = (distance * 1024) / (speedEventTime - oldSpeedTime);
if (!isNaN(speed)) {
state.CalculatedSpeed = speed;
sensor.emit('speedData', state);
}
}
}
//# sourceMappingURL=speed-cadence-sensors.js.map