-
Notifications
You must be signed in to change notification settings - Fork 1
/
mausb_core.c
197 lines (160 loc) · 5.04 KB
/
mausb_core.c
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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 - 2020 DisplayLink (UK) Ltd.
*/
#include <linux/module.h>
#include "hcd.h"
#include "mausb_address.h"
#include "utils.h"
MODULE_LICENSE("GPL");
MODULE_AUTHOR("DisplayLink (UK) Ltd.");
#ifdef DKMS_BUILD
MODULE_VERSION(MAUSB_DRIVER_VERSION);
#endif
static struct mausb_device_address device_address;
static int mausb_device_disconnect_param;
static u16 madev_addr;
static u8 mausb_client_connect_param;
static u8 mausb_client_disconnect_param;
static int mausb_client_connect(const char *value,
const struct kernel_param *kp)
{
unsigned long flags;
spin_lock_irqsave(&mss.lock, flags);
if (mss.client_connected) {
dev_err(mausb_host_dev.this_device, "MA-USB client is already connected");
spin_unlock_irqrestore(&mss.lock, flags);
return -EEXIST;
}
/* Save heartbeat client information */
mss.client_connected = true;
mss.missed_heartbeats = 0;
reinit_completion(&mss.client_stopped);
spin_unlock_irqrestore(&mss.lock, flags);
/* Start hearbeat timer */
mod_timer(&mss.heartbeat_timer,
jiffies + msecs_to_jiffies(MAUSB_HEARTBEAT_TIMEOUT_MS));
return 0;
}
static int mausb_client_disconnect(const char *value,
const struct kernel_param *kp)
{
unsigned long flags;
struct mausb_device *dev = NULL;
spin_lock_irqsave(&mss.lock, flags);
if (!mss.client_connected) {
dev_err(mausb_host_dev.this_device, "MA-USB client is not connected");
spin_unlock_irqrestore(&mss.lock, flags);
return -ENODEV;
}
spin_unlock_irqrestore(&mss.lock, flags);
/* Stop heartbeat timer */
del_timer_sync(&mss.heartbeat_timer);
/* Clear heartbeat client information */
spin_lock_irqsave(&mss.lock, flags);
mss.client_connected = false;
mss.missed_heartbeats = 0;
list_for_each_entry(dev, &mss.madev_list, list_entry) {
dev_vdbg(mausb_host_dev.this_device, "Enqueue heartbeat_work madev_addr=%x",
dev->madev_addr);
queue_work(dev->workq, &dev->heartbeat_work);
}
complete(&mss.client_stopped);
spin_unlock_irqrestore(&mss.lock, flags);
return 0;
}
static int mausb_device_connect(const char *value,
const struct kernel_param *kp)
{
int status = 0;
if (!value)
return -EINVAL;
if (strlen(value) <= INET6_ADDRSTRLEN) {
strcpy(device_address.ip.address, value);
dev_info(mausb_host_dev.this_device, "Processing '%s' address",
device_address.ip.address);
} else {
dev_err(mausb_host_dev.this_device, "Invalid IP format");
return 0;
}
status = mausb_initiate_dev_connection(device_address, madev_addr);
memset(&device_address, 0, sizeof(device_address));
return status;
}
static int mausb_device_disconnect(const char *value,
const struct kernel_param *kp)
{
u8 dev_address = 0;
int status = 0;
unsigned long flags;
struct mausb_device *dev = NULL;
if (!value)
return -EINVAL;
status = kstrtou8(value, 0, &dev_address);
if (status < 0)
return -EINVAL;
spin_lock_irqsave(&mss.lock, flags);
dev = mausb_get_dev_from_addr_unsafe(dev_address);
if (dev)
queue_work(dev->workq, &dev->hcd_disconnect_work);
spin_unlock_irqrestore(&mss.lock, flags);
return 0;
}
static const struct kernel_param_ops mausb_device_connect_ops = {
.set = mausb_device_connect
};
static const struct kernel_param_ops mausb_device_disconnect_ops = {
.set = mausb_device_disconnect
};
static const struct kernel_param_ops mausb_client_connect_ops = {
.set = mausb_client_connect
};
static const struct kernel_param_ops mausb_client_disconnect_ops = {
.set = mausb_client_disconnect
};
module_param_named(mgmt, device_address.ip.port.management, ushort, 0664);
MODULE_PARM_DESC(mgmt, "MA-USB management port");
module_param_named(ctrl, device_address.ip.port.control, ushort, 0664);
MODULE_PARM_DESC(ctrl, "MA-USB control port");
module_param_named(bulk, device_address.ip.port.bulk, ushort, 0664);
MODULE_PARM_DESC(bulk, "MA-USB bulk port");
module_param_named(isoch, device_address.ip.port.isochronous, ushort, 0664);
MODULE_PARM_DESC(isoch, "MA-USB isochronous port");
module_param_named(madev_addr, madev_addr, ushort, 0664);
MODULE_PARM_DESC(madev_addr, "MA-USB device address");
module_param_cb(client_connect, &mausb_client_connect_ops,
&mausb_client_connect_param, 0664);
module_param_cb(client_disconnect, &mausb_client_disconnect_ops,
&mausb_client_disconnect_param, 0664);
module_param_cb(ip, &mausb_device_connect_ops,
device_address.ip.address, 0664);
module_param_cb(disconnect, &mausb_device_disconnect_ops,
&mausb_device_disconnect_param, 0664);
static int mausb_host_init(void)
{
int status = mausb_host_dev_register();
if (status < 0)
return status;
status = mausb_host_driver_init();
if (status < 0)
goto cleanup_dev;
status = mausb_register_power_state_listener();
if (status < 0)
goto cleanup;
mausb_initialize_mss();
return 0;
cleanup:
mausb_host_driver_deinit();
cleanup_dev:
mausb_host_dev_deregister();
return status;
}
static void mausb_host_exit(void)
{
mausb_unregister_power_state_listener();
mausb_deinitialize_mss();
mausb_host_driver_deinit();
mausb_host_dev_deregister();
}
module_init(mausb_host_init);
module_exit(mausb_host_exit);