Guest User

Untitled

a guest
Nov 22nd, 2017
64
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.43 KB | None | 0 0
  1. ubyte data[100];
  2. int u = 0;
  3.  
  4. task BT()
  5. {
  6.     while(true)
  7.   {
  8.     while (cCmdMessageGetSize(mailbox1) < 1) wait1Msec(1);
  9.     cCmdMessageRead(data, 2, mailbox1);
  10.     u = data[0] - 100;
  11.     wait1Msec(30);
  12.   }
  13. }
  14.  
  15. task PregCamera()
  16. {
  17.     int mA = 0;
  18.     nMotorEncoder[motorA] = 0;
  19.     while(true)
  20.     {
  21.         mA = ((data[1] - 100) - nMotorEncoder[motorA]) * 0.1;
  22.         motor[motorA] = mA;
  23.         nxtDisplayTextLine(3, "%d", mA);
  24.         wait1Msec(10);
  25.     }
  26. }
Advertisement
Add Comment
Please, Sign In to add comment