遥杆控制上下。
This commit is contained in:
@@ -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));
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user