83 lines
2.8 KiB
TypeScript
83 lines
2.8 KiB
TypeScript
enum UltrasonicEvent {
|
|
ObjectClose = 1,
|
|
ObjectDetected = 2
|
|
}
|
|
|
|
namespace input {
|
|
|
|
//% fixedInstances
|
|
export class UltraSonicSensor extends internal.UartSensor {
|
|
private threshold: number;
|
|
|
|
constructor(port: number) {
|
|
super(port)
|
|
this.threshold = 10;
|
|
}
|
|
|
|
_deviceType() {
|
|
return DAL.DEVICE_TYPE_ULTRASONIC
|
|
}
|
|
|
|
_query(): number {
|
|
const d = this.getNumber(NumberFormat.UInt16LE, 0) & 0x0fff;
|
|
return d < this.threshold ? UltrasonicEvent.ObjectClose
|
|
: d > this.threshold + 5 ? UltrasonicEvent.ObjectDetected
|
|
: 0;
|
|
}
|
|
|
|
_update(prev: number, curr: number) {
|
|
if (curr)
|
|
control.raiseEvent(this._id, curr);
|
|
}
|
|
|
|
/**
|
|
* Registers code to run when the given color is close
|
|
* @param distance the distance in centimeters when an object is close, eg: 10
|
|
* @param handler the code to run when detected
|
|
*/
|
|
//% help=input/ultrasonic/on-object
|
|
//% block="on %sensor|object within %distance|cm"
|
|
//% blockId=ultrasonicOnObjectClose
|
|
//% parts="ultrasonicsensor"
|
|
//% blockNamespace=input
|
|
//% weight=100 blockGap=8
|
|
//% group="Ultrasonic Sensor"
|
|
onObject(distance: number, handler: () => void) {
|
|
this.threshold = Math.max(1, Math.min(95, distance));
|
|
control.onEvent(this._id, UltrasonicEvent.ObjectClose, handler);
|
|
this._setMode(0)
|
|
if (this._query() == UltrasonicEvent.ObjectClose)
|
|
control.runInBackground(handler);
|
|
}
|
|
|
|
/**
|
|
* Gets the distance from the sonar in millimeters
|
|
* @param sensor the ultrasonic sensor port
|
|
*/
|
|
//% help=input/ultrasonic/distance
|
|
//% block="%sensor|distance"
|
|
//% blockId=sonarGetDistance
|
|
//% parts="ultrasonic"
|
|
//% blockNamespace=input
|
|
//% weight=65 blockGap=8
|
|
//% group="Ultrasonic Sensor"
|
|
distance() {
|
|
// it supposedly also has an inch mode, but we stick to mm
|
|
this._setMode(0)
|
|
return this.getNumber(NumberFormat.UInt16LE, 0) & 0x0fff;
|
|
}
|
|
}
|
|
|
|
//% fixedInstance whenUsed block="ultrasonic sensor 4"
|
|
export const ultrasonic4: UltraSonicSensor = new UltraSonicSensor(4)
|
|
|
|
//% fixedInstance whenUsed block="ultrasonic sensor 1"
|
|
export const ultrasonic1: UltraSonicSensor = new UltraSonicSensor(1)
|
|
|
|
//% fixedInstance whenUsed block="ultrasonic sensor 2"
|
|
export const ultrasonic2: UltraSonicSensor = new UltraSonicSensor(2)
|
|
|
|
//% fixedInstance whenUsed block="ultrasonic sensor 3"
|
|
export const ultrasonic3: UltraSonicSensor = new UltraSonicSensor(3)
|
|
}
|