mirror of
https://github.com/overte-org/overte.git
synced 2025-06-19 00:00:41 +02:00
Simplified serial port init to not use baud.
This commit is contained in:
parent
87dfbf9f4f
commit
6b85d93aee
3 changed files with 9 additions and 26 deletions
|
@ -36,7 +36,7 @@ void SerialInterface::pair() {
|
||||||
char *serialPortname = new char[100];
|
char *serialPortname = new char[100];
|
||||||
sprintf(serialPortname, "/dev/%s", entry->d_name);
|
sprintf(serialPortname, "/dev/%s", entry->d_name);
|
||||||
|
|
||||||
initializePort(serialPortname, 115200);
|
initializePort(serialPortname);
|
||||||
|
|
||||||
delete [] serialPortname;
|
delete [] serialPortname;
|
||||||
}
|
}
|
||||||
|
@ -48,7 +48,7 @@ void SerialInterface::pair() {
|
||||||
}
|
}
|
||||||
|
|
||||||
// connect to the serial port
|
// connect to the serial port
|
||||||
void SerialInterface::initializePort(char* portname, int baud) {
|
void SerialInterface::initializePort(char* portname) {
|
||||||
#ifdef __APPLE__
|
#ifdef __APPLE__
|
||||||
_serialDescriptor = open(portname, O_RDWR | O_NOCTTY | O_NDELAY);
|
_serialDescriptor = open(portname, O_RDWR | O_NOCTTY | O_NDELAY);
|
||||||
|
|
||||||
|
@ -62,31 +62,14 @@ void SerialInterface::initializePort(char* portname, int baud) {
|
||||||
struct termios options;
|
struct termios options;
|
||||||
tcgetattr(_serialDescriptor, &options);
|
tcgetattr(_serialDescriptor, &options);
|
||||||
|
|
||||||
switch(baud) {
|
options.c_cflag |= (CLOCAL | CREAD | CS8);
|
||||||
case 9600: cfsetispeed(&options,B9600);
|
|
||||||
cfsetospeed(&options,B9600);
|
|
||||||
break;
|
|
||||||
case 19200: cfsetispeed(&options,B19200);
|
|
||||||
cfsetospeed(&options,B19200);
|
|
||||||
break;
|
|
||||||
case 38400: cfsetispeed(&options,B38400);
|
|
||||||
cfsetospeed(&options,B38400);
|
|
||||||
break;
|
|
||||||
case 115200: cfsetispeed(&options,B115200);
|
|
||||||
cfsetospeed(&options,B115200);
|
|
||||||
break;
|
|
||||||
default:cfsetispeed(&options,B9600);
|
|
||||||
cfsetospeed(&options,B9600);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
options.c_cflag |= (CLOCAL | CREAD);
|
|
||||||
options.c_cflag &= ~PARENB;
|
options.c_cflag &= ~PARENB;
|
||||||
options.c_cflag &= ~CSTOPB;
|
options.c_cflag &= ~CSTOPB;
|
||||||
options.c_cflag &= ~CSIZE;
|
options.c_cflag &= ~CSIZE;
|
||||||
options.c_cflag |= CS8;
|
|
||||||
tcsetattr(_serialDescriptor, TCSANOW, &options);
|
tcsetattr(_serialDescriptor, TCSANOW, &options);
|
||||||
|
|
||||||
|
cfsetispeed(&options,B115200);
|
||||||
|
cfsetospeed(&options,B115200);
|
||||||
|
|
||||||
if (USING_INVENSENSE_MPU9150) {
|
if (USING_INVENSENSE_MPU9150) {
|
||||||
// block on invensense reads until there is data to read
|
// block on invensense reads until there is data to read
|
||||||
|
|
|
@ -60,7 +60,7 @@ public:
|
||||||
bool active;
|
bool active;
|
||||||
|
|
||||||
private:
|
private:
|
||||||
void initializePort(char* portname, int baud);
|
void initializePort(char* portname);
|
||||||
void resetSerial();
|
void resetSerial();
|
||||||
|
|
||||||
int _serialDescriptor;
|
int _serialDescriptor;
|
||||||
|
|
Loading…
Reference in a new issue