-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathGowinTestScript.ino
65 lines (55 loc) · 2.84 KB
/
GowinTestScript.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
// PIN Define
#define EncoderTickPin 2
#define EncoderDirPin 8
#define PositionTrig 10
#define Dashboard_Button1 11
#define Dashboard_Button2 12
#define Dashboard_Button3 A0
#define Motor_PWM 9
LiquidCrystal_I2C lcd(0x27,16,2);
void setup() {
// initialize digital pin LED_BUILTIN as an output.
//pinMode(LED_BUILTIN, OUTPUT);
//INITIALIZATION
pinMode(EncoderTickPin, INPUT_PULLUP);
pinMode(EncoderDirPin, INPUT_PULLUP);
pinMode(PositionTrig, INPUT);
pinMode(Dashboard_Button1, INPUT_PULLUP);
pinMode(Dashboard_Button2, INPUT_PULLUP);
pinMode(Dashboard_Button3, INPUT_PULLUP);
pinMode(Motor_PWM, OUTPUT);
lcd.init(); // initialize the lcd
lcd.init();
// Print a message to the LCD.
lcd.backlight();
lcd.setCursor(0,0);
lcd.print("Jancuk");
attachInterrupt(digitalPinToInterrupt(EncoderTickPin),encoderTick,FALLING);
Serial.begin(9600);
}
// the loop function runs over and over again forever
void loop() {
Serial.print("Pos:");Serial.print(digitalRead(PositionTrig));Serial.print(" ");
Serial.print("DB1:");Serial.print(digitalRead(Dashboard_Button1));Serial.print(" ");
Serial.print("DB2:");Serial.print(digitalRead(Dashboard_Button2));Serial.print(" ");
Serial.print("DB3:");Serial.print(digitalRead(Dashboard_Button3));Serial.print(" ");
Serial.println(" ");
analogWrite(Motor_PWM,255);
delay(1000); // wait for a second
Serial.print("Pos:");Serial.print(digitalRead(PositionTrig));Serial.print(" ");
Serial.print("DB1:");Serial.print(digitalRead(Dashboard_Button1));Serial.print(" ");
Serial.print("DB2:");Serial.print(digitalRead(Dashboard_Button2));Serial.print(" ");
Serial.print("DB3:");Serial.print(digitalRead(Dashboard_Button3));Serial.print(" ");
Serial.println(" ");
analogWrite(Motor_PWM,0);
delay(1000); // wait for a second
}
void encoderTick(){
if(digitalRead(EncoderDirPin)){
Serial.println("maju");
}else{
Serial.println("mundur");
}
}