/dev/ptmxで作成した２つの疑似シリアル間を中継する。
スレーブをオープンするまでループバックしてしまうのが問題。
C言語
#define _XOPEN_SOURCE
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/select.h>
#include <sys/time.h>
#include <sys/types.h>
#include <unistd.h>
static void dump(char *desc, void *data,int len)
{
unsigned char *d = (unsigned char*)data;
int i;
printf("%s ",desc);
for(i=0;i<len;i++)
{
printf("%02x",d[i]);
}
fputs("\n",stdout);
}
int main()
{
unsigned char buf[64*1024];
int fd1;
int fd2;
int m;
int r;
fd_set rdfs;
fd1 = open("/dev/ptmx", O_RDWR | O_NOCTTY);
if(fd1<0)
{
perror("open");
return 1;
}
grantpt(fd1);
unlockpt(fd1);
printf("%s\n", ptsname(fd1));
fd2 = open("/dev/ptmx", O_RDWR | O_NOCTTY);
if(fd2<0)
{
perror("open");
return 1;
}
grantpt(fd2);
unlockpt(fd2);
printf("%s\n", ptsname(fd2));
while(1)
{
m = (fd1 > fd2) ? fd1 : fd2;
FD_ZERO(&rdfs);
FD_SET(fd1, &rdfs);
FD_SET(fd2, &rdfs);
r = select(m+1, &rdfs, NULL, NULL, NULL);
if(r<0)
{
perror("select");
return 1;
}
if(r)
{
if(FD_ISSET(fd1, &rdfs))
{
r = read(fd1, buf, sizeof(buf));
if(r<0)
{
perror("read");
return 1;
}
write(fd2, buf, r);
dump(ptsname(fd1), buf, r);
}
if(FD_ISSET(fd2, &rdfs))
{
r = read(fd2, buf, sizeof(buf));
if(r<0)
{
perror("read");
return 1;
}
write(fd1, buf, r);
dump(ptsname(fd2), buf, r);
}
}
}
return 0;
}
python
import os
import asyncore
import binascii
class SerialEmu(asyncore.file_dispatcher):
def __init__(self):
self.master, self.slave = os.openpty()
self.slave_name = os.ttyname(self.slave)
asyncore.file_dispatcher.__init__(self, self.master)
def handle_read(self):
d = os.read(self.master,2048)
os.write(self.opposite.master,d)
print 'RX %s %s' % (self.slave_name, binascii.b2a_hex(d))
def writable(self):
return False
s1 = SerialEmu()
s2 = SerialEmu()
print s1.slave_name
print s2.slave_name
s1.opposite = s2
s2.opposite = s1
asyncore.loop()
