fix Linux light compile errors

This commit is contained in:
Chris Danford
2003-11-16 11:11:56 +00:00
parent aaea996bda
commit 1b7a2717d5
3 changed files with 37 additions and 42 deletions
@@ -19,43 +19,10 @@
#include <termios.h>
#include <string.h>
#include <errno.h>
#include "adrport.h"
#include "RageLog.h"
static int fd = 0;
LightsDriver_LinuxSerial::LightsDriver_LinuxSerial()
{
sprintf(sPortName, "/dev/ttyS1", sPortNumber);
fd = open(sPortName, O_RDWR | O_NOCTTY | O_NDELAY);
if (fd < 0)
RageException::Throw( "open error %d %s\n", errno, strerror(errno) );
struct termios my_termios;
tcgetattr(fd, &my_termios);
tcflush(fd, TCIFLUSH);
my_termios.c_cflag = B2400 | CS8 |CREAD | CLOCAL | HUPCL;
cfsetospeed(&my_termios, B2400);
tcsetattr(fd, TCSANOW, &my_termios);
LOG->Info("Lights info:");
LOG->Info(" new cflag=%08x\n", my_termios.c_cflag);
LOG->Info(" new oflag=%08x\n", my_termios.c_oflag);
LOG->Info(" new iflag=%08x\n", my_termios.c_iflag);
LOG->Info(" new lflag=%08x\n", my_termios.c_lflag);
LOG->Info(" new line=%02x\n", my_termios.c_line);
WriteString( "Yo", strlen("Yo" );
}
LightsDriver_LinuxSerial::~LightsDriver_LinuxSerial()
{
if (fd > 0)
close(fd);
}
void WriteString( char* sz, int len )
{
int iOut;
@@ -74,24 +41,53 @@ void WriteString( char* sz, int len )
ASSERT( iOut > 0 );
}
char g_data[2] = { 0, 0 };
LightsDriver_LinuxSerial::LightsDriver_LinuxSerial()
{
fd = open("/dev/ttyS1", O_RDWR | O_NOCTTY | O_NDELAY);
if (fd < 0)
RageException::Throw( "open error %d %s\n", errno, strerror(errno) );
struct termios my_termios;
tcgetattr(fd, &my_termios);
tcflush(fd, TCIFLUSH);
my_termios.c_cflag = B2400 | CS8 |CREAD | CLOCAL | HUPCL;
cfsetospeed(&my_termios, B2400);
tcsetattr(fd, TCSANOW, &my_termios);
LOG->Info("Lights info:");
LOG->Info(" new cflag=%08x\n", my_termios.c_cflag);
LOG->Info(" new oflag=%08x\n", my_termios.c_oflag);
LOG->Info(" new iflag=%08x\n", my_termios.c_iflag);
LOG->Info(" new lflag=%08x\n", my_termios.c_lflag);
LOG->Info(" new line=%02x\n", my_termios.c_line);
WriteString( "Yo", strlen("Yo") );
}
LightsDriver_LinuxSerial::~LightsDriver_LinuxSerial()
{
if (fd > 0)
close(fd);
}
char g_data[2] = { 0, 0 };
void LightsDriver_LinuxSerial::SetLight( Light light, bool bOn )
{
int byte_index = light / 8;
int bit_index = light % 8;
char &data = g_data[byte_index];
BYTE mask = 0x01 << bit_index;
char mask = 0x01 << bit_index;
if( bOn )
data |= mask;
else
data &= ~mask;
WriteString( data, sizeof(data) );
}
void LightsDriver_LinuxSerial::Flush()
{
WriteString( data, sizeof(data) );
WriteString( g_data, sizeof(g_data) );
}