Advertisement
tommasta

Arduino Multi AR600 Master *hangs*

Apr 27th, 2012
69
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 3.84 KB | None | 0 0
  1. #include <Wire.h>
  2. int rx1 = 0;  //throttle
  3. int rx2 = 0;  //aileron
  4. int rx3 = 0;  //elevation
  5. int rx4 = 0;  //rudder
  6. int rx5 = 0;  //AUX
  7. int rx6 = 0;  //Trainer
  8. int rx1b = 0;  //throttle
  9. int rx2b = 0;  //aileron
  10. int rx3b = 0;  //elevation
  11. int rx4b = 0;  //rudder
  12. int rx5b = 0;  //AUX
  13. int rx6b = 0;  //Trainer
  14. char bx1 = 0;
  15. char bx2 = 0;
  16. char bx3 = 0;
  17. char bx4 = 0;
  18. char bx5 = 0;
  19. char bx6 = 0;
  20. char bx1b = 0;
  21. char bx2b = 0;
  22. char bx3b = 0;
  23. char bx4b = 0;
  24. char bx5b = 0;
  25. char bx6b = 0;
  26.  
  27.  
  28. void setup()
  29. {
  30.   Serial.begin(115200);      //Open the serial port at 115200bps
  31.   Wire.begin();              //Join I2C bus (no address for master)
  32. }
  33.  
  34.  
  35. void loop()
  36. {
  37.   rx1 = pulseIn(7,HIGH,20000);
  38. // rx1 = constrain (rx1, 1300, 1875);
  39. // rx1 = map(rx1, 1300, 1875, 1, 100);
  40.  bx1 = char(rx1);
  41.   rx2 = pulseIn(6,HIGH,20000);
  42. // rx2 = constrain (rx2, 1001, 2000);
  43.  //rx2 = map(rx2, 1100, 1890, 1, 100);
  44.  bx2 = char(rx2);
  45.   rx3 = pulseIn(5,HIGH,20000);
  46. // rx3 = constrain (rx3, 1001, 2000);
  47. // rx3 = map(rx3, 1100, 1890, 1, 100);
  48.  bx3 = char(rx3);
  49.   rx4 = pulseIn(4,HIGH,20000);
  50. // rx4 = constrain (rx4, 1001, 2000);
  51. // rx4 = map(rx4, 1100, 1890, 1, 100);
  52.  bx4 = char(rx4);
  53.   rx5 = pulseIn(3,HIGH,20000);
  54. // rx5 = constrain (rx5, 1001, 2000);
  55. // rx5 = map(rx5, 1100, 1890, 1, 100);
  56.  bx5 = char(rx5);
  57.   rx6 = pulseIn(2,HIGH,20000);
  58. // rx6 = constrain (rx6, 1001, 2000);
  59. // rx6 = map(rx6, 1100, 1890, 1, 100);
  60.  bx6 = char(rx6);
  61.  
  62.    rx1b = pulseIn(A0,HIGH,20000);
  63. // rx1b = constrain (rx1b, 1300, 1875);
  64. // rx1b = map(rx1b, 1300, 1875, 1, 100);
  65.  bx1b = char(rx1b);
  66.   rx2b = pulseIn(A1,HIGH,20000);
  67. // rx2b = constrain (rx2b, 1001, 2000);
  68. // rx2b = map(rx2b, 1100, 1890, 1, 100);
  69.  bx2b = char(rx2b);
  70.   rx3b = pulseIn(A2,HIGH,20000);
  71. // rx3b = constrain (rx3b, 1001, 2000);
  72. // rx3b = map(rx3b, 1100, 1890, 1, 100);
  73.  bx3b = char(rx3b);
  74.   rx4b = pulseIn(A3,HIGH,20000);
  75. // rx4b = constrain (rx4b, 1001, 2000);
  76. // rx4b = map(rx4b, 1100, 1890, 1, 100);
  77.  bx4b = char(rx4b);
  78.   rx5b = pulseIn(12,HIGH,20000);
  79. // rx5b = constrain (rx5b, 1001, 2000);
  80. // rx5b = map(rx5b, 1100, 1890, 1, 100);
  81.  bx5b = char(rx5b);
  82.   rx6b = pulseIn(8,HIGH,20000);
  83. // rx6b = constrain (rx6b, 1001, 2000);
  84. // rx6b = map(rx6b, 1100, 1890, 1, 100);
  85.  bx6b = char(rx6b);
  86.     Serial.print(rx1);
  87.     Serial.print("\t");
  88.     Serial.print(rx2);
  89.     Serial.print("\t");
  90.     Serial.print(rx3);
  91.     Serial.print("\t");
  92.     Serial.print(rx4);
  93.     Serial.print("\t");
  94.     Serial.print(rx5);
  95.     Serial.print("\t");
  96.     Serial.print(rx6);
  97.     Serial.println("\t");
  98.    
  99.     Serial.print(rx1b);
  100.     Serial.print("\t");
  101.     Serial.print(rx2b);
  102.     Serial.print("\t");
  103.     Serial.print(rx3b);
  104.     Serial.print("\t");
  105.     Serial.print(rx4b);
  106.     Serial.print("\t");
  107.     Serial.print(rx5b);
  108.     Serial.print("\t");
  109.     Serial.print(rx6b);
  110.     Serial.println("\t");
  111.         Serial.println("\t");
  112.  
  113.  
  114.  {
  115.     expansionWrite(bx1, bx2, bx3, bx4, bx5, bx6, bx1b, bx2b, bx3b, bx4b, bx5b, bx6b);  //Whenever you want to write to the
  116. }}
  117.  
  118. 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)
  119. {
  120.   //pin = pin-100;             substracts 100 to it maps to the real ports on the expansion arduino
  121.   Wire.beginTransmission(2); //Transmit to device #2
  122. //  Wire.write(pin);            //Sends one byte stating the pin to be addressed
  123.   Wire.write((int)value1);
  124.   Wire.write((int)value2);
  125.   Wire.write((int)value3);
  126.   Wire.write((int)value4);
  127.   Wire.write((int)value5);
  128.   Wire.write((int)value6);
  129.   Wire.write((int)value7);
  130.   Wire.write((int)value8);
  131.   Wire.write((int)value9);
  132.   Wire.write((int)value10);
  133.   Wire.write((int)value11);
  134.   Wire.write((int)value12);  //Sends the value to be transmitted to the pin selected
  135.   Wire.endTransmission();    //Stop transmitting
  136. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement