Guest User

Untitled

a guest
Oct 19th, 2017
69
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.87 KB | None | 0 0
  1. char envio[60];
  2. char envio_x[15];
  3. char envio_y[15];
  4. char envio_z[15];
  5. const int eje_x=ANALOG5;
  6. const int eje_y=ANALOG3;
  7. const int eje_z=ANALOG1;
  8. void setup()
  9. {
  10.  
  11. xbee802.init(XBEE_802_15_4,FREQ2_4G,NORMAL);
  12.  
  13.  
  14. xbee802.ON(); // starts using the serial port
  15. USB.begin();
  16. PWR.setSensorPower(SENS_5V,SENS_ON);
  17.  
  18. pinMode(eje_x,INPUT);
  19. pinMode(eje_y,INPUT);
  20. pinMode(eje_z,INPUT);
  21. }
  22.  
  23. void loop()
  24. {
  25. int x=analogRead(eje_x);
  26. int y=analogRead(eje_y);
  27. int z=analogRead(eje_z);
  28. float zeroG=430.0;
  29. float scale=93.0;
  30. float outx=((float)x-zeroG)/scale;
  31. float outy=((float)y-zeroG)/scale;
  32. float outz=((float)z-zeroG)/scale;
  33. dtostrf(outx,5,5,envio_x);
  34. dtostrf(outy,5,5,envio_y);
  35. dtostrf(outz,5,5,envio_z);
  36.  
  37. // Utils.setLED(LED0,LED_ON);
  38.  
  39. sprintf(envio,"x:%f y:%f z:%f n",envio_x,envio_y,envio_z,'n',"r");
  40. xbee802.send("0013A20040691665",envio);
  41.  
  42. // Utils.setLED(LED0,LED_ON);
  43. delay(1000);
  44.  
  45. }
Add Comment
Please, Sign In to add comment