Advertisement
KRITSADA

ATX2 use RC Remote Control for Rescue Robot

Jul 24th, 2016
209
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.57 KB | None | 0 0
  1. #include <ATX2.h>   // ATX2 Board
  2. int ch1,ch2,ch3,ch4;
  3. int x,y,z,a,b;
  4. void setup() {
  5.   XIO();    // ATX2 initialize
  6.   setTextSize(2);
  7.   pinMode(31, INPUT);
  8.   pinMode(30, INPUT);
  9.   pinMode(29, INPUT);
  10.   pinMode(28, INPUT);
  11. }
  12.  
  13. void loop() {
  14.    ch1=pulseIn(31,HIGH,25000);
  15.    ch2=pulseIn(30,HIGH,25000);
  16.    ch3=pulseIn(29,HIGH,25000);
  17.    ch4=pulseIn(28,HIGH,25000);
  18.  /*  glcd(0,0,"%d ",ch1);
  19.    glcd(1,0,"%d ",ch2);
  20.    glcd(2,0,"%d ",ch3);
  21.    glcd(3,0,"%d ",ch4);*/
  22.    x=map(ch1,1000,2000,-100,100);
  23.    y=map(ch2,1000,2000,-50,50);
  24.    FD2(x+y,x-y);
  25.    
  26.    
  27.  }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement