fix left right to 0
This commit is contained in:
parent
ddb532134f
commit
27e31bda76
|
|
@ -1,6 +1,6 @@
|
||||||
# mbit
|
# mbit
|
||||||
|
|
||||||
Extension for Yahboom zh_tr mbit
|
Extension for Yahboom_mbit_en V3.0.2
|
||||||
|
|
||||||
## License
|
## License
|
||||||
|
|
||||||
|
|
|
||||||
55
main.ts
55
main.ts
|
|
@ -610,15 +610,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, speed1);
|
setPwm(12, 0, speed1);
|
||||||
setPwm(13, 0, 0);
|
setPwm(13, 0, 0);
|
||||||
|
|
@ -639,16 +633,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, 0);
|
setPwm(12, 0, 0);
|
||||||
setPwm(13, 0, speed1);
|
setPwm(13, 0, speed1);
|
||||||
|
|
||||||
|
|
@ -669,15 +656,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, speed1);
|
setPwm(12, 0, speed1);
|
||||||
setPwm(13, 0, 0);
|
setPwm(13, 0, 0);
|
||||||
|
|
@ -699,15 +680,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, speed1);
|
setPwm(12, 0, speed1);
|
||||||
setPwm(13, 0, 0);
|
setPwm(13, 0, 0);
|
||||||
|
|
@ -741,15 +716,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, 0);
|
setPwm(12, 0, 0);
|
||||||
setPwm(13, 0, speed1);
|
setPwm(13, 0, speed1);
|
||||||
|
|
@ -771,16 +740,9 @@ namespace mbit_Robot {
|
||||||
if (speed1 >= 4096) {
|
if (speed1 >= 4096) {
|
||||||
speed1 = 4095
|
speed1 = 4095
|
||||||
}
|
}
|
||||||
if (speed1 <= 350) {
|
|
||||||
speed1 = 350
|
|
||||||
}
|
|
||||||
if (speed2 >= 4096) {
|
if (speed2 >= 4096) {
|
||||||
speed2 = 4095
|
speed2 = 4095
|
||||||
}
|
}
|
||||||
if (speed2 <= 350) {
|
|
||||||
speed2 = 350
|
|
||||||
}
|
|
||||||
|
|
||||||
setPwm(12, 0, speed1);
|
setPwm(12, 0, speed1);
|
||||||
setPwm(13, 0, 0);
|
setPwm(13, 0, 0);
|
||||||
|
|
||||||
|
|
@ -903,6 +865,8 @@ namespace mbit_Robot {
|
||||||
export function Ultrasonic_Car(): number {
|
export function Ultrasonic_Car(): number {
|
||||||
|
|
||||||
// send pulse
|
// send pulse
|
||||||
|
let list:Array<number> = [0, 0, 0, 0, 0];
|
||||||
|
for (let i = 0; i < 5; i++) {
|
||||||
pins.setPull(DigitalPin.P14, PinPullMode.PullNone);
|
pins.setPull(DigitalPin.P14, PinPullMode.PullNone);
|
||||||
pins.digitalWritePin(DigitalPin.P14, 0);
|
pins.digitalWritePin(DigitalPin.P14, 0);
|
||||||
control.waitMicros(2);
|
control.waitMicros(2);
|
||||||
|
|
@ -910,9 +874,12 @@ namespace mbit_Robot {
|
||||||
control.waitMicros(15);
|
control.waitMicros(15);
|
||||||
pins.digitalWritePin(DigitalPin.P14, 0);
|
pins.digitalWritePin(DigitalPin.P14, 0);
|
||||||
|
|
||||||
// read pulse
|
|
||||||
let d = pins.pulseIn(DigitalPin.P15, PulseValue.High, 43200);
|
let d = pins.pulseIn(DigitalPin.P15, PulseValue.High, 43200);
|
||||||
return Math.floor(d / 58);
|
list[i] = Math.floor(d / 40)
|
||||||
|
}
|
||||||
|
list.sort();
|
||||||
|
let length = (list[1] + list[2] + list[3])/3;
|
||||||
|
return Math.floor(length);
|
||||||
}
|
}
|
||||||
|
|
||||||
//% blockId=mbit_Music_Car block="Music_Car|%index"
|
//% blockId=mbit_Music_Car block="Music_Car|%index"
|
||||||
|
|
@ -1070,8 +1037,8 @@ namespace mbit_Robot {
|
||||||
switch (index) {
|
switch (index) {
|
||||||
case CarState.Car_Run: Car_run(speed, speed); break;
|
case CarState.Car_Run: Car_run(speed, speed); break;
|
||||||
case CarState.Car_Back: Car_back(speed, speed); break;
|
case CarState.Car_Back: Car_back(speed, speed); break;
|
||||||
case CarState.Car_Left: Car_left(speed, speed); break;
|
case CarState.Car_Left: Car_left(0, speed); break;
|
||||||
case CarState.Car_Right: Car_right(speed, speed); break;
|
case CarState.Car_Right: Car_right(speed, 0); break;
|
||||||
case CarState.Car_Stop: Car_stop(); break;
|
case CarState.Car_Stop: Car_stop(); break;
|
||||||
case CarState.Car_SpinLeft: Car_spinleft(speed, speed); break;
|
case CarState.Car_SpinLeft: Car_spinleft(speed, speed); break;
|
||||||
case CarState.Car_SpinRight: Car_spinright(speed, speed); break;
|
case CarState.Car_SpinRight: Car_spinright(speed, speed); break;
|
||||||
|
|
@ -1087,8 +1054,8 @@ namespace mbit_Robot {
|
||||||
switch (index) {
|
switch (index) {
|
||||||
case CarState.Car_Run: Car_run(speed1, speed2); break;
|
case CarState.Car_Run: Car_run(speed1, speed2); break;
|
||||||
case CarState.Car_Back: Car_back(speed1, speed2); break;
|
case CarState.Car_Back: Car_back(speed1, speed2); break;
|
||||||
case CarState.Car_Left: Car_left(speed1, speed2); break;
|
case CarState.Car_Left: Car_left(0, speed2); break;
|
||||||
case CarState.Car_Right: Car_right(speed1, speed2); break;
|
case CarState.Car_Right: Car_right(speed1, 0); break;
|
||||||
case CarState.Car_Stop: Car_stop(); break;
|
case CarState.Car_Stop: Car_stop(); break;
|
||||||
case CarState.Car_SpinLeft: Car_spinleft(speed1, speed2); break;
|
case CarState.Car_SpinLeft: Car_spinleft(speed1, speed2); break;
|
||||||
case CarState.Car_SpinRight: Car_spinright(speed1, speed2); break;
|
case CarState.Car_SpinRight: Car_spinright(speed1, speed2); break;
|
||||||
|
|
|
||||||
4
pxt.json
4
pxt.json
|
|
@ -1,7 +1,7 @@
|
||||||
{
|
{
|
||||||
"name": "mbit",
|
"name": "mbit",
|
||||||
"version": "3.0.1",
|
"version": "3.0.2",
|
||||||
"description": "Extension for YahBoom m:bit V3.0.1",
|
"description": "Extension for YahBoom m:bit V3.0.2",
|
||||||
"license": "MIT",
|
"license": "MIT",
|
||||||
"dependencies": {
|
"dependencies": {
|
||||||
"core": "*",
|
"core": "*",
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue