#if (defined(__BEOS__) || defined(__HAIKU__))
#include <OS.h>
#endif
#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <fcntl.h>
#include <errno.h>
#include <ctype.h>
#include <stdarg.h>
#include <sys/time.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/wait.h>
#include <sys/stat.h>
#include <pcmcia/version.h>
#include <pcmcia/config.h>
#include <pcmcia/cs_types.h>
#include <pcmcia/cs.h>
#include <pcmcia/cistpl.h>
#include <pcmcia/ds.h>
#ifdef ETC
static char *configpath = ETC;
#else
static char *configpath = "/etc/pcmcia";
#endif
static char *scheme, *stabfile;
#if (!defined(__BEOS__) && !defined(__HAIKU__))
static int major = 0;
static int lookup_dev(char *name)
{
FILE *f;
int n;
char s[32], t[32];
f = fopen("/proc/devices", "r");
if (f == NULL)
return -errno;
while (fgets(s, 32, f) != NULL) {
if (sscanf(s, "%d %s", &n, t) == 2)
if (strcmp(name, t) == 0)
break;
}
fclose(f);
if (strcmp(name, t) == 0)
return n;
else
return -ENODEV;
}
#endif
static int open_sock(int sock)
{
#if (defined(__BEOS__) || defined(__HAIKU__))
char fn[B_OS_NAME_LENGTH];
sprintf(fn, "/dev/bus/pcmcia/sock/%d", sock);
return open(fn, O_RDONLY);
#else
static char *paths[] = {
"/var/lib/pcmcia", "/var/run", "/dev", "/tmp", NULL
};
int fd;
char **p, fn[64];
dev_t dev = makedev(major, sock);
for (p = paths; *p; p++) {
sprintf(fn, "%s/cc-%d", *p, getpid());
if (mknod(fn, (S_IFCHR|S_IREAD|S_IWRITE), dev) == 0) {
fd = open(fn, O_RDONLY);
unlink(fn);
if (fd >= 0)
return fd;
if (errno == ENODEV)
break;
}
}
return -1;
#endif
}
static void print_status(cs_status_t *status)
{
char *v = "5";
if (status->Function == 0) {
printf(" ");
if (status->CardState & CS_EVENT_3VCARD)
v = "3.3";
else if (status->CardState & CS_EVENT_XVCARD)
v = "X.X";
if (status->CardState & CS_EVENT_CB_DETECT)
printf("%sV CardBus card", v);
else if (status->CardState & CS_EVENT_CARD_DETECT)
printf("%sV 16-bit PC Card", v);
else
printf("no card");
if (status->CardState & CS_EVENT_PM_SUSPEND)
printf(" [suspended]");
printf("\n");
}
if ((status->CardState & CS_EVENT_PM_SUSPEND) ||
!(status->CardState & CS_EVENT_CARD_DETECT))
return;
printf(" function %d: ", status->Function);
printf("%s", (status->CardState & CS_EVENT_READY_CHANGE)
? "[ready]" : "[busy]");
if (status->CardState & CS_EVENT_WRITE_PROTECT)
printf(", [wp]");
if (status->CardState & CS_EVENT_BATTERY_DEAD)
printf(", [bat dead]");
if (status->CardState & CS_EVENT_BATTERY_LOW)
printf(", [bat low]");
if (status->CardState & CS_EVENT_REQUEST_ATTENTION)
printf(", [req attn]");
printf("\n");
}
static void print_config(config_info_t *config)
{
if (config->Function == 0) {
printf(" Vcc %.1fV Vpp1 %.1fV Vpp2 %.1fV\n",
config->Vcc/10.0, config->Vpp1/10.0, config->Vpp2/10.0);
if (!(config->Attributes & CONF_VALID_CLIENT))
return;
printf(" interface type is ");
switch (config->IntType) {
case INT_MEMORY:
printf("\"memory-only\"\n"); break;
case INT_MEMORY_AND_IO:
printf("\"memory and I/O\"\n"); break;
case INT_CARDBUS:
printf("\"cardbus\"\n"); break;
}
if (config->AssignedIRQ != 0) {
printf(" irq %d", config->AssignedIRQ);
switch (config->IRQAttributes & IRQ_TYPE) {
case IRQ_TYPE_EXCLUSIVE:
printf(" [exclusive]"); break;
case IRQ_TYPE_TIME:
printf(" [multiplexed]"); break;
case IRQ_TYPE_DYNAMIC_SHARING:
printf(" [shared]"); break;
}
if (config->IRQAttributes & IRQ_PULSE_ALLOCATED)
printf(" [pulse]");
else
printf(" [level]");
if (!(config->Attributes & CONF_ENABLE_IRQ))
printf(" [disabled]");
printf("\n");
}
if (config->Attributes & CONF_ENABLE_DMA)
printf(" DMA mode is enabled\n");
if (config->Attributes & CONF_ENABLE_SPKR)
printf(" speaker output is enabled\n");
}
if (!(config->Attributes & CONF_VALID_CLIENT))
return;
printf(" function %d:\n", config->Function);
if (config->CardValues) {
printf(" config base %#06x\n", config->ConfigBase);
printf(" ");
if (config->CardValues & CV_OPTION_VALUE)
printf(" option 0x%02x", config->Option);
if (config->CardValues & CV_STATUS_VALUE)
printf(" status 0x%02x", config->Status);
if (config->CardValues & CV_PIN_REPLACEMENT)
printf(" pin 0x%02x", config->Pin);
if (config->CardValues & CV_COPY_VALUE)
printf(" copy 0x%02x", config->Copy);
if (config->CardValues & CV_EXT_STATUS)
printf(" ext 0x%02x", config->ExtStatus);
printf("\n");
}
if (config->NumPorts1 > 0) {
printf(" io %#06x-%#06x", config->BasePort1,
config->BasePort1 + config->NumPorts1 - 1);
if (config->IntType == INT_CARDBUS) {
printf(" [32bit]\n");
} else {
if (config->Attributes1 & IO_SHARED)
printf(" [shared]");
if (config->Attributes1 & IO_FORCE_ALIAS_ACCESS)
printf(" [alias]");
switch (config->Attributes1 & IO_DATA_PATH_WIDTH) {
case IO_DATA_PATH_WIDTH_8:
printf(" [8bit]\n"); break;
case IO_DATA_PATH_WIDTH_16:
printf(" [16bit]\n"); break;
case IO_DATA_PATH_WIDTH_AUTO:
printf(" [auto]\n"); break;
}
}
}
if (config->NumPorts2 > 0) {
printf(" io %#06x-%#06x", config->BasePort2,
config->BasePort2 + config->NumPorts2 - 1);
if (config->Attributes2 & IO_SHARED)
printf(" [shared]");
if (config->Attributes2 & IO_FORCE_ALIAS_ACCESS)
printf(" [alias]");
switch (config->Attributes2 & IO_DATA_PATH_WIDTH) {
case IO_DATA_PATH_WIDTH_8:
printf(" [8bit]\n"); break;
case IO_DATA_PATH_WIDTH_16:
printf(" [16bit]\n"); break;
case IO_DATA_PATH_WIDTH_AUTO:
printf(" [auto]\n"); break;
}
}
}
static void print_windows(int fd)
{
ds_ioctl_arg_t arg1, arg2;
int ret;
win_req_t *win = &arg1.win_info.window;
memreq_t *req = &arg2.win_info.map;
ret = ioctl(fd, DS_GET_FIRST_WINDOW, &arg1);
while (ret == 0) {
arg2.win_info.handle = arg1.win_info.handle;
ioctl(fd, DS_GET_MEM_PAGE, &arg2);
printf(" memory 0x%04x-0x%04x @ 0x%08lx",
req->CardOffset, req->CardOffset+win->Size-1,
win->Base);
if (win->Attributes & WIN_MEMORY_TYPE_AM)
printf(" [attr]");
if (!(win->Attributes & WIN_ENABLE))
printf(" [disabled]");
if (win->Attributes & WIN_USE_WAIT)
printf(" [wait]");
switch (win->Attributes & WIN_DATA_WIDTH) {
case WIN_DATA_WIDTH_8:
printf(" [8bit]\n"); break;
case WIN_DATA_WIDTH_16:
printf(" [16bit]\n"); break;
case WIN_DATA_WIDTH_32:
printf(" [32bit]\n"); break;
}
ret = ioctl(fd, DS_GET_NEXT_WINDOW, &arg1);
}
}
static int get_tuple(int fd, cisdata_t code, ds_ioctl_arg_t *arg)
{
arg->tuple.DesiredTuple = code;
arg->tuple.Attributes = TUPLE_RETURN_COMMON;
arg->tuple.TupleOffset = 0;
if ((ioctl(fd, DS_GET_FIRST_TUPLE, arg) == 0) &&
(ioctl(fd, DS_GET_TUPLE_DATA, arg) == 0) &&
(ioctl(fd, DS_PARSE_TUPLE, arg) == 0))
return 0;
else
return -1;
}
static void print_ident(int fd)
{
ds_ioctl_arg_t arg;
cistpl_vers_1_t *vers = &arg.tuple_parse.parse.version_1;
cistpl_manfid_t *manfid = &arg.tuple_parse.parse.manfid;
cistpl_funcid_t *funcid = &arg.tuple_parse.parse.funcid;
config_info_t config;
int i;
static char *fn[] = {
"multifunction", "memory", "serial", "parallel",
"fixed disk", "video", "network", "AIMS", "SCSI"
};
if (get_tuple(fd, CISTPL_VERS_1, &arg) == 0) {
printf(" product info: ");
for (i = 0; i < vers->ns; i++)
printf("%s\"%s\"", (i>0) ? ", " : "",
vers->str+vers->ofs[i]);
printf("\n");
} else {
printf(" no product info available\n");
}
if (get_tuple(fd, CISTPL_MANFID, &arg) == 0)
printf(" manfid: 0x%04x, 0x%04x\n",
manfid->manf, manfid->card);
if (get_tuple(fd, CISTPL_FUNCID, &arg) == 0)
printf(" function: %d (%s)\n", funcid->func,
fn[funcid->func]);
config.Function = config.ConfigBase = 0;
if ((ioctl(fd, DS_GET_CONFIGURATION_INFO, &config) == 0) &&
(config.IntType == INT_CARDBUS) && config.ConfigBase)
printf(" PCI id: 0x%04x, 0x%04x\n",
config.ConfigBase & 0xffff,
config.ConfigBase >> 16);
}
static void print_info(int fd)
{
ds_ioctl_arg_t arg;
cistpl_vers_1_t *vers = &arg.tuple_parse.parse.version_1;
cistpl_manfid_t *manfid = &arg.tuple_parse.parse.manfid;
cistpl_funcid_t *funcid = &arg.tuple_parse.parse.funcid;
config_info_t config;
int i;
vers->ns = 0;
get_tuple(fd, CISTPL_VERS_1, &arg);
for (i = 0; i < 4; i++)
printf("PRODID_%d=\"%s\"\n", i+1,
(i < vers->ns) ? vers->str+vers->ofs[i] : "");
*manfid = (cistpl_manfid_t) { 0, 0 };
get_tuple(fd, CISTPL_MANFID, &arg);
printf("MANFID=%04x,%04x\n", manfid->manf, manfid->card);
*funcid = (cistpl_funcid_t) { 0xff, 0xff };
get_tuple(fd, CISTPL_FUNCID, &arg);
printf("FUNCID=%d\n", funcid->func);
config.Function = config.ConfigBase = 0;
}
typedef enum cmd_t {
C_STATUS, C_CONFIG, C_IDENT, C_INFO, C_SUSPEND,
C_RESUME, C_RESET, C_EJECT, C_INSERT
} cmd_t;
static char *cmdname[] = {
"status", "config", "ident", "info", "suspend",
"resume", "reset", "eject", "insert"
};
#define NCMD (sizeof(cmdname)/sizeof(char *))
static int do_cmd(int fd, int cmd)
{
int i, ret;
cs_status_t status;
config_info_t config;
ret = 0;
switch (cmd) {
case C_STATUS:
for (i = 0; i < 4; i++) {
status.Function = i;
if (ioctl(fd, DS_GET_STATUS, &status) == 0)
print_status(&status);
else {
if (i == 0) {
if (errno == ENODEV)
printf(" no card\n");
else
perror("ioctl()");
}
break;
}
}
break;
case C_CONFIG:
for (i = 0; i < 4; i++) {
config.Function = i;
if (ioctl(fd, DS_GET_CONFIGURATION_INFO, &config) == 0)
print_config(&config);
else {
if (i == 0) printf(" not configured\n");
break;
}
print_windows(fd);
}
break;
case C_IDENT:
print_ident(fd);
break;
case C_INFO:
print_info(fd);
break;
case C_SUSPEND:
ret = ioctl(fd, DS_SUSPEND_CARD);
break;
case C_RESUME:
ret = ioctl(fd, DS_RESUME_CARD);
break;
case C_RESET:
ret = ioctl(fd, DS_RESET_CARD);
break;
case C_EJECT:
ret = ioctl(fd, DS_EJECT_CARD);
break;
case C_INSERT:
ret = ioctl(fd, DS_INSERT_CARD);
break;
}
return ret;
}
typedef struct stab_t {
int socket, instance, status;
char class[33], driver[33], dev[33];
} stab_t;
static stab_t stab[256];
static int nstab;
static int fetch_stab(void)
{
char s[133];
FILE *f;
f = fopen(stabfile, "r");
if (f == NULL)
return -1;
for (nstab = 0; fgets(s, 132, f); ) {
if (s[0] != 'S') {
sscanf(s, "%d\t%s\t%s\t%d\t%s",
&stab[nstab].socket, stab[nstab].class,
stab[nstab].driver, &stab[nstab].instance,
stab[nstab].dev);
stab[nstab].status = 0;
nstab++;
}
}
fclose(f);
return 0;
}
#if (!defined(__BEOS__) && !defined(__HAIKU__))
static void eprintf(char *name, char *fmt, ...)
{
va_list args;
char s[32];
va_start(args, fmt);
vsprintf(s, fmt, args);
setenv(name, s, 1);
va_end(args);
}
#endif
static int execute(stab_t *s, char *action, char *scheme)
{
int ret;
char cmd[133];
#if (!defined(__BEOS__) && !defined(__HAIKU__))
eprintf("SOCKET", "%d", s->socket);
eprintf("INSTANCE", "%d", s->instance);
#endif
if (scheme)
sprintf(cmd, "./%s %s %s %s", s->class, action, s->dev, scheme);
else
sprintf(cmd, "./%s %s %s", s->class, action, s->dev);
ret = system(cmd);
if (!WIFEXITED(ret) || WEXITSTATUS(ret))
return -1;
return 0;
}
static int stop_scheme(char *new)
{
int i;
fprintf(stderr, "checking:");
for (i = 0; i < nstab; i++) {
fprintf(stderr, " %s", stab[i].dev);
stab[i].status = execute(stab+i, "cksum", new);
if (stab[i].status &&
(execute(stab+i, "check", NULL) != 0)) break;
}
fprintf(stderr, "\n");
if (i < nstab) {
fprintf(stderr, "Device '%s' busy: scheme unchanged.\n",
stab[i].dev);
return -1;
}
for (i = 0; i < nstab; i++)
if (stab[i].status) execute(stab+i, "stop", NULL);
return 0;
}
static int start_scheme(void)
{
int i, j = 0;
for (i = 0; i < nstab; i++)
if (stab[i].status) j |= execute(stab+i, "start", NULL);
return j;
}
static int do_scheme(char *new)
{
FILE *f;
char old[33];
int i;
f = fopen(scheme, "r");
if (f && fgets(old, 32, f))
old[strlen(old)-1] = '\0';
else
old[0] = '\0';
if (f) fclose(f);
if (new) {
#ifndef UNSAFE_TOOLS
if (getuid() != 0) {
fprintf(stderr, "Only root can select a new scheme.\n");
return -1;
}
#else
setuid(geteuid());
#endif
for (i = 0; i < strlen(new); i++)
if (!isalnum(new[i])) break;
if ((i != strlen(new)) || (strlen(new) < 1) ||
(strlen(new) > 32)) {
fprintf(stderr, "Bad scheme name.\n");
return -1;
}
if (strcmp(old, new) == 0) {
fprintf(stderr, "Scheme unchanged.\n");
return 0;
}
if (chdir(configpath) != 0) {
fprintf(stderr, "Could not change to %s.\n", configpath);
return -1;
}
if ((fetch_stab() == 0) && (stop_scheme(new) != 0))
return -1;
if (old[0])
printf("Changing scheme from '%s' to '%s'...\n", old, new);
else
printf("Changing scheme to '%s'...\n", new);
umask(022);
f = fopen(scheme, "w");
if (f) {
fprintf(f, "%s\n", new);
fclose(f);
} else
perror("Could not set scheme.");
if (start_scheme() != 0)
fprintf(stderr, "Some devices did not start cleanly.\n");
} else {
if (old[0])
printf("Current scheme: '%s'.\n", old);
else
printf("Current scheme: 'default'.\n");
}
return 0;
}
static void usage(char *name)
{
int i;
fprintf(stderr, "usage: %s command [socket #]\n", name);
fprintf(stderr, " or %s [-c configpath] [-f scheme]"
" [-s stab] scheme [name]\n", name);
fprintf(stderr, " commands:");
for (i = 0; i < NCMD; i++)
fprintf(stderr, " %s", cmdname[i]);
fprintf(stderr, "\n");
exit(EXIT_FAILURE);
}
#define MAX_SOCKS 8
int main(int argc, char *argv[])
{
int cmd, fd[MAX_SOCKS], ns, ret, i;
int optch, errflg = 0;
char *s, *opts = (getuid() == 0) ? "Vc:f:s:" : "V";
if (access("/var/lib/pcmcia", R_OK) == 0) {
scheme = "/var/lib/pcmcia/scheme";
stabfile = "/var/lib/pcmcia/stab";
} else {
scheme = "/var/run/pcmcia-scheme";
stabfile = "/var/run/stab";
}
while ((optch = getopt(argc, argv, opts)) != -1) {
switch (optch) {
case 'V':
fprintf(stderr, "cardctl version " CS_PKG_RELEASE "\n");
return 0;
break;
case 'c':
configpath = strdup(optarg); break;
case 'f':
scheme = strdup(optarg); break;
case 's':
stabfile = strdup(optarg); break;
default:
errflg = 1; break;
}
}
if (errflg || (argc == optind) || (argc > optind+2))
usage(argv[0]);
if (geteuid() != 0) {
fprintf(stderr, "cardctl must be setuid root\n");
exit(EXIT_FAILURE);
}
#if (!defined(__BEOS__) && !defined(__HAIKU__))
major = lookup_dev("pcmcia");
if (major < 0) {
if (major == -ENODEV)
fprintf(stderr, "no pcmcia driver in /proc/devices\n");
else
perror("could not open /proc/devices");
exit(EXIT_FAILURE);
}
#endif
if (strcmp(argv[optind], "scheme") == 0) {
#ifndef UNSAFE_TOOLS
setuid(getuid());
#endif
if (do_scheme((argc == optind+1) ? NULL : argv[optind+1]) == 0)
exit(EXIT_SUCCESS);
else
exit(EXIT_FAILURE);
}
for (cmd = 0; cmd < NCMD; cmd++)
if (strcmp(argv[optind], cmdname[cmd]) == 0) break;
if (cmd == NCMD)
usage(argv[0]);
ret = 0;
if (argc == optind+2) {
ns = strtol(argv[optind+1], &s, 0);
if ((*argv[optind+1] == '\0') || (*s != '\0'))
usage(argv[0]);
fd[0] = open_sock(ns);
if (fd[0] < 0) {
perror("open_sock()");
exit(EXIT_FAILURE);
}
#ifndef UNSAFE_TOOLS
setuid(getuid());
#endif
ret = do_cmd(fd[0], cmd);
if (ret != 0)
perror("ioctl()");
} else {
for (ns = 0; ns < MAX_SOCKS; ns++) {
fd[ns] = open_sock(ns);
if (fd[ns] < 0) break;
}
#ifndef UNSAFE_TOOLS
setuid(getuid());
#endif
if (ns == 0) {
perror("open_sock()");
exit(EXIT_FAILURE);
}
for (ns = 0; (ns < MAX_SOCKS) && (fd[ns] >= 0); ns++) {
if (cmd <= C_IDENT)
printf("Socket %d:\n", ns);
i = do_cmd(fd[ns], cmd);
if ((i != 0) && (errno != ENODEV)) {
perror("ioctl()");
ret = i;
}
}
}
if (ret != 0)
exit(EXIT_FAILURE);
return 0;
}
