incyclist-ant-plus
Version:
Incyclist library for ANT+ - originally forked from longhorn/ant-plus
197 lines (196 loc) • 7.96 kB
JavaScript
"use strict";
var __createBinding = (this && this.__createBinding) || (Object.create ? (function(o, m, k, k2) {
if (k2 === undefined) k2 = k;
var desc = Object.getOwnPropertyDescriptor(m, k);
if (!desc || ("get" in desc ? !m.__esModule : desc.writable || desc.configurable)) {
desc = { enumerable: true, get: function() { return m[k]; } };
}
Object.defineProperty(o, k2, desc);
}) : (function(o, m, k, k2) {
if (k2 === undefined) k2 = k;
o[k2] = m[k];
}));
var __setModuleDefault = (this && this.__setModuleDefault) || (Object.create ? (function(o, v) {
Object.defineProperty(o, "default", { enumerable: true, value: v });
}) : function(o, v) {
o["default"] = v;
});
var __importStar = (this && this.__importStar) || (function () {
var ownKeys = function(o) {
ownKeys = Object.getOwnPropertyNames || function (o) {
var ar = [];
for (var k in o) if (Object.prototype.hasOwnProperty.call(o, k)) ar[ar.length] = k;
return ar;
};
return ownKeys(o);
};
return function (mod) {
if (mod && mod.__esModule) return mod;
var result = {};
if (mod != null) for (var k = ownKeys(mod), i = 0; i < k.length; i++) if (k[i] !== "default") __createBinding(result, mod, k[i]);
__setModuleDefault(result, mod);
return result;
};
})();
Object.defineProperty(exports, "__esModule", { value: true });
exports.SpeedSensorState = void 0;
const consts_1 = require("../consts");
const messages_1 = require("../messages");
const base_sensor_1 = __importStar(require("./base-sensor"));
class SpeedSensorState extends base_sensor_1.SensorState {
}
exports.SpeedSensorState = SpeedSensorState;
const DEVICE_TYPE = 0x7b;
const PROFILE = 'SPD';
const PERIOD = 8118;
const DEFAULT_WHEEL_CIRCUMFERENCE = 2.118;
class SpeedSensor extends base_sensor_1.default {
constructor() {
super(...arguments);
this.states = {};
this.wheelCircumference = DEFAULT_WHEEL_CIRCUMFERENCE;
}
getProfile() {
return PROFILE;
}
getDeviceType() {
return DEVICE_TYPE;
}
getChannelConfiguration() {
return {
type: 'receive',
transmissionType: 0,
timeout: consts_1.Constants.TIMEOUT_NEVER,
period: PERIOD,
frequency: 57,
};
}
onEvent(data) {
return;
}
setWheelCircumference(wheelCircumference) {
this.wheelCircumference = wheelCircumference;
}
onMessage(data) {
const channel = this.getChannel();
if (!channel)
return;
const channelNo = channel.getChannelNo();
const deviceID = data.readUInt16LE(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 1);
const deviceType = data.readUInt8(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 3);
if (data.readUInt8(messages_1.Messages.BUFFER_INDEX_CHANNEL_NUM) !== channelNo || deviceType !== this.getDeviceType()) {
return;
}
if (!this.states[deviceID]) {
this.states[deviceID] = new SpeedSensorState(deviceID);
this.states[deviceID].Channel = channelNo;
}
if (data.readUInt8(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN) & 0x40) {
if (data.readUInt8(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 5) === 0x20) {
this.states[deviceID].Rssi = data.readInt8(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 6);
this.states[deviceID].Threshold = data.readInt8(messages_1.Messages.BUFFER_INDEX_EXT_MSG_BEGIN + 7);
}
}
switch (data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_TYPE)) {
case consts_1.Constants.MESSAGE_CHANNEL_BROADCAST_DATA:
case consts_1.Constants.MESSAGE_CHANNEL_ACKNOWLEDGED_DATA:
case consts_1.Constants.MESSAGE_CHANNEL_BURST_DATA:
updateState(this, this.states[deviceID], data);
if (this.deviceID === 0 || this.deviceID === deviceID) {
channel.onDeviceData(this.getProfile(), deviceID, this.states[deviceID]);
}
break;
default:
break;
}
}
}
exports.default = SpeedSensor;
const TOGGLE_MASK = 0x80;
function updateState(sensor, state, data) {
state._RawData = data;
const pageNum = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA);
switch (pageNum & ~TOGGLE_MASK) {
case 1: {
state.OperatingTime = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 1);
state.OperatingTime |= data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 2) << 8;
state.OperatingTime |= data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 3) << 16;
state.OperatingTime *= 2;
break;
}
case 2: {
state.ManId = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 1);
state.SerialNumber = state.DeviceID;
state.SerialNumber |= data.readUInt16LE(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 2) << 16;
state.SerialNumber >>>= 0;
break;
}
case 3: {
state.HwVersion = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 1);
state.SwVersion = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 2);
state.ModelNum = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 3);
break;
}
case 4: {
const batteryFrac = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 2);
const batteryStatus = data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 3);
state.BatteryVoltage = (batteryStatus & 0x0f) + batteryFrac / 256;
const batteryFlags = (batteryStatus & 0x70) >>> 4;
switch (batteryFlags) {
case 1:
state.BatteryStatus = 'New';
break;
case 2:
state.BatteryStatus = 'Good';
break;
case 3:
state.BatteryStatus = 'Ok';
break;
case 4:
state.BatteryStatus = 'Low';
break;
case 5:
state.BatteryStatus = 'Critical';
break;
default:
state.BatteryVoltage = undefined;
state.BatteryStatus = 'Invalid';
break;
}
break;
}
case 5: {
state.Motion = (data.readUInt8(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 1) & 0x01) === 0x01;
break;
}
default:
break;
}
const oldUpdateTime = state._UpdateTime;
const oldSpeedTime = state.SpeedEventTime;
const oldSpeedCount = state.CumulativeSpeedRevolutionCount;
let delay = 3000;
const eventTime = Date.now();
let speedTime = data.readUInt16LE(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 4);
const speedCount = data.readUInt16LE(messages_1.Messages.BUFFER_INDEX_MSG_DATA + 6);
if ((speedTime === oldSpeedTime) && (eventTime - oldUpdateTime >= delay)) {
state.CalculatedSpeed = 0;
}
else if (state.Motion !== undefined && !state.Motion) {
state.CalculatedSpeed = 0;
}
else {
state._UpdateTime = eventTime;
state.SpeedEventTime = speedTime;
state.CumulativeSpeedRevolutionCount = speedCount;
if (oldSpeedTime > speedTime) {
speedTime += 1024 * 64;
}
const distance = sensor.wheelCircumference * (speedCount - oldSpeedCount);
state.CalculatedDistance = distance;
const speed = (distance * 1024) / (speedTime - oldSpeedTime);
if (!isNaN(speed)) {
state.CalculatedSpeed = speed;
}
}
}