415 lines
15 KiB
TypeScript
415 lines
15 KiB
TypeScript
import { Peripheral } from "noble";
|
|
|
|
import { Hub } from "./hub";
|
|
import { Port } from "./port";
|
|
|
|
import * as Consts from "./consts";
|
|
|
|
import Debug = require("debug");
|
|
const debug = Debug("lpf2hub");
|
|
|
|
|
|
/**
|
|
* @class LPF2Hub
|
|
* @extends Hub
|
|
*/
|
|
export class LPF2Hub extends Hub {
|
|
|
|
private _lastTiltX: number = 0;
|
|
private _lastTiltY: number = 0;
|
|
|
|
private _messageBuffer: Buffer = Buffer.alloc(0);
|
|
|
|
|
|
public connect () {
|
|
return new Promise(async (resolve, reject) => {
|
|
await super.connect();
|
|
const characteristic = this._getCharacteristic(Consts.BLECharacteristic.LPF2_ALL);
|
|
this._subscribeToCharacteristic(characteristic, this._parseMessage.bind(this));
|
|
setTimeout(() => {
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x01, 0x02, 0x02])); // Activate button reports
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x01, 0x03, 0x05])); // Request firmware version
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x01, 0x06, 0x02])); // Activate battery level reports
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x41, 0x3c, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01])); // Activate voltage reports
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x41, 0x3b, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01])); // Activate current reports
|
|
if (this.type === Consts.HubType.DUPLO_TRAIN_HUB) {
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x41, 0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x01]));
|
|
}
|
|
}, 1000);
|
|
return resolve();
|
|
});
|
|
}
|
|
|
|
|
|
/**
|
|
* Set the name of the Hub.
|
|
* @method LPF2Hub#setName
|
|
* @param {string} name New name of the hub (14 characters or less, ASCII only).
|
|
* @returns {Promise} Resolved upon successful issuance of command.
|
|
*/
|
|
public setName (name: string) {
|
|
if (name.length > 14) {
|
|
throw new Error("Name must be 14 characters or less");
|
|
}
|
|
return new Promise((resolve, reject) => {
|
|
let data = Buffer.from([0x01, 0x01, 0x01]);
|
|
data = Buffer.concat([data, Buffer.from(name, "ascii")]);
|
|
// Send this twice, as sometimes the first time doesn't take
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
this._name = name;
|
|
return resolve();
|
|
});
|
|
}
|
|
|
|
|
|
/**
|
|
* Set the color of the LED on the Hub via a color value.
|
|
* @method LPF2Hub#setLEDColor
|
|
* @param {Color} color
|
|
* @returns {Promise} Resolved upon successful issuance of command.
|
|
*/
|
|
public setLEDColor (color: number | boolean) {
|
|
return new Promise((resolve, reject) => {
|
|
let data = Buffer.from([0x41, 0x32, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00]);
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
if (color === false) {
|
|
color = 0;
|
|
}
|
|
data = Buffer.from([0x81, 0x32, 0x11, 0x51, 0x00, color]);
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
return resolve();
|
|
});
|
|
}
|
|
|
|
|
|
/**
|
|
* Set the color of the LED on the Hub via RGB values.
|
|
* @method LPF2Hub#setLEDRGB
|
|
* @param {number} red
|
|
* @param {number} green
|
|
* @param {number} blue
|
|
* @returns {Promise} Resolved upon successful issuance of command.
|
|
*/
|
|
public setLEDRGB (red: number, green: number, blue: number) {
|
|
return new Promise((resolve, reject) => {
|
|
let data = Buffer.from([0x41, 0x32, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00]);
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
data = Buffer.from([0x81, 0x32, 0x11, 0x51, 0x01, red, green, blue]);
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, data);
|
|
return resolve();
|
|
});
|
|
}
|
|
|
|
|
|
public sendRaw (message: Buffer) {
|
|
return new Promise((resolve, reject) => {
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, message, () => {
|
|
return resolve();
|
|
});
|
|
});
|
|
}
|
|
|
|
|
|
protected _activatePortDevice (port: number, type: number, mode: number, format: number, callback?: () => void) {
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x41, port, mode, 0x01, 0x00, 0x00, 0x00, 0x01]), callback);
|
|
}
|
|
|
|
|
|
protected _deactivatePortDevice (port: number, type: number, mode: number, format: number, callback?: () => void) {
|
|
this._writeMessage(Consts.BLECharacteristic.LPF2_ALL, Buffer.from([0x41, port, mode, 0x01, 0x00, 0x00, 0x00, 0x00]), callback);
|
|
}
|
|
|
|
|
|
protected _writeMessage (uuid: string, message: Buffer, callback?: () => void) {
|
|
const characteristic = this._getCharacteristic(uuid);
|
|
if (characteristic) {
|
|
message = Buffer.concat([Buffer.alloc(2), message]);
|
|
message[0] = message.length;
|
|
characteristic.write(message, false, callback);
|
|
}
|
|
}
|
|
|
|
|
|
private _parseMessage (data?: Buffer) {
|
|
|
|
if (data) {
|
|
this._messageBuffer = Buffer.concat([this._messageBuffer, data]);
|
|
}
|
|
|
|
if (this._messageBuffer.length <= 0) {
|
|
return;
|
|
}
|
|
|
|
const len = this._messageBuffer[0];
|
|
if (len >= this._messageBuffer.length) {
|
|
|
|
const message = this._messageBuffer.slice(0, len);
|
|
this._messageBuffer = this._messageBuffer.slice(len);
|
|
|
|
switch (message[2]) {
|
|
case 0x01: {
|
|
this._parseDeviceInfo(message);
|
|
break;
|
|
}
|
|
case 0x04: {
|
|
this._parsePortMessage(message);
|
|
break;
|
|
}
|
|
case 0x45: {
|
|
this._parseSensorMessage(message);
|
|
break;
|
|
}
|
|
case 0x82: {
|
|
this._parsePortAction(message);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (this._messageBuffer.length > 0) {
|
|
this._parseMessage();
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
|
|
private _parseDeviceInfo (data: Buffer) {
|
|
|
|
// Button press reports
|
|
if (data[3] === 0x02) {
|
|
if (data[5] === 1) {
|
|
/**
|
|
* Emits when a button is pressed.
|
|
* @event LPF2Hub#button
|
|
* @param {string} button
|
|
* @param {ButtonState} state
|
|
*/
|
|
this.emit("button", "GREEN", Consts.ButtonState.PRESSED);
|
|
return;
|
|
} else if (data[5] === 0) {
|
|
this.emit("button", "GREEN", Consts.ButtonState.RELEASED);
|
|
return;
|
|
}
|
|
|
|
// Firmware version
|
|
} else if (data[3] === 0x03) {
|
|
const build = data.readUInt16LE(5);
|
|
const bugFix = data.readUInt8(7);
|
|
const major = data.readUInt8(8) >>> 4;
|
|
const minor = data.readUInt8(8) & 0xf;
|
|
this._firmwareInfo = { major, minor, bugFix, build };
|
|
|
|
// Battery level reports
|
|
} else if (data[3] === 0x06) {
|
|
this._batteryLevel = data[5];
|
|
}
|
|
|
|
}
|
|
|
|
|
|
private _parsePortMessage (data: Buffer) {
|
|
|
|
const port = this._getPortForPortNumber(data[3]);
|
|
|
|
if (!port) {
|
|
return;
|
|
}
|
|
|
|
port.connected = (data[4] === 1 || data[4] === 2) ? true : false;
|
|
this._registerDeviceAttachment(port, data[5]);
|
|
|
|
}
|
|
|
|
|
|
private _parsePortAction (data: Buffer) {
|
|
|
|
const port = this._getPortForPortNumber(data[3]);
|
|
|
|
if (!port) {
|
|
return;
|
|
}
|
|
|
|
if (data[4] === 0x0a) {
|
|
port.busy = false;
|
|
if (port.finished) {
|
|
port.finished();
|
|
port.finished = null;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
private _padMessage (data: Buffer, len: number) {
|
|
if (data.length < len) {
|
|
data = Buffer.concat([data, Buffer.alloc(len - data.length)]);
|
|
}
|
|
return data;
|
|
}
|
|
|
|
|
|
private _parseSensorMessage (data: Buffer) {
|
|
|
|
if ((data[3] === 0x3b && this.type === Consts.HubType.POWERED_UP_REMOTE)) { // Voltage (PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const voltage = data.readUInt16LE(4) / 500;
|
|
this._voltage = Math.floor(voltage);
|
|
return;
|
|
} else if (data[3] === 0x3c && this.type === Consts.HubType.POWERED_UP_REMOTE) { // Current (PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const current = data.readUInt16LE(4) / 1000;
|
|
this._current = current;
|
|
return;
|
|
} else if (data[3] === 0x3c && this.type !== Consts.HubType.POWERED_UP_REMOTE) { // Voltage (Non-PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const voltage = data.readUInt16LE(4) / 400;
|
|
this._voltage = Math.floor(voltage);
|
|
return;
|
|
} else if (data[3] === 0x3b && this.type !== Consts.HubType.POWERED_UP_REMOTE) { // Current (Non-PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const current = data.readUInt16LE(4) / 4096;
|
|
this._current = current * 100;
|
|
return;
|
|
}
|
|
|
|
const port = this._getPortForPortNumber(data[3]);
|
|
|
|
if (!port) {
|
|
return;
|
|
}
|
|
|
|
if (port && port.connected) {
|
|
switch (port.type) {
|
|
case Consts.DeviceType.WEDO2_DISTANCE: {
|
|
let distance = data[4];
|
|
if (data[5] === 1) {
|
|
distance = data[4] + 255;
|
|
}
|
|
/**
|
|
* Emits when a distance sensor is activated.
|
|
* @event LPF2Hub#distance
|
|
* @param {string} port
|
|
* @param {number} distance Distance, in millimeters.
|
|
*/
|
|
this.emit("distance", port.id, distance * 10);
|
|
break;
|
|
}
|
|
case Consts.DeviceType.BOOST_DISTANCE: {
|
|
|
|
/**
|
|
* Emits when a color sensor is activated.
|
|
* @event LPF2Hub#color
|
|
* @param {string} port
|
|
* @param {Color} color
|
|
*/
|
|
if (data[4] <= 10) {
|
|
this.emit("color", port.id, data[4]);
|
|
}
|
|
|
|
let distance = data[5];
|
|
const partial = data[7];
|
|
|
|
if (partial > 0) {
|
|
distance += 1.0 / partial;
|
|
}
|
|
|
|
distance = Math.floor(distance * 25.4) - 20;
|
|
|
|
this.emit("distance", port.id, distance);
|
|
|
|
/**
|
|
* A combined color and distance event, emits when the sensor is activated.
|
|
* @event LPF2Hub#colorAndDistance
|
|
* @param {string} port
|
|
* @param {Color} color
|
|
* @param {number} distance Distance, in millimeters.
|
|
*/
|
|
if (data[4] <= 10) {
|
|
this.emit("colorAndDistance", port.id, data[4], distance);
|
|
}
|
|
break;
|
|
}
|
|
case Consts.DeviceType.WEDO2_TILT: {
|
|
const tiltX = data[4] > 160 ? data[4] - 255 : data[4] - (data[4] * 2);
|
|
const tiltY = data[5] > 160 ? 255 - data[5] : data[5] - (data[5] * 2);
|
|
this._lastTiltX = tiltX;
|
|
this._lastTiltY = tiltY;
|
|
/**
|
|
* Emits when a tilt sensor is activated.
|
|
* @event LPF2Hub#tilt
|
|
* @param {string} port If the event is fired from the Move Hub's in-built tilt sensor, the special port "TILT" is used.
|
|
* @param {number} x
|
|
* @param {number} y
|
|
*/
|
|
this.emit("tilt", port.id, this._lastTiltX, this._lastTiltY);
|
|
break;
|
|
}
|
|
case Consts.DeviceType.BOOST_TACHO_MOTOR: {
|
|
const rotation = data.readInt32LE(4);
|
|
/**
|
|
* Emits when a rotation sensor is activated.
|
|
* @event LPF2Hub#rotate
|
|
* @param {string} port
|
|
* @param {number} rotation
|
|
*/
|
|
this.emit("rotate", port.id, rotation);
|
|
break;
|
|
}
|
|
case Consts.DeviceType.BOOST_MOVE_HUB_MOTOR: {
|
|
const rotation = data.readInt32LE(4);
|
|
this.emit("rotate", port.id, rotation);
|
|
break;
|
|
}
|
|
case Consts.DeviceType.BOOST_TILT: {
|
|
const tiltX = data[4] > 160 ? data[4] - 255 : data[4];
|
|
const tiltY = data[5] > 160 ? 255 - data[5] : data[5] - (data[5] * 2);
|
|
this.emit("tilt", port.id, tiltX, tiltY);
|
|
break;
|
|
}
|
|
case Consts.DeviceType.POWERED_UP_REMOTE_BUTTON: {
|
|
switch (data[4]) {
|
|
case 0x01: {
|
|
this.emit("button", port.id, Consts.ButtonState.UP);
|
|
break;
|
|
}
|
|
case 0xff: {
|
|
this.emit("button", port.id, Consts.ButtonState.DOWN);
|
|
break;
|
|
}
|
|
case 0x7f: {
|
|
this.emit("button", port.id, Consts.ButtonState.STOP);
|
|
break;
|
|
}
|
|
case 0x00: {
|
|
this.emit("button", port.id, Consts.ButtonState.RELEASED);
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
case Consts.DeviceType.DUPLO_TRAIN_BASE_COLOR: {
|
|
if (data[4] <= 10) {
|
|
this.emit("color", port.id, data[4]);
|
|
}
|
|
break;
|
|
}
|
|
case Consts.DeviceType.DUPLO_TRAIN_BASE_SPEEDOMETER: {
|
|
/**
|
|
* Emits on a speed change.
|
|
* @event LPF2Hub#speed
|
|
* @param {string} port
|
|
* @param {number} speed
|
|
*/
|
|
const speed = data.readInt16LE(4);
|
|
this.emit("speed", port.id, speed);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
}
|