1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
|
/* Copyright 1999-2003 Red Hat, Inc.
*
* This software may be freely redistributed under the terms of the GNU
* public license.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
*/
#include <dirent.h>
#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <sys/types.h>
#include "firewire.h"
#include "modules.h"
static void firewireFreeDevice(struct firewireDevice *dev)
{
freeDevice((struct device *) dev);
}
static void firewireWriteDevice(FILE *file, struct firewireDevice *dev)
{
writeDevice(file, (struct device *)dev);
}
static int firewireCompareDevice(struct firewireDevice *dev1, struct firewireDevice *dev2)
{
return compareDevice( (struct device *)dev1, (struct device *)dev2);
}
struct firewireDevice *firewireNewDevice(struct firewireDevice *old)
{
struct firewireDevice *ret;
ret = malloc(sizeof(struct firewireDevice));
memset(ret, '\0', sizeof(struct firewireDevice));
ret = (struct firewireDevice *) newDevice((struct device *) old, (struct device *) ret);
ret->bus = BUS_FIREWIRE;
ret->newDevice = firewireNewDevice;
ret->freeDevice = firewireFreeDevice;
ret->writeDevice = firewireWriteDevice;
ret->compareDevice = firewireCompareDevice;
return ret;
}
struct device *firewireProbe(enum deviceClass probeClass, int probeFlags,
struct device *devlist)
{
struct firewireDevice *fwdev;
int loaded_driver = 0;
if (
(probeClass & CLASS_SCSI)
) {
DIR *dir;
struct dirent *entry;
int fd;
if (!loadModule("ohci1394"))
loaded_driver = 1;
dir = opendir("/sys/bus/ieee1394/devices");
if (!dir)
goto out;
while ((entry = readdir(dir))) {
char path[256];
char *specifier_id, *version;
if (entry->d_name[0] == '.')
continue;
snprintf(path,255,"/sys/bus/ieee1394/devices/%s/specifier_id",entry->d_name);
fd = open(path, O_RDONLY);
if (fd < 0)
continue;
specifier_id = bufFromFd(fd);
specifier_id[strlen(specifier_id) - 1] = '\0';
snprintf(path,255,"/sys/bus/ieee1394/devices/%s/version",entry->d_name);
fd = open(path, O_RDONLY);
if (fd < 0) {
free(specifier_id);
continue;
}
version = bufFromFd(fd);
version[strlen(version) - 1] = '\0';
if (!strcmp(version,"0x010483") &&
!strcmp(specifier_id,"0x00609e")) {
fwdev = firewireNewDevice(NULL);
fwdev->driver = strdup("sbp2");
fwdev->type = CLASS_SCSI;
if (devlist)
fwdev->next = devlist;
snprintf(path,255,"/sys/bus/ieee1394/devices/%s/model_name_kv",entry->d_name);
fd = open(path, O_RDONLY);
if (fd) {
fwdev->desc = bufFromFd(fd);
fwdev->desc[strlen(fwdev->desc) - 1] = '\0';
} else
fwdev->desc = strdup("Generic IEEE-1394 Storage Device");
devlist = (struct device *) fwdev;
}
free(version);
free(specifier_id);
}
}
out:
if (loaded_driver == 1)
removeModule("ohci1394");
return devlist;
}
|
