70 likes | 225 Views
Điều khiển chuyển động. SaigonTech SRobot Workshop. Nội dung chính. Điều khiển Motor Điều khiển tay lái (Pilot). 1. Điều khiển Motor. Yêu cầu : Viết chương trình điều khiển robot xoay vòng tròn tại tâm trong 5 giây . uses STRobot , SysUtils ; var robot: SROBOT;
E N D
Điềukhiểnchuyểnđộng SaigonTechSRobot Workshop
Nội dung chính • Điềukhiển Motor • Điềukhiểntaylái (Pilot)
1. ĐiềukhiểnMotor • Yêucầu:Viếtchươngtrìnhđiềukhiển robot xoayvòngtròntạitâmtrong5 giây.
uses STRobot, SysUtils; var robot: SROBOT; leftMotor, rightMotor: SMOTOR; begin robot := createRobot('NXT', 'Robot xe 1', 100, 100, 0); leftMotor := robotGetMotor(robot, PORT_A); rightMotor := robotGetMotor(robot, PORT_B); motorForward(leftMotor); motorBackward(rightMotor); sleep(5000); end.
2. Điềukhiểntaylái (Pilot) • Yêucầu:Viếtchươngtrìnhđiềukhiển robot di chuyểnnhưsau: • Di chuyểnvớiquỹđạolàmộthìnhvuôngcócạnhlà 60cm. • Sauđótiếptục di chuyểnvớiquỹđạolàmộthìnhtrònvớibánkính 30cm.
uses STRobot, SysUtils; var robot: SROBOT; pilot: SPILOT; counter, power, edge, radius: Integer; length : Double; begin robot := createRobot('NXT', 'Robot xe 1', 100, 100, 0); pilot := robotGetPilot(robot); power := 50; edge := 60; radius := 30; for counter := 1 to 4 do begin pilotForwardByDistance(pilot, edge, TYPE_POWER, power); pilotTurnLeftByAngle(pilot, 90, TYPE_POWER, power); end; length := 2 * PI * radius; pilotTurnRightArcByLength(pilot, radius, length, TYPE_POWER, power); end.