Advertisement
Guest User

Untitled

a guest
Apr 26th, 2017
69
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.66 KB | None | 0 0
  1. function Ruch(drivingPower,turningPower, drivingDist,turningDist,tryb)
  2.  
  3. myNXT = COM_OpenNXT('usb.ini');
  4. COM_SetDefaultNXT(myNXT);
  5.  
  6. % Set some parameters:
  7. leftWheel = MOTOR_A;
  8. rightWheel = MOTOR_C;
  9. bothWheels = [leftWheel; rightWheel];
  10.  
  11. % now create the objects for straigt driving:
  12. mForward = NXTMotor(bothWheels, 'Power', drivingPower, 'TachoLimit', drivingDist);
  13. mReverse = mForward; % clone object
  14. mReverse.Power = -mForward.Power; % just swap the power sign
  15.  
  16.  
  17.  
  18. % in degrees
  19.  
  20. % for turning the bot, we have two objects each:
  21. mTurnLeft1 = NXTMotor(leftWheel, 'Power', -turningPower, 'TachoLimit', turningDist);
  22. mTurnLeft1.SpeedRegulation = false; % don't need this for turning
  23.  
  24. % for the 2nd part of turning, use first part's settings and modify:
  25. mTurnLeft2 = mTurnLeft1; % copy object
  26. mTurnLeft2.Port = rightWheel; % but use other wheel
  27. mTurnLeft2.Power = -mTurnLeft1.Power; % swap power again
  28.  
  29. % the right-turn objects are the same, but mirrored:
  30. mTurnRight1 = mTurnLeft1; % first copy...
  31. mTurnRight2 = mTurnLeft2;
  32. mTurnRight1.Power = -mTurnRight1.Power; % now mirror powers
  33. mTurnRight2.Power = -mTurnRight2.Power;
  34. % Instead of mirroring the powers, we could've also changed
  35. % the ports (swapped left and right wheels).
  36.  
  37. % TRYB - 1 Przod | 2 - Tyl | 3 - Podnies | 4 - Opusc | 5 - Lewo | 6 -Prawo
  38.  
  39. if (tryb == 1)
  40. % make a left-turn
  41. mTurnLeft1.SendToNXT();
  42. mTurnLeft2.SendToNXT();
  43. mTurnLeft1.WaitFor();
  44. mTurnLeft2.WaitFor();
  45. else
  46. % turn back to the origin
  47. mTurnRight1.SendToNXT();
  48. mTurnRight2.SendToNXT();
  49. mTurnRight1.WaitFor();
  50. mTurnRight2.WaitFor();
  51. end
  52.  
  53. end
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement