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
|
/******************************************************************************
* Copyright (c) 2013 IBM Corporation
* All rights reserved.
* This program and the accompanying materials
* are made available under the terms of the BSD License
* which accompanies this distribution, and is available at
* http://www.opensource.org/licenses/bsd-license.php
*
* Contributors:
* IBM Corporation - initial implementation
*****************************************************************************/
/*
* All functions concerning interface to slof
*/
#include <string.h>
#include "helpers.h"
#include "usb-core.h"
#include "paflof.h"
#undef SLOF_DEBUG
//#define SLOF_DEBUG
#ifdef SLOF_DEBUG
#define dprintf(_x ...) do { printf(_x); } while(0)
#else
#define dprintf(_x ...)
#endif
static int slof_usb_handle(struct usb_dev *dev)
{
struct slof_usb_dev sdev;
sdev.port = dev->port;
sdev.addr = dev->addr;
sdev.hcitype = dev->hcidev->type;
sdev.num = dev->hcidev->num;
sdev.udev = dev;
if (dev->class == DEV_HID_KEYB) {
dprintf("Keyboard %ld %ld\n", dev->hcidev->type, dev->hcidev->num);
sdev.devtype = DEVICE_KEYBOARD;
forth_push((long)&sdev);
forth_eval("s\" dev-keyb.fs\" INCLUDED");
} else if (dev->class == DEV_HID_MOUSE) {
dprintf("Mouse %ld %ld\n", dev->hcidev->type, dev->hcidev->num);
sdev.devtype = DEVICE_MOUSE;
forth_push((long)&sdev);
forth_eval("s\" dev-mouse.fs\" INCLUDED");
} else if ((dev->class >> 16 & 0xFF) == 8) {
dprintf("MASS Storage device %ld %ld\n", dev->hcidev->type, dev->hcidev->num);
sdev.devtype = DEVICE_DISK;
forth_push((long)&sdev);
forth_eval("s\" dev-storage.fs\" INCLUDED");
} else if (dev->class == DEV_HUB) {
dprintf("Generic hub device %ld %ld\n", dev->hcidev->type,
dev->hcidev->num);
sdev.devtype = DEVICE_HUB;
forth_push((long)&sdev);
forth_eval("s\" dev-hub.fs\" INCLUDED");
}
return true;
}
void usb_slof_populate_new_device(struct usb_dev *dev)
{
switch (usb_get_intf_class(dev->class)) {
case 3:
dprintf("HID found %06X\n", dev->class);
slof_usb_handle(dev);
break;
case 8:
dprintf("MASS STORAGE found %d %06X\n", dev->intf_num,
dev->class);
if ((dev->class & 0x50) != 0x50) { /* Bulk-only supported */
printf("Device not supported %06X\n", dev->class);
break;
}
if (!usb_msc_reset(dev)) {
printf("%s: bulk reset failed\n", __func__);
break;
}
SLOF_msleep(100);
slof_usb_handle(dev);
break;
case 9:
dprintf("HUB found\n");
slof_usb_handle(dev);
break;
default:
printf("USB Interface class -%x- Not supported\n", dev->class);
break;
}
}
|
