pxt-ev3/libs/core/ir.ts

287 lines
9.4 KiB
TypeScript
Raw Normal View History

2017-07-10 12:37:14 +02:00
const enum IrSensorMode {
None = -1,
Proximity = 0,
Seek = 1,
RemoteControl = 2,
}
const enum IrRemoteChannel {
Ch0 = 0, // top
Ch1 = 1,
Ch2 = 2,
Ch3 = 3,
}
const enum IrRemoteButton {
None = 0x00,
CenterBeacon = 0x01,
TopLeft = 0x02,
BottomLeft = 0x04,
TopRight = 0x08,
BottomRight = 0x10,
}
2017-10-28 18:13:02 +02:00
namespace sensors {
2017-07-10 12:37:14 +02:00
function mapButton(v: number) {
switch (v) {
case 0: return IrRemoteButton.None
case 1: return IrRemoteButton.TopLeft
case 2: return IrRemoteButton.BottomLeft
case 3: return IrRemoteButton.TopRight
case 4: return IrRemoteButton.TopRight | IrRemoteButton.BottomRight
case 5: return IrRemoteButton.TopLeft | IrRemoteButton.TopRight
case 6: return IrRemoteButton.TopLeft | IrRemoteButton.BottomRight
case 7: return IrRemoteButton.BottomLeft | IrRemoteButton.TopRight
case 8: return IrRemoteButton.BottomLeft | IrRemoteButton.BottomRight
case 9: return IrRemoteButton.CenterBeacon
case 10: return IrRemoteButton.BottomLeft | IrRemoteButton.TopLeft
case 11: return IrRemoteButton.TopRight | IrRemoteButton.BottomRight
default: return IrRemoteButton.None
}
}
2017-10-27 06:10:37 +02:00
let buttons: RemoteInfraredBeaconButton[]
2017-10-24 20:58:52 +02:00
2017-10-27 05:20:24 +02:00
function create(ir: InfraredSensor) {
2017-10-24 20:58:52 +02:00
// it's created by referencing it
}
2017-10-27 06:10:37 +02:00
export function irButton(id: IrRemoteButton): RemoteInfraredBeaconButton {
2017-10-24 20:58:52 +02:00
if (buttons == null) {
buttons = []
for (let i = 0; i < 5; ++i) {
2017-10-28 18:13:02 +02:00
buttons.push(new RemoteInfraredBeaconButton(new brick.Button()))
2017-10-24 20:58:52 +02:00
}
// make sure sensors are up
2017-10-27 05:51:13 +02:00
create(infraredSensor1)
create(infraredSensor2)
create(infraredSensor3)
create(infraredSensor4)
2017-10-24 20:58:52 +02:00
}
let num = -1
while (id) {
id >>= 1;
num++;
}
num = Math.clamp(0, buttons.length - 1, num)
return buttons[num]
}
2017-10-27 06:10:37 +02:00
//% fixedInstances
export class RemoteInfraredBeaconButton extends control.Component {
2017-10-28 18:13:02 +02:00
private button: brick.Button;
constructor(button: brick.Button) {
2017-10-27 06:10:37 +02:00
super();
this.button = button;
}
_update(curr: boolean) {
this.button._update(curr);
}
/**
* Check if a remote button is currently pressed or not.
* @param button the remote button to query the request
*/
//% help=input/remote-infrared-beacon/is-pressed
//% block="%button|is pressed"
//% blockId=remoteButtonIsPressed
//% parts="remote"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-27 06:10:37 +02:00
//% weight=81 blockGap=8
//% group="Remote Infrared Beacon"
isPressed() {
return this.button.isPressed();
}
/**
* See if the remote button was pressed again since the last time you checked.
* @param button the remote button to query the request
*/
//% help=input/remote-infrared-beacon/was-pressed
//% block="%button|was pressed"
//% blockId=remotebuttonWasPressed
//% parts="remote"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-27 06:10:37 +02:00
//% weight=80 blockGap=8
//% group="Remote Infrared Beacon"
wasPressed() {
return this.button.wasPressed();
}
/**
* Do something when a button or sensor is clicked, up or down
* @param button the button that needs to be clicked or used
* @param event the kind of button gesture that needs to be detected
* @param body code to run when the event is raised
*/
//% help=input/remote-infrared-beacon/on-event
//% blockId=remotebuttonEvent block="on %button|%event"
//% parts="remote"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-27 06:10:37 +02:00
//% weight=99 blockGap=8
//% group="Remote Infrared Beacon"
onEvent(ev: ButtonEvent, body: () => void) {
this.button.onEvent(ev, body);
}
}
2017-10-27 05:51:13 +02:00
2017-10-27 05:20:24 +02:00
//% fixedInstances
export class InfraredSensor extends internal.UartSensor {
2017-10-27 05:51:13 +02:00
private channel: IrRemoteChannel;
private proximityThreshold: number;
2017-07-10 12:37:14 +02:00
2017-10-24 20:58:52 +02:00
constructor(port: number) {
super(port)
2017-07-10 12:37:14 +02:00
this.channel = IrRemoteChannel.Ch0
2017-10-27 05:51:13 +02:00
this.proximityThreshold = 10;
2017-10-24 20:58:52 +02:00
irButton(0) // make sure buttons array is initalized
2017-07-10 12:37:14 +02:00
2017-10-24 20:58:52 +02:00
// and set the mode, as otherwise button events won't work
2017-10-27 05:51:13 +02:00
this.mode = IrSensorMode.RemoteControl;
2017-07-10 12:37:14 +02:00
}
_query() {
if (this.mode == IrSensorMode.RemoteControl)
2017-10-27 05:51:13 +02:00
return mapButton(this.getNumber(NumberFormat.UInt8LE, this.channel));
else if (this.mode == IrSensorMode.Proximity) {
const d = this.getNumber(NumberFormat.UInt16LE, 0) & 0x0fff;
return d < this.proximityThreshold ? PromixityEvent.ObjectNear
: d > this.proximityThreshold + 5 ? PromixityEvent.ObjectDetected
: 0;
}
2017-07-10 12:37:14 +02:00
return 0
}
_update(prev: number, curr: number) {
2017-10-27 05:51:13 +02:00
if (this.mode == IrSensorMode.RemoteControl) {
for (let i = 0; i < buttons.length; ++i) {
let v = !!(curr & (1 << i))
2017-10-27 06:10:37 +02:00
buttons[i]._update(v)
2017-10-27 05:51:13 +02:00
}
} else {
if (curr)
control.raiseEvent(this._id, curr);
2017-07-10 12:37:14 +02:00
}
}
2017-07-10 13:47:00 +02:00
_deviceType() {
return DAL.DEVICE_TYPE_IR
2017-07-10 13:47:00 +02:00
}
2017-07-10 12:37:14 +02:00
setRemoteChannel(c: IrRemoteChannel) {
c = Math.clamp(0, 3, c | 0)
this.channel = c
2017-10-27 05:51:13 +02:00
this._setMode(IrSensorMode.RemoteControl)
2017-07-10 12:37:14 +02:00
}
2017-10-27 05:51:13 +02:00
_setMode(m: IrSensorMode) {
2017-07-10 12:37:14 +02:00
this._setMode(m)
}
2017-10-27 05:51:13 +02:00
/**
2017-10-27 05:57:18 +02:00
* Registers code to run when an object is getting near.
2017-10-27 05:51:13 +02:00
* @param handler the code to run when detected
*/
//% help=input/infrared/on-object-near
2017-10-27 05:57:18 +02:00
//% block="on %sensor|object near"
2017-10-27 05:51:13 +02:00
//% blockId=infraredOnObjectNear
//% parts="infraredsensor"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-27 05:51:13 +02:00
//% weight=100 blockGap=8
//% group="Infrared Sensor"
2017-10-27 05:57:18 +02:00
onObjectNear(handler: () => void) {
2017-10-27 05:51:13 +02:00
control.onEvent(this._id, PromixityEvent.ObjectNear, handler);
if (this.proximity() == PromixityEvent.ObjectNear)
control.runInBackground(handler);
}
2017-10-27 05:57:18 +02:00
setObjectNearThreshold(distance: number) {
this.proximityThreshold = Math.max(1, Math.min(95, distance));
}
2017-10-27 05:51:13 +02:00
2017-10-24 14:30:05 +02:00
/**
2017-10-27 05:20:24 +02:00
* Get the promixity measured by the infrared sensor, from ``0`` (close) to ``100`` (far)
2017-10-24 14:30:05 +02:00
* @param ir the infrared sensor
*/
2017-10-27 05:20:24 +02:00
//% help=input/infrared/proximity
//% block="%infrared|proximity"
//% blockId=infraredGetProximity
2017-10-24 14:30:05 +02:00
//% parts="infrared"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-25 00:33:28 +02:00
//% weight=65 blockGap=8
//% group="Infrared Sensor"
2017-10-27 05:20:24 +02:00
proximity() {
2017-10-27 05:51:13 +02:00
this._setMode(IrSensorMode.Proximity)
2017-07-10 12:37:14 +02:00
return this.getNumber(NumberFormat.UInt8LE, 0)
}
2017-10-24 14:30:05 +02:00
/**
* Get the remote commandreceived the infrared sensor.
* @param ir the infrared sensor
*/
//% help=input/infrared/remote-command
//% block="%infrared|remote command"
//% blockId=infraredGetRemoteCommand
//% parts="infrared"
2017-10-28 18:13:02 +02:00
//% blockNamespace=sensors
2017-10-24 14:30:05 +02:00
//% weight=65 blockGap=8
//% group="Infrared Sensor"
2017-10-24 14:30:05 +02:00
remoteCommand() {
2017-10-27 05:51:13 +02:00
this._setMode(IrSensorMode.RemoteControl)
2017-07-10 12:37:14 +02:00
return this.getNumber(NumberFormat.UInt8LE, this.channel)
}
2017-10-24 14:30:05 +02:00
// TODO
2017-07-10 12:37:14 +02:00
getDirectionAndDistance() {
2017-10-27 05:51:13 +02:00
this._setMode(IrSensorMode.Seek)
2017-07-10 12:37:14 +02:00
return this.getNumber(NumberFormat.UInt16LE, this.channel * 2)
}
}
2017-10-27 05:51:13 +02:00
//% fixedInstance whenUsed block="infrared sensor 1"
export const infraredSensor1: InfraredSensor = new InfraredSensor(1)
2017-10-24 20:58:52 +02:00
2017-10-27 05:51:13 +02:00
//% fixedInstance whenUsed block="infrared sensor 2"
export const infraredSensor2: InfraredSensor = new InfraredSensor(2)
2017-10-24 20:58:52 +02:00
2017-10-27 05:51:13 +02:00
//% fixedInstance whenUsed block="infrared sensor 3"
export const infraredSensor3: InfraredSensor = new InfraredSensor(3)
2017-10-24 20:58:52 +02:00
2017-10-27 05:51:13 +02:00
//% fixedInstance whenUsed block="infrared sensor 4"
export const infraredSensor4: InfraredSensor = new InfraredSensor(4)
2017-07-10 15:26:19 +02:00
2017-10-27 06:10:37 +02:00
/**
* Remote beacon (center) button.
*/
//% whenUsed block="remote button center" weight=95 fixedInstance
export const remoteButtonCenter = irButton(IrRemoteButton.CenterBeacon)
2017-07-10 15:26:19 +02:00
/**
* Remote top-left button.
*/
2017-10-27 06:10:37 +02:00
//% whenUsed block="remote button top-left" weight=95 fixedInstance
export const remoteButtonTopLeft = irButton(IrRemoteButton.TopLeft)
2017-07-10 15:26:19 +02:00
/**
* Remote top-right button.
*/
2017-10-27 06:10:37 +02:00
//% whenUsed block="remote button top-right" weight=95 fixedInstance
export const remoteButtonTopRight = irButton(IrRemoteButton.TopRight)
2017-07-10 15:26:19 +02:00
/**
* Remote bottom-left button.
*/
2017-10-27 06:10:37 +02:00
//% whenUsed block="remote button bottom-left" weight=95 fixedInstance
export const remoteButtonBottomLeft = irButton(IrRemoteButton.BottomLeft)
2017-07-10 15:26:19 +02:00
/**
* Remote bottom-right button.
*/
2017-10-27 06:10:37 +02:00
//% whenUsed block="remote button bottom-right" weight=95 fixedInstance
export const remoteButtonBottomRight = irButton(IrRemoteButton.BottomRight)
2017-07-10 12:37:14 +02:00
}