340 lines
11 KiB
TypeScript
340 lines
11 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
|
|
* @ignore
|
|
* @extends Hub
|
|
*/
|
|
export class LPF2Hub extends Hub {
|
|
|
|
|
|
protected _current: number = 0;
|
|
|
|
private _lastTiltX: number = 0;
|
|
private _lastTiltY: number = 0;
|
|
|
|
private _messageBuffer: Buffer = Buffer.alloc(0);
|
|
|
|
|
|
/**
|
|
* @readonly
|
|
* @property {number} current Current usage of the hub (Amps)
|
|
*/
|
|
public get current () {
|
|
return this._current;
|
|
}
|
|
|
|
|
|
public connect () {
|
|
return new Promise(async (resolve, reject) => {
|
|
await super.connect();
|
|
const characteristic = this._characteristics[Consts.BLECharacteristics.LPF2_ALL];
|
|
this._subscribeToCharacteristic(characteristic, this._parseMessage.bind(this));
|
|
this._writeMessage(Consts.BLECharacteristics.LPF2_ALL, Buffer.from([0x01, 0x02, 0x02])); // Activate button reports
|
|
this._writeMessage(Consts.BLECharacteristics.LPF2_ALL, Buffer.from([0x41, 0x3b, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01])); // Activate current reports
|
|
this._writeMessage(Consts.BLECharacteristics.LPF2_ALL, Buffer.from([0x41, 0x3c, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01])); // Activate voltage reports
|
|
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.BLECharacteristics.LPF2_ALL, data);
|
|
this._writeMessage(Consts.BLECharacteristics.LPF2_ALL, data);
|
|
this._name = name;
|
|
return resolve();
|
|
});
|
|
}
|
|
|
|
|
|
protected _activatePortDevice (port: number, type: number, mode: number, format: number, callback?: () => void) {
|
|
this._writeMessage(Consts.BLECharacteristics.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.BLECharacteristics.LPF2_ALL, Buffer.from([0x41, port, mode, 0x01, 0x00, 0x00, 0x00, 0x00]), callback);
|
|
}
|
|
|
|
|
|
protected _writeMessage (uuid: string, message: Buffer, callback?: () => void) {
|
|
const characteristic = this._characteristics[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) {
|
|
|
|
if (data[3] === 2) {
|
|
if (data[5] === 1) {
|
|
/**
|
|
* Emits when a button is pressed.
|
|
* @event LPF2Hub#button
|
|
* @param {string} button
|
|
* @param {number} state A number representing one of the button state consts.
|
|
*/
|
|
this.emit("button", "GREEN", Consts.ButtonStates.PRESSED);
|
|
return;
|
|
} else if (data[5] === 0) {
|
|
this.emit("button", "GREEN", Consts.ButtonStates.RELEASED);
|
|
return;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
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.Hubs.POWERED_UP_REMOTE) || (data[3] === 0x3c && this.type !== Consts.Hubs.POWERED_UP_REMOTE)) { // Voltage
|
|
data = this._padMessage(data, 6);
|
|
const batteryLevel = (data.readUInt16LE(4) / 4096) * 100;
|
|
this._batteryLevel = Math.floor(batteryLevel);
|
|
return;
|
|
} else if (data[3] === 0x3b && this.type !== Consts.Hubs.POWERED_UP_REMOTE) { // Current (Non-PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const current = data.readUInt16LE(4) / 4096;
|
|
this._current = current;
|
|
return;
|
|
} else if (data[3] === 0x3c) { // Current (PUP Remote)
|
|
data = this._padMessage(data, 6);
|
|
const current = data.readUInt16LE(4) / 1000;
|
|
this._current = current;
|
|
return;
|
|
}
|
|
|
|
const port = this._getPortForPortNumber(data[3]);
|
|
|
|
if (!port) {
|
|
return;
|
|
}
|
|
|
|
if (port && port.connected) {
|
|
switch (port.type) {
|
|
case Consts.Devices.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.Devices.BOOST_DISTANCE:
|
|
{
|
|
|
|
/**
|
|
* Emits when a color sensor is activated.
|
|
* @event LPF2Hub#color
|
|
* @param {string} port
|
|
* @param {number} color A number representing one of the LED color consts.
|
|
*/
|
|
if (data[4] <= 10) {
|
|
this.emit("color", port.id, data[4]);
|
|
}
|
|
|
|
let distance = data[5];
|
|
const partial = data[7];
|
|
|
|
if (partial > 0) {
|
|
distance += 1 / partial;
|
|
}
|
|
|
|
this.emit("distance", port.id, Math.floor(distance * 25.4) - 20);
|
|
break;
|
|
}
|
|
case Consts.Devices.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.Devices.BOOST_TACHO_MOTOR:
|
|
{
|
|
const rotation = data.readInt32LE(2);
|
|
/**
|
|
* 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.Devices.BOOST_MOVE_HUB_MOTOR:
|
|
{
|
|
const rotation = data.readInt32LE(2);
|
|
this.emit("rotate", port.id, rotation);
|
|
break;
|
|
}
|
|
case Consts.Devices.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.Devices.POWERED_UP_REMOTE_BUTTON:
|
|
{
|
|
switch (data[4]) {
|
|
case 0x01:
|
|
{
|
|
this.emit("button", port.id, Consts.ButtonStates.UP);
|
|
break;
|
|
}
|
|
case 0xff:
|
|
{
|
|
this.emit("button", port.id, Consts.ButtonStates.DOWN);
|
|
break;
|
|
}
|
|
case 0x7f:
|
|
{
|
|
this.emit("button", port.id, Consts.ButtonStates.STOP);
|
|
break;
|
|
}
|
|
case 0x00:
|
|
{
|
|
this.emit("button", port.id, Consts.ButtonStates.RELEASED);
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
}
|