actions/itgmania212121
1
0
Fork 0
Code Issues Pull Requests Actions 1 Packages Projects Releases Wiki Activity

Glenn's serial flow control fix!

Browse Source
This commit is contained in:
Jason Asbahr
2003-11-20 06:44:54 +00:00
parent 897cd94be5
commit a32a62faac
1 changed files with 28 additions and 28 deletions
Download Patch File Download Diff File Expand all files Collapse all files
stepmania/src/arch/Lights/LightsDriver_LinuxSerial.cpp
+27 -27
View File
@@ -20,13 +20,14 @@
#include <string.h> #include <string.h>
#include <errno.h> #include <errno.h>
#include "RageLog.h" #include "RageLog.h"
#include "RageTimer.h"
static int fd = 0; static int fd = -1;
void WriteString( char* sz, int len ) void WriteString( const char *sz, int len )
{ {
int iOut; int iOut;
if (fd < 1) if( fd == -1 )
{ {
LOG->Warn("Lights port is not open\n"); LOG->Warn("Lights port is not open\n");
return; return;
@@ -43,33 +44,35 @@ void WriteString( char* sz, int len )
LightsDriver_LinuxSerial::LightsDriver_LinuxSerial() LightsDriver_LinuxSerial::LightsDriver_LinuxSerial()
{ {
fd = open("/dev/ttyS0", O_RDWR | O_NOCTTY | O_NDELAY); // COM1 fd = open("/dev/ttyS0", O_RDWR | O_NOCTTY); // COM1
if (fd < 0) if (fd < 0)
RageException::Throw( "open error %d %s\n", errno, strerror(errno) ); RageException::Throw( "open error %d %s\n", errno, strerror(errno) );
struct termios my_termios;
tcgetattr(fd, &my_termios);
tcflush(fd, TCIFLUSH); tcflush(fd, TCIFLUSH);
my_termios.c_cflag = B2400 | CS8 |CREAD | CLOCAL | HUPCL; struct termios my_termios;
tcgetattr(fd, &my_termios);
// my_termios.c_iflag = IGNBRK;
// my_termios.c_lflag = 0;
// my_termios.c_oflag = 0;
// my_termios.c_cflag |= CREAD | CLOCAL;
my_termios.c_cflag &= ~CRTSCTS;
my_termios.c_iflag &= ~(IXON | IXOFF | IXANY); /* no flow control */ my_termios.c_iflag &= ~(IXON | IXOFF | IXANY); /* no flow control */
my_termios.c_oflag &= ~(IXON | IXOFF | IXANY); /* no flow control */ // my_termios.sg_ispeed = my_termios.sg_ispeed = B2400;
fcntl(fd, F_SETFL, 0);
// my_termios.c_cflag = B2400 | CS8 | CREAD | CLOCAL | HUPCL;
// my_termios.c_oflag &= ~0; /* no flow control */
// fcntl(fd, F_SETFL, 0);
cfsetispeed(&my_termios, B2400);
cfsetospeed(&my_termios, B2400); cfsetospeed(&my_termios, B2400);
tcsetattr(fd, TCSANOW, &my_termios); tcsetattr(fd, TCSANOW, &my_termios);
LOG->Info("Lights info:"); LOG->Info("Lights info:");
LOG->Info(" new cflag=%08lx", my_termios.c_cflag); LOG->Info(" new cflag=%08lx", my_termios.c_cflag);
LOG->Info(" new oflag=%08lx", my_termios.c_oflag); LOG->Info(" new oflag=%08lx", my_termios.c_oflag);
LOG->Info(" new iflag=%08lx", my_termios.c_iflag); LOG->Info(" new iflag=%08lx", my_termios.c_iflag);
LOG->Info(" new lflag=%08lx", my_termios.c_lflag); LOG->Info(" new lflag=%08lx", my_termios.c_lflag);
// c_line dosen't seem to be defined in every termios.h file
// Is it really needed in info?
#if 0
LOG->Info(" new line=%02x", my_termios.c_line);
#endif
} }
LightsDriver_LinuxSerial::~LightsDriver_LinuxSerial() LightsDriver_LinuxSerial::~LightsDriver_LinuxSerial()
@@ -98,27 +101,24 @@ void LightsDriver_LinuxSerial::SetLight( Light light, bool bOn )
void LightsDriver_LinuxSerial::Flush() void LightsDriver_LinuxSerial::Flush()
{ {
// temp HACK: only write once every 30 times // temp HACK: only write once every 30 times
static int counter = 0; static RageTimer tm;
if( counter < 30 ) if( tm.PeekDeltaTime() < 0.02f )
{
counter++;
return; return;
} tm.Touch();
else
{
counter = 0;
// fall through and write
}
LOG->Trace( "Entering LightsDriver_LinuxSerial::Flush()" ); // LOG->Trace( "Entering LightsDriver_LinuxSerial::Flush()" );
char temp_data_to_write[2+NUM_DATA_BYTES] = ""; char temp_data_to_write[2+NUM_DATA_BYTES] = "";
temp_data_to_write[0] = 'Y'; temp_data_to_write[0] = 'Y';
temp_data_to_write[1] = 'o'; temp_data_to_write[1] = 'o';
for( int i=0; i<NUM_DATA_BYTES; i++ ) for( int i=0; i<NUM_DATA_BYTES; i++ )
temp_data_to_write[2+i] = ~g_data[i]; // flip bits so that 0=on, 1=off. temp_data_to_write[2+i] = ~g_data[i]; // flip bits so that 0=on, 1=off.
RageTimer testing;
WriteString( temp_data_to_write, sizeof(temp_data_to_write) ); WriteString( temp_data_to_write, sizeof(temp_data_to_write) );
if( testing.PeekDeltaTime() > 0.1f )
LOG->Warn("WriteString took %F", testing.GetDeltaTime());
LOG->Trace( "Leaving LightsDriver_LinuxSerial::Flush()" ); // LOG->Trace( "Leaving LightsDriver_LinuxSerial::Flush()" );
} }