Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- ubyte data[100];
- int u = 0;
- task BT()
- {
- while(true)
- {
- while (cCmdMessageGetSize(mailbox1) < 1) wait1Msec(1);
- cCmdMessageRead(data, 2, mailbox1);
- u = data[0] - 100;
- wait1Msec(30);
- }
- }
- task PregCamera()
- {
- int mA = 0;
- nMotorEncoder[motorA] = 0;
- while(true)
- {
- mA = ((data[1] - 100) - nMotorEncoder[motorA]) * 0.1;
- motor[motorA] = mA;
- nxtDisplayTextLine(3, "%d", mA);
- wait1Msec(10);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment