Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void loop() {
- in_str = pulseIn(STR, HIGH, pulse_time);
- in_thr = pulseIn(THR, HIGH, pulse_time);
- in_ch3 = pulseIn(CH3, HIGH, pulse_time);
- if (in_ch3 < 1100 || in_ch3 >= 2000) out_ch3 = 0;
- if (in_ch3 == 0 || in_ch3 >= 1100 && in_ch3 < 1600) out_ch3 = 1;
- if (in_ch3 >= 1600 && in_ch3 < 2000) out_ch3 = 2;
- in_ch4 = pulseIn(CH4, HIGH, pulse_time);
- if (in_ch4 < 1100) out_ch4 = 0;
- if (in_ch4 >= 1100) out_ch4 = 1;
- if (serial == 1) {
- Serial.print("in_str: ");
- Serial.print(in_str);
- Serial.print(" out_str: ");
- Serial.println(out_str);
- Serial.print("in_thr: ");
- Serial.print(in_thr);
- Serial.print(" out_thr: ");
- Serial.println(out_thr);
- Serial.print("in_ch3: ");
- Serial.print(in_ch3);
- Serial.print(" out_ch3: ");
- Serial.println(out_ch3);
- Serial.print("in_ch4: ");
- Serial.print(in_ch4);
- Serial.print(" out_ch4: ");
- Serial.println(out_ch4);
- }
- analogWrite(FW, 255);
- //Rear Light
- if (in_thr > neut_thr - 50 && in_thr < neut_thr + 50) {
- analogWrite(RL, 255);
- start = millis(); // start czas bezczynnosci
- } else {
- analogWrite(RL, 0);
- start = 0;
- }
- //Reverse Gear
- if (in_thr >= neut_thr + 50) {
- analogWrite(RG, 255);
- } else {
- analogWrite(RG, 0);
- }
- //Fasher
- if (in_str < neut_str - 150) {
- //Right Flasher
- analogWrite(RF, 255);
- delay(400);
- analogWrite(RF, 0);
- delay(400);
- } else if (in_str > neut_str + 150) {
- //Left Flasher
- analogWrite(LF, 255);
- delay(400);
- analogWrite(LF, 0);
- delay(400);
- } else {
- analogWrite(LF, 0);
- analogWrite(RF, 0);
- }
- /*/Warning Lights - inaction
- czas = millis() - start;
- if (czas > 10000) {
- Serial.println("Warning Lights - inaction");
- analogWrite(RF, 255);
- analogWrite(LF, 255);
- delay(400);
- analogWrite(RF, 0);
- analogWrite(LF, 0);
- delay(400);
- } else {
- analogWrite(RF, 0);
- analogWrite(LF, 0);
- }*/
- //Winch
- if (out_ch3 == 1) {
- myservo.write(90);
- } else {
- //Winch In
- if (out_ch3 == 0) {
- myservo.write(82); //45
- }
- //Winch Out
- if (out_ch3 == 2) {
- myservo.write(98); //135
- }
- }
- //Ledbar
- if (out_ch4 == 1) {
- digitalWrite(LB, HIGH);
- analogWrite(FD, 255);
- } else {
- digitalWrite(LB, LOW);
- analogWrite(FD, 0);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement