CGate(unsigned int SensorPin, unsigned int ServoPin, unsigned int ClosedPos, unsigned int OpenMaxPos)
    {
        sensorPin = SensorPin;
        servoPin = ServoPin;
        closedPos = ClosedPos; // pozycja zamknieta
        actPos = ClosedPos; // poz aktualna
        openMaxPos = OpenMaxPos; // poz maksymalnie otwarta
    }