few changes for RTS/CTS control
Dependencies: MTS-Serial libmDot mbed-rtos mbed
Fork of mDot_AT_firmware by
ATSerialFlowControl.cpp
- Committer:
- serg838
- Date:
- 2016-10-25
- Revision:
- 11:77b7911263da
- Parent:
- 9:ff62b20f7000
File content as of revision 11:77b7911263da:
#include "mbed.h" #include "ATSerialFlowControl.h" #include "MTSLog.h" #include "Utils.h" using namespace mts; ATSerialFlowControl::ATSerialFlowControl(PinName TXD, PinName RXD, PinName RTS, PinName CTS, int txBufSize, int rxBufSize) : ATSerial(TXD, RXD, txBufSize, rxBufSize) , rxReadyFlag(false) , rts(RTS) , cts(CTS) , dtr(PA_11) { notifyStartSending(); // Calculate the high and low watermark values highThreshold = mts_max(rxBufSize - 10, rxBufSize * 0.85); lowThreshold = rxBufSize * 0.3; // Setup the low watermark callback on the internal receive buffer rxBuffer.attach(this, &ATSerialFlowControl::notifyStartSending, lowThreshold, LESS); } ATSerialFlowControl::~ATSerialFlowControl() { } //Override the rxClear function to make sure that flow control lines are set correctly. void ATSerialFlowControl::rxClear() { MTSBufferedIO::rxClear(); notifyStartSending(); } void ATSerialFlowControl::notifyStartSending() { if(!rxReadyFlag) { rts.write(0); rxReadyFlag = true; //printf("RTS LOW: READY - RX[%d/%d]\r\n", rxBuffer.size(), rxBuffer.capacity()); } } void ATSerialFlowControl::notifyStopSending() { if(rxReadyFlag) { rts.write(1); rxReadyFlag = false; //printf("RTS HIGH: NOT-READY - RX[%d/%d]\r\n", rxBuffer.size(), rxBuffer.capacity()); } } void ATSerialFlowControl::handleRead() { ATSerial::handleRead(); if (rxBuffer.size() >= highThreshold) { notifyStopSending(); } } void ATSerialFlowControl::handleWrite() { while(txBuffer.size() != 0) { if (serial.writeable() && cts.read() == 0) { dtr.write(0); char byte; if(txBuffer.read(byte) == 1) { serial.attach(NULL, Serial::RxIrq); serial.putc(byte); serial.attach(this, &ATSerialFlowControl::handleRead, Serial::RxIrq); } } else { if (cts.read() == 1) dtr.write(1); return; } } }