h3n3/darkwater_cplus_640
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

new rejig

Browse Source
This commit is contained in:
shrkey
2016-10-10 22:18:16 +01:00
parent 69384be0d0
commit b2e758c50b
1 changed files with 12 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
darkwater/DW640.cpp
View File

@@ -201,29 +201,31 @@ DW_Motor *DW640::getMotor(uint8_t motor) {
uint8_t in1; uint8_t in1;
uint8_t in2; uint8_t in2;
motor--;
// Get the motor // Get the motor
switch(motor) { switch(motor) {
case 1: case 0:
in2 = 2; in2 = 2;
in1 = 3; in1 = 3;
break; break;
case 2: case 1:
in2 = 4; in2 = 4;
in1 = 5; in1 = 5;
break; break;
case 3: case 2:
in2 = 6; in2 = 6;
in1 = 7; in1 = 7;
break; break;
case 4: case 3:
in2 = 8; in2 = 8;
in1 = 9; in1 = 9;
break; break;
case 5: case 4:
in2 = 10; in2 = 10;
in1 = 11; in1 = 11;
break; break;
case 6: case 5:
in2 = 12; in2 = 12;
in1 = 13; in1 = 13;
break; break;
@@ -248,12 +250,14 @@ DW_Servo *DW640::getServo(uint8_t servo) {
uint8_t pin; uint8_t pin;
servo--;
// Get the servo // Get the servo
switch(servo) { switch(servo) {
case 1: case 0:
pin = 0; // Servo 1 is on PWM 0 pin = 0; // Servo 1 is on PWM 0
break; break;
case 2: case 1:
pin = 1; // Servo 2 is on PWM 1 pin = 1; // Servo 2 is on PWM 1
break; break;
default: default: