root/branches/atorf/Benchmarking/MotorTests/DriveBackToStart.m @ 280

Revision 280, 0.6 KB (checked in by atorf, 5 years ago)

Added new Sensor demos and motor tests
Line 
1COM_CloseNXT all
2
3clear
4
5h = COM_OpenNXT('bluetooth.ini', 'check');
6COM_SetDefaultNXT(h);
7
8
9port1 = MOTOR_B;
10port2 = MOTOR_C;
11
12power = 60;
13limit = 5000;
14
15
16StopMotor all off
17NXT_ResetMotorPosition(port1, false);
18NXT_ResetMotorPosition(port1, true);
19NXT_ResetMotorPosition(port2, false);
20NXT_ResetMotorPosition(port2, true);
21
22
23
24SetMotor(port1)
25    SyncToMotor(port2)
26    SetPower(power)
27    SetAngleLimit(limit)
28SendMotorSettings
29
30WaitForMotor(port1)
31
32pause(2)
33
34SetMotor(port1)
35    SyncToMotor(port2)
36    SetPower(-power)
37    SetAngleLimit(limit)
38SendMotorSettings
39
40WaitForMotor(port1)
41
42pause(2)
43
44
45StopMotor all off
Note: See TracBrowser for help on using the browser.