private void StartMotor(int port, int speed)
{
if (speed > 255)
speed = 255;
if (speed < -255)
speed = -255;
brick.BrickPi.Motor[port].Speed = speed;
brick.BrickPi.Motor[port].Enable = 1;
}