2017-07-10 16:07:23 +02:00
|
|
|
const enum GyroSensorMode {
|
|
|
|
None = -1,
|
|
|
|
Angle = 0,
|
|
|
|
Rate = 1,
|
|
|
|
}
|
|
|
|
|
2017-10-28 18:13:02 +02:00
|
|
|
namespace sensors {
|
2017-10-25 00:22:07 +02:00
|
|
|
//% fixedInstances
|
2017-07-10 16:07:23 +02:00
|
|
|
export class GyroSensor extends internal.UartSensor {
|
2017-10-24 20:58:52 +02:00
|
|
|
constructor(port: number) {
|
|
|
|
super(port)
|
2017-07-10 16:07:23 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
_deviceType() {
|
2017-07-11 16:18:59 +02:00
|
|
|
return DAL.DEVICE_TYPE_GYRO
|
2017-07-10 16:07:23 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
setMode(m: GyroSensorMode) {
|
|
|
|
this._setMode(m)
|
|
|
|
}
|
|
|
|
|
2017-10-24 14:30:05 +02:00
|
|
|
/**
|
|
|
|
* Get the current angle from the gyroscope.
|
2017-10-25 00:37:48 +02:00
|
|
|
* @param sensor the gyroscope to query the request
|
2017-10-24 14:30:05 +02:00
|
|
|
*/
|
|
|
|
//% help=input/gyro/angle
|
2017-12-19 20:37:33 +01:00
|
|
|
//% block="%sensor|angle"
|
2017-10-24 14:30:05 +02:00
|
|
|
//% blockId=gyroGetAngle
|
|
|
|
//% parts="gyroscope"
|
2017-10-28 18:13:02 +02:00
|
|
|
//% blockNamespace=sensors
|
2017-12-25 02:46:58 +01:00
|
|
|
//% sensor.fieldEditor="ports"
|
2017-10-25 00:22:07 +02:00
|
|
|
//% weight=65 blockGap=8
|
2017-10-25 01:52:13 +02:00
|
|
|
//% group="Gyro Sensor"
|
2017-11-30 19:34:34 +01:00
|
|
|
angle(): number {
|
2017-07-10 16:07:23 +02:00
|
|
|
this.setMode(GyroSensorMode.Angle)
|
|
|
|
return this.getNumber(NumberFormat.Int16LE, 0)
|
|
|
|
}
|
|
|
|
|
2017-10-24 14:30:05 +02:00
|
|
|
/**
|
|
|
|
* Get the current rotation rate from the gyroscope.
|
2017-10-25 00:37:48 +02:00
|
|
|
* @param sensor the gyroscope to query the request
|
2017-10-24 14:30:05 +02:00
|
|
|
*/
|
|
|
|
//% help=input/gyro/rate
|
2017-12-19 20:37:33 +01:00
|
|
|
//% block="%sensor|rotation rate"
|
2017-10-24 14:30:05 +02:00
|
|
|
//% blockId=gyroGetRate
|
|
|
|
//% parts="gyroscope"
|
2017-10-28 18:13:02 +02:00
|
|
|
//% blockNamespace=sensors
|
2017-12-25 02:46:58 +01:00
|
|
|
//% sensor.fieldEditor="ports"
|
2017-10-24 14:30:05 +02:00
|
|
|
//% weight=65 blockGap=8
|
2017-10-25 01:52:13 +02:00
|
|
|
//% group="Gyro Sensor"
|
2017-11-30 19:34:34 +01:00
|
|
|
rate(): number {
|
2017-07-10 16:07:23 +02:00
|
|
|
this.setMode(GyroSensorMode.Rate)
|
|
|
|
return this.getNumber(NumberFormat.Int16LE, 0)
|
|
|
|
}
|
|
|
|
}
|
2017-12-07 07:34:11 +01:00
|
|
|
|
2017-12-19 20:37:33 +01:00
|
|
|
//% fixedInstance whenUsed block="gyro 1" jres=icons.port1
|
2017-10-25 01:52:13 +02:00
|
|
|
export const gyro1: GyroSensor = new GyroSensor(1)
|
2017-10-24 20:58:52 +02:00
|
|
|
|
2017-12-19 20:37:33 +01:00
|
|
|
//% fixedInstance whenUsed block="gyro 2" weight=95 jres=icons.port2
|
2017-11-16 21:58:37 +01:00
|
|
|
export const gyro2: GyroSensor = new GyroSensor(2)
|
2017-12-07 07:34:11 +01:00
|
|
|
|
2017-12-19 20:37:33 +01:00
|
|
|
//% fixedInstance whenUsed block="gyro 3" jres=icons.port3
|
2017-10-24 20:58:52 +02:00
|
|
|
export const gyro3: GyroSensor = new GyroSensor(3)
|
|
|
|
|
2017-12-19 20:37:33 +01:00
|
|
|
//% fixedInstance whenUsed block="gyro 4" jres=icons.port4
|
2017-10-24 20:58:52 +02:00
|
|
|
export const gyro4: GyroSensor = new GyroSensor(4)
|
2017-07-10 16:07:23 +02:00
|
|
|
}
|