add LightsDriver_LinuxSerial

This commit is contained in:
Chris Danford
2003-11-16 07:43:39 +00:00
parent 5cc4f6dc00
commit 5f95df0bae
7 changed files with 140 additions and 2 deletions
+3
View File
@@ -190,6 +190,9 @@ void LightsManager::Update( float fDeltaTime )
default:
ASSERT(0);
}
// apply new light values we set above
m_pDriver->Flush();
}
void LightsManager::SetLightMode( LightMode lm )
+1
View File
@@ -20,6 +20,7 @@ public:
virtual ~LightsDriver() {};
virtual void SetLight( Light light, bool bOn ) = 0;
virtual void Flush() = 0;
};
@@ -0,0 +1,97 @@
#include "global.h"
/*
-----------------------------------------------------------------------------
Class: LightsDriver_LinuxSerial
Desc: See header.
Copyright (c) 2001-2002 by the person(s) listed below. All rights reserved.
Chris Danford
-----------------------------------------------------------------------------
*/
#include "LightsDriver_LinuxSerial.h"
#include <stdio.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <string.h>
#include <errno.h>
#include "adrport.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;
if (fd < 1)
{
LOG->Warn("Lights port is not open\n");
return ;
}
iOut = write(fd, sz, len);
if (iOut < 0)
{
LOG->Warn("Lights write error %d %s\n", errno, strerror(errno));
}
ASSERT( iOut > 0 );
}
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;
if( bOn )
data |= mask;
else
data &= ~mask;
WriteString( data, sizeof(data) );
}
void LightsDriver_LinuxSerial::Flush()
{
WriteString( data, sizeof(data) );
}
@@ -0,0 +1,28 @@
#ifndef LightsDriver_LinuxSerial_H
#define LightsDriver_LinuxSerial_H
/*
-----------------------------------------------------------------------------
Class: LightsDriver_LinuxSerial
Desc: Control lights.
Copyright (c) 2001-2002 by the person(s) listed below. All rights reserved.
Chris Danford
-----------------------------------------------------------------------------
*/
#include "arch/Lights/LightsDriver.h"
class LightsDriver_LinuxSerial : public LightsDriver
{
public:
LightsDriver_LinuxSerial();
virtual ~LightsDriver_LinuxSerial();
virtual void SetLight( Light light, bool bOn );
virtual void Flush();
};
#endif
@@ -20,6 +20,7 @@ public:
virtual ~LightsDriver_Null() {};
virtual void SetLight( Light light, bool bOn ) {};
virtual void Flush() {};
};
@@ -75,7 +75,14 @@ void LightsDriver_Win32Parallel::SetLight( Light light, bool bOn )
data |= mask;
else
data &= ~mask;
}
DWORD address = LPT_ADDRESS[lpt];
PortOut( address, data );
void LightsDriver_Win32Parallel::Flush()
{
for( int i=0; i<MAX_PARALLEL_PORTS; i++ )
{
BYTE &data = g_data[i];
DWORD address = LPT_ADDRESS[i];
PortOut( address, data );
}
}
@@ -20,6 +20,7 @@ public:
virtual ~LightsDriver_Win32Parallel();
virtual void SetLight( Light light, bool bOn );
virtual void Flush();
};