Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Wire.h>
- int rx1 = 0; //throttle
- int rx2 = 0; //aileron
- int rx3 = 0; //elevation
- int rx4 = 0; //rudder
- int rx5 = 0; //AUX
- int rx6 = 0; //Trainer
- int rx1b = 0; //throttle
- int rx2b = 0; //aileron
- int rx3b = 0; //elevation
- int rx4b = 0; //rudder
- int rx5b = 0; //AUX
- int rx6b = 0; //Trainer
- char bx1 = 0;
- char bx2 = 0;
- char bx3 = 0;
- char bx4 = 0;
- char bx5 = 0;
- char bx6 = 0;
- char bx1b = 0;
- char bx2b = 0;
- char bx3b = 0;
- char bx4b = 0;
- char bx5b = 0;
- char bx6b = 0;
- void setup()
- {
- Serial.begin(115200); //Open the serial port at 115200bps
- Wire.begin(); //Join I2C bus (no address for master)
- }
- void loop()
- {
- rx1 = pulseIn(7,HIGH,20000);
- // rx1 = constrain (rx1, 1300, 1875);
- // rx1 = map(rx1, 1300, 1875, 1, 100);
- bx1 = char(rx1);
- rx2 = pulseIn(6,HIGH,20000);
- // rx2 = constrain (rx2, 1001, 2000);
- //rx2 = map(rx2, 1100, 1890, 1, 100);
- bx2 = char(rx2);
- rx3 = pulseIn(5,HIGH,20000);
- // rx3 = constrain (rx3, 1001, 2000);
- // rx3 = map(rx3, 1100, 1890, 1, 100);
- bx3 = char(rx3);
- rx4 = pulseIn(4,HIGH,20000);
- // rx4 = constrain (rx4, 1001, 2000);
- // rx4 = map(rx4, 1100, 1890, 1, 100);
- bx4 = char(rx4);
- rx5 = pulseIn(3,HIGH,20000);
- // rx5 = constrain (rx5, 1001, 2000);
- // rx5 = map(rx5, 1100, 1890, 1, 100);
- bx5 = char(rx5);
- rx6 = pulseIn(2,HIGH,20000);
- // rx6 = constrain (rx6, 1001, 2000);
- // rx6 = map(rx6, 1100, 1890, 1, 100);
- bx6 = char(rx6);
- rx1b = pulseIn(A0,HIGH,20000);
- // rx1b = constrain (rx1b, 1300, 1875);
- // rx1b = map(rx1b, 1300, 1875, 1, 100);
- bx1b = char(rx1b);
- rx2b = pulseIn(A1,HIGH,20000);
- // rx2b = constrain (rx2b, 1001, 2000);
- // rx2b = map(rx2b, 1100, 1890, 1, 100);
- bx2b = char(rx2b);
- rx3b = pulseIn(A2,HIGH,20000);
- // rx3b = constrain (rx3b, 1001, 2000);
- // rx3b = map(rx3b, 1100, 1890, 1, 100);
- bx3b = char(rx3b);
- rx4b = pulseIn(A3,HIGH,20000);
- // rx4b = constrain (rx4b, 1001, 2000);
- // rx4b = map(rx4b, 1100, 1890, 1, 100);
- bx4b = char(rx4b);
- rx5b = pulseIn(12,HIGH,20000);
- // rx5b = constrain (rx5b, 1001, 2000);
- // rx5b = map(rx5b, 1100, 1890, 1, 100);
- bx5b = char(rx5b);
- rx6b = pulseIn(8,HIGH,20000);
- // rx6b = constrain (rx6b, 1001, 2000);
- // rx6b = map(rx6b, 1100, 1890, 1, 100);
- bx6b = char(rx6b);
- Serial.print(rx1);
- Serial.print("\t");
- Serial.print(rx2);
- Serial.print("\t");
- Serial.print(rx3);
- Serial.print("\t");
- Serial.print(rx4);
- Serial.print("\t");
- Serial.print(rx5);
- Serial.print("\t");
- Serial.print(rx6);
- Serial.println("\t");
- Serial.print(rx1b);
- Serial.print("\t");
- Serial.print(rx2b);
- Serial.print("\t");
- Serial.print(rx3b);
- Serial.print("\t");
- Serial.print(rx4b);
- Serial.print("\t");
- Serial.print(rx5b);
- Serial.print("\t");
- Serial.print(rx6b);
- Serial.println("\t");
- Serial.println("\t");
- {
- expansionWrite(bx1, bx2, bx3, bx4, bx5, bx6, bx1b, bx2b, bx3b, bx4b, bx5b, bx6b); //Whenever you want to write to the
- }}
- void expansionWrite(int value1, int value2, int value3, int value4, int value5, int value6, int value7, int value8, int value9, int value10, int value11, int value12)
- {
- //pin = pin-100; substracts 100 to it maps to the real ports on the expansion arduino
- Wire.beginTransmission(2); //Transmit to device #2
- // Wire.write(pin); //Sends one byte stating the pin to be addressed
- Wire.write((int)value1);
- Wire.write((int)value2);
- Wire.write((int)value3);
- Wire.write((int)value4);
- Wire.write((int)value5);
- Wire.write((int)value6);
- Wire.write((int)value7);
- Wire.write((int)value8);
- Wire.write((int)value9);
- Wire.write((int)value10);
- Wire.write((int)value11);
- Wire.write((int)value12); //Sends the value to be transmitted to the pin selected
- Wire.endTransmission(); //Stop transmitting
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement