COM_CloseNXT all

clear

h = COM_OpenNXT('bluetooth.ini', 'check');
COM_SetDefaultNXT(h);


port1 = MOTOR_B;
port2 = MOTOR_C;

power = 60;
limit = 5000;


StopMotor all off
NXT_ResetMotorPosition(port1, false);
NXT_ResetMotorPosition(port1, true);
NXT_ResetMotorPosition(port2, false);
NXT_ResetMotorPosition(port2, true);



SetMotor(port1)
    SyncToMotor(port2)
    SetPower(power)
    SetAngleLimit(limit)
SendMotorSettings

WaitForMotor(port1)

pause(2)

SetMotor(port1)
    SyncToMotor(port2)
    SetPower(-power)
    SetAngleLimit(limit)
SendMotorSettings

WaitForMotor(port1)

pause(2)


StopMotor all off