test.cpp

Go to the documentation of this file.

/* +------------------------------------------------------------------------+
   |                     Mobile Robot Programming Toolkit (MRPT)            |
   |                          http://www.mrpt.org/                          |
   |                                                                        |
   | Copyright (c) 2005-2018, Individual contributors, see AUTHORS file     |
   | See: http://www.mrpt.org/Authors - All rights reserved.                |
   | Released under BSD License. See details in http://www.mrpt.org/License |
   +------------------------------------------------------------------------+ */

#include <mrpt/comms/CSerialPort.h>
#include <iostream>

using namespace mrpt::comms;
using namespace std;

int main()
{
    try
    {
        CSerialPort* serPort;

        string serName;

        cout << "Serial port test application: Use it with a loopback serial "
                "port (pins 2-3 connected)"
             << endl;

        cout << "Enter the serial port name (e.g. COM1, ttyS0, ttyUSB0): ";
        getline(cin, serName);

        cout << endl;
        cout << "Opening serial port...";
        serPort = new CSerialPort(serName);
        cout << "OK" << endl;

        cout << "Setting timeouts...";
        serPort->setTimeouts(100, 1, 100, 1, 100);
        cout << "OK" << endl;

        cout << "Setting baud rate...";
        serPort->setConfig(500000);
        cout << "OK" << endl;

        for (int i = 0; i < 10; i++)
        {
            // Test write:
            cout << "Writing test data...";
            const char buf1[] = "Hello world!";
            size_t written = serPort->Write(buf1, sizeof(buf1));
            cout << written << " bytes written." << endl;

            // Read:
            cout << "Reading data...";
            char buf2[100];
            size_t nRead = serPort->Read(buf2, sizeof(buf2));
            cout << nRead << " bytes read: '";

            buf2[nRead] = 0;
            cout << buf2 << "'" << endl;
        }

        delete serPort;
    }
    catch (std::exception& e)
    {
        cerr << e.what() << endl;
        return -1;
    }

    return 0;
}