d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Change API of FW_GDEVLST ioctl.

Browse Source 
- include information about itself.
- define struct fw_devinfo and use it in struct fw_devlstreq.
- unify EUI64 representation using struct fw_eui64.
This commit is contained in:
simokawa 2003-01-25 14:47:33 +00:00
parent bd84d01eea
commit ea028a97ec
6 changed files with 92 additions and 68 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
sys/dev/firewire/firewire.h
View File

@ -310,6 +310,11 @@ struct fw_pkt {
struct fw_eui64 {
u_int32_t hi, lo;
};
#define FW_EUI64_BYTE(eui, x) \
((((x)<4)? \
((eui)->hi >> (8*(3-(x)))): \
((eui)->lo >> (8*(7-(x)))) \
) & 0xff)
struct fw_asyreq {
struct fw_asyreq_t{
@ -328,11 +333,17 @@ struct fw_asyreq {
u_int32_t data[512];
};
struct fw_devinfo {
struct fw_eui64 eui;
u_int16_t dst;
u_int16_t status;
};
#define FW_MAX_DEVLST 70
struct fw_devlstreq {
int n;
struct fw_eui64 eui[64];
u_int16_t dst[64];
u_int16_t status[64];
u_int16_t n;
u_int16_t info_len;
struct fw_devinfo dev[FW_MAX_DEVLST];
};
#define FW_SELF_ID_PORT_CONNECTED_TO_CHILD 3
@ -430,11 +441,6 @@ struct fw_speed_map {
u_int8_t speed[64][64];
};
struct fw_map_buf {
int len;
void *ptr;
};
struct fw_crom_buf {
struct fw_eui64 eui;
int len;

2
sys/dev/firewire/firewirereg.h
View File

@ -135,7 +135,7 @@ struct firewire_comm{
#define FWBUSEXPDONE 7
#define FWBUSCOMPLETION 10
int nisodma;
u_int8_t eui[8];
struct fw_eui64 eui;
STAILQ_HEAD(fw_queue, fw_xfer);
struct fw_xferq
*arq, *atq, *ars, *ats, *it[FW_MAX_DMACH],*ir[FW_MAX_DMACH];

30
sys/dev/firewire/fwdev.c
View File

@ -531,15 +531,13 @@ fw_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, fw_proc *td)
struct fw_xferq *ir, *it;
struct fw_xfer *xfer;
struct fw_pkt *fp;
struct fw_devinfo *devinfo;
struct fw_devlstreq *fwdevlst = (struct fw_devlstreq *)data;
struct fw_asyreq *asyreq = (struct fw_asyreq *)data;
struct fw_isochreq *ichreq = (struct fw_isochreq *)data;
struct fw_isobufreq *ibufreq = (struct fw_isobufreq *)data;
struct fw_asybindreq *bindreq = (struct fw_asybindreq *)data;
#if 0
struct fw_map_buf *map_buf = (struct fw_map_buf *)data;
#endif
struct fw_crom_buf *crom_buf = (struct fw_crom_buf *)data;
if (DEV_FWMEM(dev))
@ -842,19 +840,27 @@ fw_ioctl (dev_t dev, u_long cmd, caddr_t data, int flag, fw_proc *td)
err = fw_bindadd(sc->fc, fwb);
break;
case FW_GDEVLST:
i = 0;
for(fwdev = TAILQ_FIRST(&sc->fc->devices); fwdev != NULL;
fwdev = TAILQ_NEXT(fwdev, link)){
if(i < fwdevlst->n){
fwdevlst->dst[i] = fwdev->dst;
fwdevlst->status[i] =
(fwdev->status == FWDEVATTACHED)?1:0;
fwdevlst->eui[i].hi = fwdev->eui.hi;
fwdevlst->eui[i].lo = fwdev->eui.lo;
i = len = 1;
/* myself */
devinfo = &fwdevlst->dev[0];
devinfo->dst = sc->fc->nodeid;
devinfo->status = 0; /* XXX */
devinfo->eui.hi = sc->fc->eui.hi;
devinfo->eui.lo = sc->fc->eui.lo;
for (fwdev = TAILQ_FIRST(&sc->fc->devices); fwdev != NULL;
fwdev = TAILQ_NEXT(fwdev, link)) {
if(len < FW_MAX_DEVLST){
devinfo = &fwdevlst->dev[len++];
devinfo->dst = fwdev->dst;
devinfo->status =
(fwdev->status == FWDEVINVAL)?0:1;
devinfo->eui.hi = fwdev->eui.hi;
devinfo->eui.lo = fwdev->eui.lo;
}
i++;
}
fwdevlst->n = i;
fwdevlst->info_len = len;
break;
case FW_GTPMAP:
bcopy(sc->fc->topology_map, data,

19
sys/dev/firewire/fwohci.c
View File

@ -579,6 +579,7 @@ fwohci_init(struct fwohci_softc *sc, device_t dev)
{
int i;
u_int32_t reg;
u_int8_t ui[8];
reg = OREAD(sc, OHCI_VERSION);
device_printf(dev, "OHCI version %x.%x (ROM=%d)\n",
@ -682,19 +683,13 @@ fwohci_init(struct fwohci_softc *sc, device_t dev)
if ((sc->atrs.flags & FWOHCI_DBCH_INIT) == 0)
return ENOMEM;
reg = OREAD(sc, FWOHCIGUID_H);
for( i = 0 ; i < 4 ; i ++){
sc->fc.eui[3 - i] = reg & 0xff;
reg = reg >> 8;
}
reg = OREAD(sc, FWOHCIGUID_L);
for( i = 0 ; i < 4 ; i ++){
sc->fc.eui[7 - i] = reg & 0xff;
reg = reg >> 8;
}
sc->fc.eui.hi = OREAD(sc, FWOHCIGUID_H);
sc->fc.eui.lo = OREAD(sc, FWOHCIGUID_L);
for( i = 0 ; i < 8 ; i ++)
ui[i] = FW_EUI64_BYTE(&sc->fc.eui,i);
device_printf(dev, "EUI64 %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n",
sc->fc.eui[0], sc->fc.eui[1], sc->fc.eui[2], sc->fc.eui[3],
sc->fc.eui[4], sc->fc.eui[5], sc->fc.eui[6], sc->fc.eui[7]);
ui[0], ui[1], ui[2], ui[3], ui[4], ui[5], ui[6], ui[7]);
sc->fc.ioctl = fwohci_ioctl;
sc->fc.cyctimer = fwohci_cyctimer;
sc->fc.set_bmr = fwohci_set_bus_manager;

15
sys/dev/firewire/if_fwe.c
View File

@ -146,6 +146,7 @@ fwe_attach(device_t dev)
struct ifnet *ifp;
int unit, s;
u_char *eaddr;
struct fw_eui64 *eui;
fwe = ((struct fwe_softc *)device_get_softc(dev));
unit = device_get_unit(dev);
@ -168,12 +169,14 @@ fwe_attach(device_t dev)
#define LOCAL (0x02)
#define GROUP (0x01)
eaddr = &fwe->eth_softc.arpcom.ac_enaddr[0];
eaddr[0] = (fwe->fd.fc->eui[0] | LOCAL) & ~GROUP;
eaddr[1] = fwe->fd.fc->eui[1];
eaddr[2] = fwe->fd.fc->eui[2];
eaddr[3] = fwe->fd.fc->eui[5];
eaddr[4] = fwe->fd.fc->eui[6];
eaddr[5] = fwe->fd.fc->eui[7];
eui = &fwe->fd.fc->eui;
eaddr[0] = (FW_EUI64_BYTE(eui, 0) | LOCAL) & ~GROUP;
eaddr[1] = FW_EUI64_BYTE(eui, 1);
eaddr[2] = FW_EUI64_BYTE(eui, 2);
eaddr[3] = FW_EUI64_BYTE(eui, 5);
eaddr[4] = FW_EUI64_BYTE(eui, 6);
eaddr[5] = FW_EUI64_BYTE(eui, 7);
printf("if_fwe%d: Fake Ethernet address: "
"%02x:%02x:%02x:%02x:%02x:%02x\n", unit,
eaddr[0], eaddr[1], eaddr[2], eaddr[3], eaddr[4], eaddr[5]);

70
usr.sbin/fwcontrol/fwcontrol.c
View File

@ -72,32 +72,40 @@ usage(void)
exit(0);
}
static void
get_num_of_dev(int fd, struct fw_devlstreq *data)
static struct fw_devlstreq *
get_dev(int fd)
{
data->n = 64;
struct fw_devlstreq *data;
data = (struct fw_devlstreq *)malloc(sizeof(struct fw_devlstreq));
if (data == NULL)
err(1, "malloc");
if( ioctl(fd, FW_GDEVLST, data) < 0) {
err(1, "ioctl");
}
return data;
}
static void
list_dev(int fd)
{
struct fw_devlstreq data;
struct fw_devlstreq *data;
struct fw_devinfo *devinfo;
int i;
get_num_of_dev(fd, &data);
printf("%d devices\n", data.n);
for (i = 0; i < data.n; i++) {
data = get_dev(fd);
printf("%d devices (info_len=%d)\n", data->n, data->info_len);
for (i = 0; i < data->info_len; i++) {
devinfo = &data->dev[i];
printf("%d node %d eui:%08x%08x status:%d\n",
i,
data.dst[i],
data.eui[i].hi,
data.eui[i].lo,
data.status[i]
devinfo->dst,
devinfo->eui.hi,
devinfo->eui.lo,
devinfo->status
);
}
free((void *)data);
}
static u_int32_t
@ -165,29 +173,32 @@ send_phy_config(int fd, int root_node, int gap_count)
static void
set_pri_req(int fd, int pri_req)
{
struct fw_devlstreq data;
struct fw_devlstreq *data;
struct fw_devinfo *devinfo;
u_int32_t max, reg, old;
int i;
get_num_of_dev(fd, &data);
data = get_dev(fd);
#define BUGET_REG 0xf0000218
for (i = 0; i < data.n; i++) {
if (!data.status[i])
for (i = 0; i < data->info_len; i++) {
devinfo = &data->dev[i];
if (!devinfo->status)
continue;
reg = read_write_quad(fd, data.eui[i], BUGET_REG, 1, 0);
reg = read_write_quad(fd, devinfo->eui, BUGET_REG, 1, 0);
printf("%d %08x:%08x, %08x",
data.dst[i], data.eui[i].hi, data.eui[i].lo, reg);
devinfo->dst, devinfo->eui.hi, devinfo->eui.lo, reg);
if (reg > 0 && pri_req >= 0) {
old = (reg & 0x3f);
max = (reg & 0x3f00) >> 8;
if (pri_req > max)
pri_req = max;
printf(" 0x%x -> 0x%x\n", old, pri_req);
read_write_quad(fd, data.eui[i], BUGET_REG, 0, pri_req);
read_write_quad(fd, devinfo->eui, BUGET_REG, 0, pri_req);
} else {
printf("\n");
}
}
free((void *)data);
}
static void
@ -204,26 +215,29 @@ static int
get_crom(int fd, int node, void *crom_buf, int len)
{
struct fw_crom_buf buf;
int i, error;
struct fw_devlstreq data;
int i, n, error;
struct fw_devlstreq *data;
get_num_of_dev(fd, &data);
data = get_dev(fd);
for (i = 0; i < data.n; i++) {
if (data.dst[i] == node && data.eui[i].lo != 0)
for (i = 0; i < data->info_len; i++) {
if (data->dev[i].dst == node && data->dev[i].eui.lo != 0)
break;
}
if (i != data.n) {
buf.eui = data.eui[i];
} else {
err(1, "no such node: %d\n", node);
}
if (i == data->info_len)
errx(1, "no such node %d.", node);
else if (i == 0)
errx(1, "node %d is myself.", node);
else
buf.eui = data->dev[i].eui;
free((void *)data);
buf.len = len;
buf.ptr = crom_buf;
if ((error = ioctl(fd, FW_GCROM, &buf)) < 0) {
err(1, "ioctl");
}
return error;
}