incyclist-devices 2.2.9 → 2.3.0

package/lib/ble/tacx/sensor.js

@@ -0,0 +1,596 @@
+"use strict";
+var __awaiter = (this && this.__awaiter) || function (thisArg, _arguments, P, generator) {
+    function adopt(value) { return value instanceof P ? value : new P(function (resolve) { resolve(value); }); }
+    return new (P || (P = Promise))(function (resolve, reject) {
+        function fulfilled(value) { try { step(generator.next(value)); } catch (e) { reject(e); } }
+        function rejected(value) { try { step(generator["throw"](value)); } catch (e) { reject(e); } }
+        function step(result) { result.done ? resolve(result.value) : adopt(result.value).then(fulfilled, rejected); }
+        step((generator = generator.apply(thisArg, _arguments || [])).next());
+    });
+};
+var __importDefault = (this && this.__importDefault) || function (mod) {
+    return (mod && mod.__esModule) ? mod : { "default": mod };
+};
+Object.defineProperty(exports, "__esModule", { value: true });
+const consts_1 = require("../consts");
+const consts_2 = require("./consts");
+const sensor_1 = __importDefault(require("../fm/sensor"));
+const utils_1 = require("../utils");
+class TacxAdvancedFitnessMachineDevice extends sensor_1.default {
+    constructor(peripheral, props) {
+        super(peripheral, props);
+        this.prevCrankData = undefined;
+        this.currentCrankData = undefined;
+        this.timeOffset = 0;
+        this.tsPrevWrite = undefined;
+        this.prevMessages = {};
+        this.data = {};
+        this.hasFECData = false;
+        this.messageCnt = 0;
+        this.tacxRx = consts_2.TACX_FE_C_RX;
+        this.tacxTx = consts_2.TACX_FE_C_TX;
+    }
+    reset() {
+        this.data = {};
+    }
+    getRequiredCharacteristics() {
+        return [consts_1.INDOOR_BIKE_DATA, '2a37', consts_1.FTMS_STATUS, consts_1.CSP_MEASUREMENT, consts_1.CSC_MEASUREMENT, this.tacxRx];
+    }
+    onData(characteristic, data) {
+        const isDuplicate = this.isDuplicate(characteristic, data);
+        if (isDuplicate) {
+            return false;
+        }
+        this.messageCnt++;
+        try {
+            const uuid = characteristic.toLocaleLowerCase();
+            let res = undefined;
+            if (uuid && (0, utils_1.matches)(uuid, this.tacxRx)) {
+                res = this.parseFECMessage(data);
+            }
+            else {
+                switch (uuid) {
+                    case consts_1.CSP_MEASUREMENT:
+                        res = this.parsePower(data, this.hasFECData);
+                        break;
+                    case consts_1.INDOOR_BIKE_DATA:
+                        res = this.parseIndoorBikeData(data, this.hasFECData);
+                        break;
+                    case '2a37':
+                        res = this.parseHrm(data);
+                        break;
+                    case consts_1.CSC_MEASUREMENT:
+                        res = this.parseCSC(data, this.hasFECData);
+                        break;
+                    case consts_1.FTMS_STATUS:
+                        if (!this.hasFECData)
+                            res = this.parseFitnessMachineStatus(data);
+                        break;
+                    default:
+                        break;
+                }
+            }
+            if (res)
+                this.emit('data', res);
+            return res;
+        }
+        catch (err) {
+            this.logEvent({ message: 'error', fn: 'tacx.onData()', error: err.message || err, stack: err.stack });
+        }
+    }
+    isDuplicate(characteristic, data) {
+        const uuid = (0, utils_1.beautifyUUID)(characteristic);
+        const message = data.toString('hex');
+        const prev = this.prevMessages[uuid];
+        if ((prev === null || prev === void 0 ? void 0 : prev.message) === message && Date.now() - (prev === null || prev === void 0 ? void 0 : prev.ts) < 1000) {
+            return true;
+        }
+        this.prevMessages[uuid] = { ts: Date.now(), message };
+        return false;
+    }
+    setTargetPower(power) {
+        return __awaiter(this, void 0, void 0, function* () {
+            if (this.data.targetPower !== undefined && this.data.targetPower === power)
+                return true;
+            return yield this.sendTargetPower(power);
+        });
+    }
+    setSlope(slope) {
+        return __awaiter(this, void 0, void 0, function* () {
+            return yield this.sendTrackResistance(slope, this.crr);
+        });
+    }
+    requestControl() {
+        return __awaiter(this, void 0, void 0, function* () {
+            return true;
+        });
+    }
+    parseCrankData(crankData) {
+        if (!this.prevCrankData) {
+            this.prevCrankData = Object.assign(Object.assign({}, crankData), { cntUpdateMissing: -1 });
+            return {};
+        }
+        const c = this.currentCrankData = crankData;
+        const p = this.prevCrankData;
+        let rpm = this.data.cadence;
+        let hasUpdate = c.time !== p.time;
+        if (hasUpdate) {
+            let time = c.time - p.time;
+            let revs = c.revolutions - p.revolutions;
+            if (c.time < p.time) {
+                time += 0x10000;
+                this.timeOffset += 0x10000;
+            }
+            if (c.revolutions < p.revolutions)
+                revs += 0x10000;
+            rpm = 1024 * 60 * revs / time;
+        }
+        else if (p.cntUpdateMissing < 0 || p.cntUpdateMissing > 2) {
+            rpm = 0;
+        }
+        const cntUpdateMissing = p.cntUpdateMissing;
+        this.prevCrankData = this.currentCrankData;
+        if (hasUpdate)
+            this.prevCrankData.cntUpdateMissing = 0;
+        else
+            this.prevCrankData.cntUpdateMissing = cntUpdateMissing + 1;
+        return { rpm, time: this.timeOffset + c.time };
+    }
+    parseCSC(_data, logOnly = false) {
+        const data = Buffer.from(_data);
+        this.logEvent({ message: 'BLE CSC message', data: data.toString('hex') });
+        if (logOnly)
+            return this.data;
+        let offset = 0;
+        const flags = data.readUInt8(offset);
+        offset++;
+        if (flags & 0x01) {
+            offset += 6;
+        }
+        if (flags & 0x02) {
+            const crankData = {
+                revolutions: data.readUInt16LE(offset),
+                time: data.readUInt16LE(offset + 2)
+            };
+            const { rpm, time } = this.parseCrankData(crankData);
+            this.data.cadence = rpm;
+            this.data.time = time;
+        }
+        return this.data;
+    }
+    parsePower(_data, logOnly = false) {
+        const data = Buffer.from(_data);
+        this.logEvent({ message: 'BLE CSP message', data: data.toString('hex') });
+        if (logOnly)
+            return this.data;
+        try {
+            let offset = 4;
+            const flags = data.readUInt16LE(0);
+            this.data.instantaneousPower = data.readUInt16LE(2);
+            if (flags & 0x1)
+                data.readUInt8(offset++);
+            if (flags & 0x4) {
+                offset += 2;
+            }
+            if (flags & 0x10) {
+                offset += 6;
+            }
+            if (flags & 0x20) {
+                const crankData = {
+                    revolutions: data.readUInt16LE(offset),
+                    time: data.readUInt16LE(offset + 2)
+                };
+                const { rpm, time } = this.parseCrankData(crankData);
+                this.data.cadence = rpm;
+                this.data.time = time;
+            }
+        }
+        catch (err) {
+            this.logEvent({ message: 'error', fn: 'parsePower()', error: err.message || err, stack: err.stack });
+        }
+        const { instantaneousPower, cadence, time } = this.data;
+        return { instantaneousPower, cadence, time, raw: data.toString('hex') };
+    }
+    parseIndoorBikeData(_data, logOnly) {
+        this.logEvent({ message: 'BLE INDOOR_BIKE_DATA message', data: _data.toString('hex') });
+        if (logOnly)
+            return this.data;
+        return super.parseIndoorBikeData(_data);
+    }
+    resetState() {
+        const state = this.data;
+        delete state.time;
+        delete state.totalDistance;
+        delete state.RealSpeed;
+        delete state.VirtualSpeed;
+        delete state.heartrate;
+        delete state.HeartRateSource;
+        delete state.EventCount;
+        delete state.cadence;
+        delete state.AccumulatedPower;
+        delete state.instantaneousPower;
+        delete state.averagePower;
+        delete state.TrainerStatus;
+        delete state.TargetStatus;
+    }
+    parseFEState(capStateBF) {
+        switch ((capStateBF & 0x70) >> 4) {
+            case 1:
+                this.data.State = 'OFF';
+                break;
+            case 2:
+                this.data.State = 'READY';
+                this.resetState();
+                break;
+            case 3:
+                this.data.State = 'IN_USE';
+                break;
+            case 4:
+                this.data.State = 'FINISHED';
+                break;
+            default:
+                delete this.data.State;
+                break;
+        }
+        if (capStateBF & 0x80) {
+        }
+    }
+    parseGeneralFE(data) {
+        const equipmentTypeBF = data.readUInt8(1);
+        let elapsedTime = data.readUInt8(2);
+        let distance = data.readUInt8(3);
+        const speed = data.readUInt16LE(4);
+        const heartRate = data.readUInt8(6);
+        const capStateBF = data.readUInt8(7);
+        this.parseFEEquipmentType(equipmentTypeBF);
+        this.parseFEHeartrate(heartRate, capStateBF);
+        this.parseFETime(elapsedTime);
+        this.parseFEDistance(capStateBF, distance);
+        this.data.speed = speed / 1000;
+        this.parseFERealSpeed(capStateBF, speed);
+        this.parseFEState(capStateBF);
+        return this.data;
+    }
+    parseFEEquipmentType(equipmentTypeBF) {
+        switch (equipmentTypeBF & 0x1F) {
+            case 19:
+                this.data.EquipmentType = 'Treadmill';
+                break;
+            case 20:
+                this.data.EquipmentType = 'Elliptical';
+                break;
+            case 21:
+                this.data.EquipmentType = 'StationaryBike';
+                break;
+            case 22:
+                this.data.EquipmentType = 'Rower';
+                break;
+            case 23:
+                this.data.EquipmentType = 'Climber';
+                break;
+            case 24:
+                this.data.EquipmentType = 'NordicSkier';
+                break;
+            case 25:
+                this.data.EquipmentType = 'Trainer';
+                break;
+            default:
+                this.data.EquipmentType = 'General';
+                break;
+        }
+    }
+    parseFEHeartrate(heartRate, capStateBF) {
+        if (heartRate !== 0xFF) {
+            switch (capStateBF & 0x03) {
+                case 3: {
+                    this.data.heartrate = heartRate;
+                    this.data.HeartRateSource = 'HandContact';
+                    break;
+                }
+                case 2: {
+                    this.data.heartrate = heartRate;
+                    this.data.HeartRateSource = 'EM';
+                    break;
+                }
+                case 1: {
+                    this.data.heartrate = heartRate;
+                    this.data.HeartRateSource = 'ANT+';
+                    break;
+                }
+                default: {
+                    delete this.data.heartrate;
+                    delete this.data.HeartRateSource;
+                    break;
+                }
+            }
+        }
+    }
+    parseFETime(elapsedTime) {
+        elapsedTime /= 4;
+        const oldElapsedTime = (this.data.time || 0) % 64;
+        if (elapsedTime !== oldElapsedTime) {
+            if (oldElapsedTime > elapsedTime) {
+                elapsedTime += 64;
+            }
+        }
+        this.data.time = (this.data.time || 0) + elapsedTime - oldElapsedTime;
+    }
+    parseFEDistance(capStateBF, distance) {
+        if (capStateBF & 0x04) {
+            const oldDistance = (this.data.time || 0) % 256;
+            if (distance !== oldDistance) {
+                if (oldDistance > distance) {
+                    distance += 256;
+                }
+            }
+            this.data.totalDistance = (this.data.totalDistance || 0) + distance - oldDistance;
+        }
+        else {
+            delete this.data.totalDistance;
+        }
+    }
+    parseFERealSpeed(capStateBF, speed) {
+        if (capStateBF & 0x08) {
+            this.data.VirtualSpeed = speed / 1000;
+            delete this.data.RealSpeed;
+        }
+        else {
+            delete this.data.VirtualSpeed;
+            this.data.RealSpeed = speed / 1000;
+        }
+    }
+    parseTrainerData(data) {
+        const oldEventCount = this.data.EventCount || 0;
+        let eventCount = data.readUInt8(1);
+        const cadence = data.readUInt8(2);
+        let accPower = data.readUInt16LE(3);
+        const power = data.readUInt16LE(5) & 0xFFF;
+        const trainerStatus = data.readUInt8(6) >> 4;
+        const flagStateBF = data.readUInt8(7);
+        if (eventCount !== oldEventCount) {
+            this.data.EventCount = eventCount;
+            if (oldEventCount > eventCount) {
+                eventCount += 255;
+            }
+        }
+        if (cadence !== 0xFF) {
+            this.data.cadence = cadence;
+        }
+        if (power !== 0xFFF) {
+            this.data.instantaneousPower = power;
+            const oldAccPower = (this.data.AccumulatedPower || 0) % 65536;
+            if (accPower !== oldAccPower) {
+                if (oldAccPower > accPower) {
+                    accPower += 65536;
+                }
+            }
+            this.data.AccumulatedPower = (this.data.AccumulatedPower || 0) + accPower - oldAccPower;
+            this.data.averagePower = (accPower - oldAccPower) / (eventCount - oldEventCount);
+        }
+        this.data.TrainerStatus = trainerStatus;
+        switch (flagStateBF & 0x03) {
+            case 0:
+                this.data.TargetStatus = 'OnTarget';
+                break;
+            case 1:
+                this.data.TargetStatus = 'LowSpeed';
+                break;
+            case 2:
+                this.data.TargetStatus = 'HighSpeed';
+                break;
+            default:
+                delete this.data.TargetStatus;
+                break;
+        }
+        this.parseFEState(flagStateBF);
+        if (power !== undefined && cadence !== undefined)
+            this.hasFECData = true;
+        return this.data;
+    }
+    parseProductInformation(data) {
+        const swRevSup = data.readUInt8(2);
+        const swRevMain = data.readUInt8(3);
+        const serial = data.readInt32LE(4);
+        this.data.SwVersion = swRevMain;
+        if (swRevSup !== 0xFF) {
+            this.data.SwVersion += swRevSup / 1000;
+        }
+        if (serial !== 0xFFFFFFFF) {
+            this.data.SerialNumber = serial;
+        }
+        return this.data;
+    }
+    parseFECMessage(_data) {
+        const data = Buffer.from(_data);
+        this.logEvent({ message: 'FE-C message', data: data.toString('hex') });
+        const c = data.readUInt8(0);
+        if (c !== consts_2.SYNC_BYTE) {
+            this.logEvent({ message: 'SYNC missing', raw: data.toString('hex') });
+            return;
+        }
+        const len = data.readUInt8(1);
+        const messageId = data.readUInt8(4);
+        let res;
+        try {
+            switch (messageId) {
+                case consts_2.ANTMessages.generalFE:
+                    res = this.parseGeneralFE(data.subarray(4, len + 3));
+                    break;
+                case consts_2.ANTMessages.trainerData:
+                    res = this.parseTrainerData(data.subarray(4, len + 3));
+                    break;
+                case consts_2.ANTMessages.productInformation:
+                    res = this.parseProductInformation(data.subarray(4, len + 3));
+                    break;
+            }
+            if (res)
+                res.raw = data.toString('hex');
+        }
+        catch (err) {
+            this.logEvent({ message: 'error', fn: 'parseFECMessage()', error: err.message || err, stack: err.stack });
+        }
+        return res;
+    }
+    getChecksum(message) {
+        let checksum = 0;
+        message.forEach((byte) => {
+            checksum = (checksum ^ byte) % 0xFF;
+        });
+        return checksum;
+    }
+    buildMessage(payload = [], msgID = 0x00) {
+        const m = [];
+        m.push(consts_2.SYNC_BYTE);
+        m.push(payload.length);
+        m.push(msgID);
+        payload.forEach((byte) => {
+            m.push(byte);
+        });
+        m.push(this.getChecksum(m));
+        return Buffer.from(m);
+    }
+    sendMessage(message) {
+        return __awaiter(this, void 0, void 0, function* () {
+            this.logEvent({ message: 'write', characteristic: this.tacxTx, data: message.toString('hex') });
+            yield this.write(this.tacxTx, message, { withoutResponse: true });
+            return true;
+        });
+    }
+    sendUserConfiguration(userWeight, bikeWeight, wheelDiameter, gearRatio) {
+        return __awaiter(this, void 0, void 0, function* () {
+            const logStr = `sendUserConfiguration(${userWeight},${bikeWeight},${wheelDiameter},${gearRatio})`;
+            this.logEvent({ message: logStr });
+            let m = userWeight === undefined ? 0xFFFF : userWeight;
+            let mb = bikeWeight === undefined ? 0xFFF : bikeWeight;
+            let d = wheelDiameter === undefined ? 0xFF : wheelDiameter;
+            let gr = gearRatio === undefined ? 0x00 : gearRatio;
+            let dOffset = 0xFF;
+            if (m !== 0xFFFF)
+                m = Math.trunc(m * 100);
+            if (mb !== 0xFFF)
+                mb = Math.trunc(mb * 20);
+            if (d !== 0xFF) {
+                d = d * 1000;
+                dOffset = d % 10;
+                d = Math.trunc(d / 10);
+            }
+            if (gr !== 0x00) {
+                gr = Math.trunc(gr / 0.03);
+            }
+            const payload = [];
+            payload.push(consts_2.DEFAULT_CHANNEL);
+            payload.push(0x37);
+            payload.push(m & 0xFF);
+            payload.push((m >> 8) & 0xFF);
+            payload.push(0xFF);
+            payload.push(((mb & 0xF) << 4) | (dOffset & 0xF));
+            payload.push((mb >> 4) & 0xF);
+            payload.push(d & 0xFF);
+            payload.push(gr & 0xFF);
+            const data = this.buildMessage(payload, consts_2.ACKNOWLEDGED_DATA);
+            return yield this.sendMessage(data);
+        });
+    }
+    sendBasicResistance(resistance) {
+        return __awaiter(this, void 0, void 0, function* () {
+            const logStr = `sendBasicResistance(${resistance})`;
+            this.logEvent({ message: logStr });
+            let res = resistance === undefined ? 0 : resistance;
+            res = res / 0.5;
+            const payload = [];
+            payload.push(consts_2.DEFAULT_CHANNEL);
+            payload.push(0x30);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(res & 0xFF);
+            const data = this.buildMessage(payload, consts_2.ACKNOWLEDGED_DATA);
+            return yield this.sendMessage(data);
+        });
+    }
+    sendTargetPower(power) {
+        return __awaiter(this, void 0, void 0, function* () {
+            const logStr = `sendTargetPower(${power})`;
+            this.logEvent({ message: logStr });
+            let p = power === undefined ? 0x00 : power;
+            p = p * 4;
+            const payload = [];
+            payload.push(consts_2.DEFAULT_CHANNEL);
+            payload.push(0x31);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(p & 0xFF);
+            payload.push((p >> 8) & 0xFF);
+            const data = this.buildMessage(payload, consts_2.ACKNOWLEDGED_DATA);
+            return yield this.sendMessage(data);
+        });
+    }
+    sendWindResistance(windCoeff, windSpeed, draftFactor) {
+        return __awaiter(this, void 0, void 0, function* () {
+            const logStr = `sendWindResistance(${windCoeff},${windSpeed},${draftFactor})`;
+            this.logEvent({ message: logStr });
+            let wc = windCoeff === undefined ? 0xFF : windCoeff;
+            let ws = windSpeed === undefined ? 0xFF : windSpeed;
+            let df = draftFactor === undefined ? 0xFF : draftFactor;
+            if (wc !== 0xFF) {
+                wc = Math.trunc(wc / 0.01);
+            }
+            if (ws !== 0xFF) {
+                ws = Math.trunc(ws + 127);
+            }
+            if (df !== 0xFF) {
+                df = Math.trunc(df / 0.01);
+            }
+            const payload = [];
+            payload.push(consts_2.DEFAULT_CHANNEL);
+            payload.push(0x32);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(wc & 0xFF);
+            payload.push(ws & 0xFF);
+            payload.push(df & 0xFF);
+            const data = this.buildMessage(payload, consts_2.ACKNOWLEDGED_DATA);
+            return yield this.sendMessage(data);
+        });
+    }
+    sendTrackResistance(slope, rrCoeff) {
+        return __awaiter(this, void 0, void 0, function* () {
+            const logStr = `sendTrackResistance(${slope},${rrCoeff})`;
+            this.logEvent({ message: logStr });
+            let s = slope === undefined ? 0xFFFF : slope;
+            let rr = rrCoeff === undefined ? 0xFF : rrCoeff;
+            if (s !== 0xFFFF) {
+                s = Math.trunc((s + 200) / 0.01);
+            }
+            if (rr !== 0xFF) {
+                rr = Math.trunc(rr / 0.00005);
+            }
+            const payload = [];
+            payload.push(consts_2.DEFAULT_CHANNEL);
+            payload.push(0x33);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(0xFF);
+            payload.push(s & 0xFF);
+            payload.push((s >> 8) & 0xFF);
+            payload.push(rr & 0xFF);
+            const data = this.buildMessage(payload, consts_2.ACKNOWLEDGED_DATA);
+            return yield this.sendMessage(data);
+        });
+    }
+}
+TacxAdvancedFitnessMachineDevice.profile = 'Smart Trainer';
+TacxAdvancedFitnessMachineDevice.protocol = 'tacx';
+TacxAdvancedFitnessMachineDevice.services = [consts_2.TACX_FE_C_BLE];
+TacxAdvancedFitnessMachineDevice.characteristics = ['2acc', '2ad2', '2ad6', '2ad8', '2ad9', '2ada', consts_2.TACX_FE_C_RX, consts_2.TACX_FE_C_TX];
+TacxAdvancedFitnessMachineDevice.detectionPriority = 10;
+exports.default = TacxAdvancedFitnessMachineDevice;