//Command sender to brick
private void MotorCommand()
{
if (rightMotor == 0 && leftMotor == 0)
{
McMotorPair.Brake();
McMotorPair.Idle();
}
else
{
if (motorControlActive)
{
McMotorB.RunAndCoast((sbyte)rightMotor, 0);
McMotorC.RunAndCoast((sbyte)leftMotor, 0);
}
else
{
motorB.Run((sbyte)rightMotor, 0);
motorC.Run((sbyte)leftMotor, 0);
}
}
}
private void ResetMotorSync()
{
_motorSync.Idle();
_motorSync.ResetMotorPosition(true);
}