-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathRCM-D1.h
45 lines (32 loc) · 1 KB
/
RCM-D1.h
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
// https://github.com/RCMgames/RCM-hardware-D1
// all the servo drivers
JMotorDriverAvrServo servo1Driver = JMotorDriverAvrServo(port1);
JMotorDriverAvrServo servo2Driver = JMotorDriverAvrServo(port2);
// all the motor drivers
JMotorDriverAvrHBridge motorADriver = JMotorDriverAvrHBridge(portA);
JMotorDriverAvrHBridge motorBDriver = JMotorDriverAvrHBridge(portB);
// variables for the drivers
float servo1Val = 0;
float servo2Val = 0;
float motorAVal = 0;
float motorBVal = 0;
// Enabled()
servo1Driver.set(servo1Val);
servo2Driver.set(servo2Val);
motorADriver.set(motorAVal);
motorBDriver.set(motorBVal);
// Enable()
servo1Driver.enable();
servo2Driver.enable();
motorADriver.enable();
motorBDriver.enable();
// Disable()
servo1Driver.disable();
servo2Driver.disable();
motorADriver.disable();
motorBDriver.disable();
// WifiDataToParse()
servo1Val = EWD::recvFl();
servo2Val = EWD::recvFl();
motorAVal = EWD::recvFl();
motorBVal = EWD::recvFl();