🚀 go-pugleaf

Witam
Piszę obsługę portu szeregowego w C++ z użyciem Linux Api. 2 obiekty klasy PortSzeregowy mają równolegle zapisywać i odczytywać ten port. Odczyt i zapis generalnie działa. Jednak chcę zapewnić działanie tej kasy (PortSzeregowy) w warunkach ekstremalnych (pod dużym obciążeniem). Dlatego nie robię tej komunikacji na timerach tylko na blokadzie pselect. Ta blokada działa w przypadku odczytu z portu, jednak analogiczny kod nie działa w przypadku zapisu.

Po prostu pselect (funkcja SerialPort::send()) nie zatrzymuje się w momencie gdy bufor wyjściowy portu jest pełen (gdy jest wywoływana przed odczytem). Poniżej zamieszczam funkcje zapisu i odczytu z portu szeregowego. Jeśli to możliwe to proszę o pomoc w zdiagnozowaniu powodu nie zatrzymywania się pselect (funkcja SerialPort::send()) w przypadku gdy bufor wyjściowy portu szeregowego jest pełen.

z góry dzięki i pozdro
Jacek

void SerialPort::receive()
{
// http://www.linuxprogrammingblog.com/code-examples/using-pselect-to-avoid-a-signal-race
// https://www.cmrr.umn.edu/~strupp/serial.html
    if(mPortDescriptor < 0)
        throw Exception(tr("Zły deskryptor pliku: %1").arg(mPortDescriptor).toUtf8().data());

    struct sigaction lSigAction;
    memset (&lSigAction, 0, sizeof(lSigAction));
    lSigAction.sa_handler = gSignTermHandler;

    // This server should shut down on SIGTERM.
    if(sigaction(SIGTERM, &lSigAction, 0))
        throw Exception(tr("Błąd sigaction! %1, %2").arg(errno).arg(strerror(errno)));

    sigset_t lMask;
    sigemptyset (&lMask);
    sigaddset (&lMask, SIGTERM);

    sigset_t orig_mask;
    if(sigprocmask(SIG_BLOCK, &lMask, &orig_mask) < 0)
        throw Exception(tr("Błąd sigprocmask! %1, %2").arg(errno).arg(strerror(errno)));

    struct timespec timeout;
    timeout.tv_sec  = 1;
    timeout.tv_nsec = 0;

    fd_set lFileDescriptorSet;
    /* BANG! we can get SIGTERM at this point, but it will be
     * delivered while we are in pselect(), because now
     * we block SIGTERM.
     */
    FD_ZERO(&lFileDescriptorSet);
    FD_SET(mPortDescriptor, &lFileDescriptorSet);

    while(true)
    {
        int lRes = pselect(mPortDescriptor + 1, &lFileDescriptorSet, NULL, NULL, &timeout, &orig_mask);
        if(mEnd)
            return;
        if((lRes < 0) && (errno != EINTR))
            throw Exception(tr("Bład pselect! %1, %2").arg(errno).arg(strerror(errno)));
        if(lRes == 0)  // timeout
            continue;
        if(gExitRequest)
            throw Exception(tr("Przechwycono sygnał SIGTERM! Koniec odbierania danych."));
        if(!FD_ISSET(mPortDescriptor, &lFileDescriptorSet))
            continue;

        int lSize = 0;
        ioctl(mPortDescriptor, FIONREAD, &lSize);

        if(lSize <= 0)
            continue;

        QByteArray lResult;
        lResult.resize(lSize);
        int lReaded(0), lPartial(0);
        while(lReaded < lSize)
        {
            if(mEnd)
                return;
            lPartial = ::read(mPortDescriptor, lResult.data(), lSize);
            if(lPartial > 0)
                lReaded += lPartial;
            else if(lPartial < 0)
            {
                qCritical() << tr("Uwaga! Błąd czytania portu szeregowego! Kod błędu: %1, wiadomość: %2").arg(errno).arg(strerror(errno));
                break;
            }
        }                    
        emit read(lResult);
    }
}

void SerialPort::send()
{
    // http://www.linuxprogrammingblog.com/code-examples/using-pselect-to-avoid-a-signal-race
    // https://www.cmrr.umn.edu/~strupp/serial.html
    if(mPortDescriptor < 0)
        throw Exception(tr("Zły deskryptor pliku: %1").arg(mPortDescriptor).toUtf8().data());

    struct sigaction lSigAction;
    memset (&lSigAction, 0, sizeof(lSigAction));
    lSigAction.sa_handler = gSignTermHandler;

    // This server should shut down on SIGTERM.
    if(sigaction(SIGTERM, &lSigAction, 0))
        throw Exception(tr("Błąd sigaction! %1, %2").arg(errno).arg(strerror(errno)));

    sigset_t lMask;
    sigemptyset(&lMask);
    sigaddset(&lMask, SIGTERM);

    sigset_t orig_mask;
    if(sigprocmask(SIG_BLOCK, &lMask, &orig_mask) < 0)
        throw Exception(tr("Błąd sigprocmask! %1, %2").arg(errno).arg(strerror(errno)));

    struct timespec timeout;
    timeout.tv_sec  = 1;
    timeout.tv_nsec = 0;

    fd_set lFileDescriptorSet;
    /* BANG! we can get SIGTERM at this point, but it will be
     * delivered while we are in pselect(), because now
     * we block SIGTERM.
     */
    FD_ZERO(&lFileDescriptorSet);
    FD_SET(mPortDescriptor, &lFileDescriptorSet);

    int lNumberToAquire(0);
    while(true)
    {
        lNumberToAquire = 0;
        if(mBufferEnd > mBufferStart)
            lNumberToAquire = mBufferEnd - mBufferStart;
        else if(mBufferEnd < mBufferStart)
            lNumberToAquire = mSendBuffer.size() - mBufferStart;
        if(lNumberToAquire <= 0)
            lNumberToAquire = 1;

        int lFreeSpaceSize = 0;
        ioctl(mPortDescriptor, TIOCOUTQ, &lFreeSpaceSize);
        if(lFreeSpaceSize <= 0) // we must wait for serial port
        {
            int lRes = pselect(mPortDescriptor + 1, NULL, &lFileDescriptorSet, NULL, &timeout, &orig_mask);
            if(mEnd)
                return;
            if((lRes < 0) && (errno != EINTR))
                throw Exception(tr("Bład pselect! Kod błedu: %1, komunikat: %2").arg(errno).arg(strerror(errno)));
            if(lRes == 0)  // timeout
                continue;
            if(gExitRequest)
                throw Exception(tr("Przechwycono sygnał SIGTERM! Koniec wysyłania danych."));
            if(!FD_ISSET(mPortDescriptor, &lFileDescriptorSet))
                continue;
        }

        ioctl(mPortDescriptor, TIOCOUTQ, &lFreeSpaceSize);

        if(lFreeSpaceSize <= 0)
        {
            qWarning() << tr("%1 Uwaga: Brak miejsca w bufoerze wyjściowym portu szeregowego!").arg(QTime::currentTime().toString("hh:mm:ss.z"));
            continue;
        }

        lNumberToAquire = qMin(lNumberToAquire, lFreeSpaceSize);

//#ifdef DEBUG
//        int lSemaphore(mAvailableData.available());
//#endif
        if((lNumberToAquire > 0) && mAvailableData.tryAcquire(lNumberToAquire, 1000))
        {
//#ifdef DEBUG
//        int lSemaphore2(mAvailableData.available());
//#endif                
            int lWriten(0), lPartial(0);
            while(lWriten < lNumberToAquire)
            {
                lPartial = ::write(mPortDescriptor, mSendBuffer.data() + mBufferStart, lNumberToAquire);
                if(lPartial > 0)
                    lWriten += lPartial;
                else if(lPartial < 0)
                {
                    qCritical() << tr("Błąd zapisu do portu szeregowego!!! Kod błędu: %1, Wiadomość błędu: %2").arg(errno).arg(strerror(errno));
                    break;
                }
            }

//            qDebug() << QTime::currentTime().toString("hh:mm:ss.z") << "Write to the serial port.";
            mBufferStart = (mBufferStart + lNumberToAquire) % mSendBufferSize;
            mFreeSpace.release(lNumberToAquire);
        }
        if(mEnd)
            return;
    }
}