188 lines
3.5 KiB
C
188 lines
3.5 KiB
C
/*
|
|
* pccardd UNIX-domain socket interface
|
|
* Copyright (C) 1996 by Tatsumi Hosokawa <hosokawa@mt.cs.keio.ac.jp>
|
|
*
|
|
* $Id: server.c,v 1.3 1999/02/07 08:02:44 kuriyama Exp $
|
|
*/
|
|
|
|
#ifndef lint
|
|
static const char rcsid[] =
|
|
"$FreeBSD$";
|
|
#endif /* not lint */
|
|
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <sys/types.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/un.h>
|
|
#include <signal.h>
|
|
#include <setjmp.h>
|
|
|
|
#include "cardd.h"
|
|
|
|
static void
|
|
cardnum(char *buf)
|
|
{
|
|
int i = 0;
|
|
struct slot *sp;
|
|
|
|
for (sp = slots; sp; sp = sp->next)
|
|
i++;
|
|
if (i > MAXSLOT)
|
|
i = MAXSLOT;
|
|
sprintf(buf, "%2d", i);
|
|
}
|
|
|
|
static struct slot *
|
|
find_slot(int slot)
|
|
{
|
|
struct slot *sp;
|
|
|
|
/* Search the list until we find the slot or get to the end */
|
|
for (sp = slots; sp && sp->slot != slot; sp = sp->next)
|
|
continue;
|
|
|
|
return ( sp );
|
|
}
|
|
|
|
static void
|
|
cardname(char *buf, int slot)
|
|
{
|
|
struct slot *sp;
|
|
char *manuf, *vers, *drv, *stat;
|
|
|
|
/* Look for the slot */
|
|
if ( (sp = find_slot(slot)) == NULL)
|
|
return;
|
|
|
|
/* Fill in the information in the buff */
|
|
if (sp->cis) {
|
|
|
|
manuf = sp->cis->manuf;
|
|
vers = sp->cis->vers;
|
|
if (sp->config && sp->config->driver &&
|
|
sp->config->driver->name)
|
|
drv = sp->config->driver->name;
|
|
else
|
|
drv = "";
|
|
} else
|
|
manuf = vers = drv = "";
|
|
|
|
switch (sp->state) {
|
|
case empty:
|
|
stat = "0";
|
|
break;
|
|
case filled:
|
|
stat = "1";
|
|
break;
|
|
case inactive:
|
|
stat = "2";
|
|
break;
|
|
default:
|
|
stat = "9";
|
|
}
|
|
sprintf(buf, "%d~%s~%s~%s~%s", slot, manuf, vers, drv, stat);
|
|
}
|
|
|
|
static void
|
|
cardpwr(int slot, int pwon)
|
|
{
|
|
struct slot *sp;
|
|
|
|
/* Look for the slot */
|
|
if ( (sp = find_slot(slot)) == NULL)
|
|
return;
|
|
|
|
if (ioctl(sp->fd, PIOCSVIR, &pwon) < 0)
|
|
logerr("invaild arguments for cardpwr");
|
|
}
|
|
|
|
static int sock = 0;
|
|
static int slen = 0;
|
|
static struct sockaddr_un sun;
|
|
|
|
void
|
|
set_socket(int s)
|
|
{
|
|
sock = s;
|
|
}
|
|
|
|
void
|
|
stat_changed(struct slot *sp)
|
|
{
|
|
int len;
|
|
char buf[512];
|
|
|
|
if (!slen)
|
|
return;
|
|
|
|
cardname(buf, sp->slot);
|
|
len = strlen(buf);
|
|
if (sendto(sock, buf, len, 0, (struct sockaddr *) & sun, slen) != len) {
|
|
logerr("sendto failed");
|
|
slen = 0;
|
|
}
|
|
}
|
|
|
|
void
|
|
process_client(void)
|
|
{
|
|
char buf[512], obuf[512];
|
|
int len;
|
|
int snum;
|
|
|
|
if (!sock)
|
|
return;
|
|
slen = sizeof(sun);
|
|
len = recvfrom(sock, buf, sizeof(buf),
|
|
0, (struct sockaddr *)&sun, &slen);
|
|
if (len < 0)
|
|
logerr("recvfrom failed");
|
|
buf[len] = '\0';
|
|
obuf[0] = '\0';
|
|
switch (buf[0]) { /* Protocol implementation */
|
|
case 'S': /* How many slots? */
|
|
cardnum(obuf);
|
|
break;
|
|
case 'N': /* Card name request */
|
|
sscanf(buf + 1, "%d", &snum);
|
|
if (snum >= 0 && snum <= MAXSLOT)
|
|
cardname(obuf, snum);
|
|
else
|
|
logerr("Illegal slot requests for N command");
|
|
break;
|
|
case 'P': /* Virtual insertion request */
|
|
sscanf(buf + 1, "%d", &snum);
|
|
if (snum >= 0 && snum <= MAXSLOT) {
|
|
logmsg("slot %d: spring has come", snum);
|
|
cardpwr(snum, 1);
|
|
} else
|
|
logerr("Illegal slot requests for P command");
|
|
break;
|
|
case 'Q': /* Virtual removal request */
|
|
sscanf(buf + 1, "%d", &snum);
|
|
if (snum >= 0 && snum <= MAXSLOT) {
|
|
logmsg("slot %d: hibernation", snum);
|
|
cardpwr(snum, 0);
|
|
} else
|
|
logerr("Illegal slot requests for Q command");
|
|
break;
|
|
default:
|
|
logerr("Unknown control message from socket");
|
|
break;
|
|
}
|
|
len = strlen(obuf);
|
|
if (len) {
|
|
if (sendto(sock, obuf, len, 0, (struct sockaddr *)&sun, slen)
|
|
!= len) {
|
|
logerr("sendto failed");
|
|
slen = 0;
|
|
}
|
|
} else if (sendto(sock, 0, 0, 0, (struct sockaddr *)&sun, slen)
|
|
!= len) {
|
|
logerr("sendto failed");
|
|
slen = 0;
|
|
}
|
|
}
|