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;
}