#include "mbed.h"
#include "MODSERIAL.h"

// Make TX buffer 1024bytes and RX buffer use 512bytes.
MODSERIAL pc(USBTX, USBRX, 256); // tx, rx
Serial RS485(p26, p25);
DigitalOut DTR (p21);


// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
// Hauptprogramm

int main()
{

// Setze die Baudrate des PCs auf 230400
    pc.baud (230400);

    // Setze die Baudrate von RS-485 auf 62500 Baud
    RS485.baud (62500);

    // Das Format von RS-485 ist 8 Bits, 1 Paritaetsbit und 1 Stopbit
    RS485.format(8,ParityForced1,1);

    // Um etwas empfangen zu koennen muss DTR immer gleich 0 sein
    DTR = 0;

// Increase the TX buffer from the default 256bytes to 1024bytes.
    if (pc.txBufferSetSize(1024) != MODSERIAL::Ok) {
        error("Failed to allocate memory for new buffer");
    }

    if (RS485.readable()) {
        pc.printf("%x ", RS485.getc());
    }
    
   // RS485.attach(&rxCallback, MODSERIAL::RxIrq);


}