Lino/RoboterArm
1
0
Fork 0
mirror of https://github.com/LinoSchmidt/RoboterArm.git synced 2026-03-21 02:31:16 +01:00
Code Issues Packages Projects Releases Wiki Activity

jstick avarage verbessert

Browse Source
This commit is contained in:
LinoSchmidt
2022-01-15 11:09:09 +01:00
parent 7fd17ecb74
commit 22a5796b38
1 changed files with 25 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files

65
Firmware 2.0/src/main.cpp
View File

@@ -47,6 +47,7 @@
#define TimeToDetach 80 #define TimeToDetach 80
#define Calibration_TimeToMiddle 3000 #define Calibration_TimeToMiddle 3000
#define Calibration_messureTime 5 #define Calibration_messureTime 5
#define Calibration_messureCount 10
//Buzzer //Buzzer
#define BuzzerPin 7 #define BuzzerPin 7
@@ -97,55 +98,39 @@ void calibrate(){
Serial.print("Get Middle Positions: "); Serial.print("Get Middle Positions: ");
int joystick_LX_middle_r1 = analogRead(joystick_LX_Pin); int joystick_LX_middle_av = 0;
delay(Calibration_messureTime); for(int i = Calibration_messureCount; i > 0; i--){
int joystick_LX_middle_r2 = analogRead(joystick_LX_Pin); joystick_LX_middle_av += analogRead(joystick_LX_Pin);
delay(Calibration_messureTime); delay(Calibration_messureTime);
int joystick_LX_middle_r3 = analogRead(joystick_LX_Pin); }
delay(Calibration_messureTime); joystick_LX_middle_av = joystick_LX_middle_av / Calibration_messureCount;
int joystick_LX_middle_r4 = analogRead(joystick_LX_Pin);
delay(Calibration_messureTime);
int joystick_LX_middle_r5 = analogRead(joystick_LX_Pin);
int joystick_LX_middle_av = (joystick_LX_middle_r1 + joystick_LX_middle_r2 + joystick_LX_middle_r3 + joystick_LX_middle_r4 + joystick_LX_middle_r5) / 5;
Serial.print("LX:" + String(joystick_LX_middle_av)); Serial.print("LX:" + String(joystick_LX_middle_av));
int joystick_LY_middle_r1 = analogRead(joystick_LY_Pin); int joystick_LY_middle_av = 0;
delay(Calibration_messureTime); for(int i = Calibration_messureCount; i > 0; i--){
int joystick_LY_middle_r2 = analogRead(joystick_LY_Pin); joystick_LY_middle_av += analogRead(joystick_LY_Pin);
delay(Calibration_messureTime); delay(Calibration_messureTime);
int joystick_LY_middle_r3 = analogRead(joystick_LY_Pin); }
delay(Calibration_messureTime); joystick_LY_middle_av = joystick_LY_middle_av / Calibration_messureCount;
int joystick_LY_middle_r4 = analogRead(joystick_LY_Pin);
delay(Calibration_messureTime);
int joystick_LY_middle_r5 = analogRead(joystick_LY_Pin);
int joystick_LY_middle_av = (joystick_LY_middle_r1 + joystick_LY_middle_r2 + joystick_LY_middle_r3 + joystick_LY_middle_r4 + joystick_LY_middle_r5) / 5;
Serial.print(" LY:" + String(joystick_LY_middle_av)); Serial.print(" LY:" + String(joystick_LY_middle_av));
int joystick_RX_middle_r1 = analogRead(joystick_RX_Pin); int joystick_RX_middle_av = 0;
delay(Calibration_messureTime); for(int i = Calibration_messureCount; i > 0; i--){
int joystick_RX_middle_r2 = analogRead(joystick_RX_Pin); joystick_RX_middle_av += analogRead(joystick_RX_Pin);
delay(Calibration_messureTime); delay(Calibration_messureTime);
int joystick_RX_middle_r3 = analogRead(joystick_RX_Pin); }
delay(Calibration_messureTime); joystick_RX_middle_av = joystick_RX_middle_av / Calibration_messureCount;
int joystick_RX_middle_r4 = analogRead(joystick_RX_Pin);
delay(Calibration_messureTime);
int joystick_RX_middle_r5 = analogRead(joystick_RX_Pin);
int joystick_RX_middle_av = (joystick_RX_middle_r1 + joystick_RX_middle_r2 + joystick_RX_middle_r3 + joystick_RX_middle_r4 + joystick_RX_middle_r5) / 5;
Serial.print(" RX:" + String(joystick_RX_middle_av)); Serial.print(" RX:" + String(joystick_RX_middle_av));
int joystick_RY_middle_r1 = analogRead(joystick_RY_Pin); int joystick_RY_middle_av = 0;
delay(Calibration_messureTime); for(int i = Calibration_messureCount; i > 0; i--){
int joystick_RY_middle_r2 = analogRead(joystick_RY_Pin); joystick_RY_middle_av += analogRead(joystick_RY_Pin);
delay(Calibration_messureTime); delay(Calibration_messureTime);
int joystick_RY_middle_r3 = analogRead(joystick_RY_Pin); }
delay(Calibration_messureTime); joystick_RY_middle_av = joystick_RY_middle_av / Calibration_messureCount;
int joystick_RY_middle_r4 = analogRead(joystick_RY_Pin);
delay(Calibration_messureTime);
int joystick_RY_middle_r5 = analogRead(joystick_RY_Pin);
int joystick_RY_middle_av = (joystick_RY_middle_r1 + joystick_RY_middle_r2 + joystick_RY_middle_r3 + joystick_RY_middle_r4 + joystick_RY_middle_r5) / 5;
Serial.println(" RY:" + String(joystick_RY_middle_av)); Serial.println(" RY:" + String(joystick_RY_middle_av));