Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void manual()
- {
- float multiplier = 2;
- float x = 0;
- float y = 0;
- while (1)
- {
- KeyboardState keyboardstate = getKeyboardState();
- x += keyboardstate.right * multiplier;
- x -= keyboardstate.left * multiplier;
- y -= keyboardstate.up * multiplier;
- y += keyboardstate.down * multiplier;
- // Make sure the velocity values dont go outside [-100,100]
- y = min(max(y, -100), 100);
- x = min(max(x, -100), 100);
- if (keyboardstate.quit)
- break;
- // Convert the x and y components to tank controls.
- unsigned char left;
- unsigned char right;
- toTankControls(x, y, &left, &right);
- sendMotorStatus(left, right);
- // Sleep a bit, this ensures that we dont overflow the wixel or 3pi robot with data.
- Sleep(16);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement