Multi-Hackers / SocketModem

A library for talking to Multi-Tech's Cellular SocketModem Devices.

Dependents:   M2X_dev axeda_wrapper_dev MTS_M2x_Example1 MTS_Cellular_Connect_Example ... more

io/MTSSerialFlowControl.cpp

Committer:
sgodinez
Date:
2013-12-16
Revision:
17:2d7c4ea7491b
Parent:
10:2bd727a4b329
Child:
39:6e94520a3217
Child:
45:40745c2036cf

File content as of revision 17:2d7c4ea7491b:

#ifndef MTSSERIALFLOWCONTROL_CPP
#define MTSSERIALFLOWCONTROL_CPP

#include "MTSSerialFlowControl.h"

MTSSerialFlowControl::MTSSerialFlowControl(PinName TXD, PinName RXD, PinName RTS, PinName CTS, int txBufSize, int rxBufSize, char* name) : MTSBufferedIO(txBufSize, rxBufSize), if_name(name)
{
    serial = new Serial(TXD, RXD);
    serial->attach(this, &MTSSerialFlowControl::handleRead, Serial::RxIrq);
    //serial->attach(this, &MTSSerialFlowControl::handleWrite, Serial::TxIrq);
    
    clearToSend = true;
    rts = new InterruptIn(RTS);
    rts->rise(this, &MTSSerialFlowControl::stopSending); // active low -> stop sending
    rts->fall(this, &MTSSerialFlowControl::startSending); // active low -> start sending
    
    cts = new DigitalOut(CTS);
    notifyStartSending();
    
    highThreshold = rxBufSize * 0.85;
    lowThreshold = rxBufSize * 0.3;
    
    rxBuffer->attach(this, &MTSSerialFlowControl::notifyStartSending, lowThreshold, Vars::LESS);
}

MTSSerialFlowControl::~MTSSerialFlowControl() {
    delete rts;
    delete cts;
    delete serial;
}

void MTSSerialFlowControl::baud(int baudrate) {
    serial->baud(baudrate);
}

void MTSSerialFlowControl::startSending() {
    clearToSend = true;
}

void MTSSerialFlowControl::stopSending() {
    clearToSend = false;
}

void MTSSerialFlowControl::notifyStartSending() {
    cts->write(0);
}

void MTSSerialFlowControl::notifyStopSending() {
    cts->write(1);
}

void MTSSerialFlowControl::handleRead() {
    if (rxBuffer->available() > highThreshold) {
        notifyStopSending();
    }
    while (serial->readable()) {
        rxBuffer->write(serial->getc());
    }
}

void MTSSerialFlowControl::handleWrite() {
    if (clearToSend) {
        while(txBuffer->available() != 0) {
            if (serial->writeable()) {
                char byte;
                if(txBuffer->read(byte) == 1) {
                    serial->putc(byte);
                }
            } else {
                wait(.05);
            }
        }
    }
}

#endif /* MTSSERIALFLOWCONTROL */