遥杆控制上下。

This commit is contained in:
unlockable
2023-09-08 17:54:05 +08:00
parent 3ec8c3d570
commit 94b2ce4416

View File

@@ -949,6 +949,17 @@ void calculate_and_draw() {
waiting_for_command = false;
}
if (analogRead(JOYSTICK_VRX) < 50) {
z_offset -= 1;
need_reevaluate = true;
waiting_for_command = false;
}
else if (analogRead(JOYSTICK_VRX) > 974) {
z_offset += 1;
need_reevaluate = true;
waiting_for_command = false;
}
if (abs(SensorReader::acceleration.x) +
abs(SensorReader::acceleration.y) +
abs(SensorReader::acceleration.z) >
@@ -983,9 +994,10 @@ void calculate_and_draw() {
Serial.println(SensorReader::angle.z);
}
if (abs(SensorReader::angle.x) < 30.0 &&
abs(SensorReader::angle.y) < 30.0 &&
abs(SensorReader::angle.z - z_ref) < 30.0) {
if (abs(SensorReader::angle.x) < 20.0 &&
abs(SensorReader::angle.y) < 20.0 &&
abs(SensorReader::angle.z - z_ref) < 20.0 &&
analogRead(JOYSTICK_VRX) > 400 && analogRead(JOYSTICK_VRX) < 648) {
waiting_for_command = true;
Serial.println("Waiting for new command");
}
@@ -1035,9 +1047,9 @@ void calculate_and_draw() {
// Display origin point
Cube::set_status(round(-x_offset), round(-y_offset),
round(-z_offset), 3);
round(z_offset), 3);
Cube::set_blinking(round(-x_offset), round(-y_offset),
round(-z_offset));
round(z_offset));
}
}
}