.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
---|
1 | 2 | /* |
---|
2 | 3 | * ISHTP client driver for HID (ISH) |
---|
3 | 4 | * |
---|
4 | 5 | * Copyright (c) 2014-2016, Intel Corporation. |
---|
5 | | - * |
---|
6 | | - * This program is free software; you can redistribute it and/or modify it |
---|
7 | | - * under the terms and conditions of the GNU General Public License, |
---|
8 | | - * version 2, as published by the Free Software Foundation. |
---|
9 | | - * |
---|
10 | | - * This program is distributed in the hope it will be useful, but WITHOUT |
---|
11 | | - * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
---|
12 | | - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
---|
13 | | - * more details. |
---|
14 | 6 | */ |
---|
15 | 7 | |
---|
16 | 8 | #include <linux/module.h> |
---|
17 | 9 | #include <linux/hid.h> |
---|
| 10 | +#include <linux/intel-ish-client-if.h> |
---|
18 | 11 | #include <linux/sched.h> |
---|
19 | | -#include "ishtp/ishtp-dev.h" |
---|
20 | | -#include "ishtp/client.h" |
---|
21 | 12 | #include "ishtp-hid.h" |
---|
22 | 13 | |
---|
23 | 14 | /* Rx ring buffer pool size */ |
---|
24 | 15 | #define HID_CL_RX_RING_SIZE 32 |
---|
25 | 16 | #define HID_CL_TX_RING_SIZE 16 |
---|
| 17 | + |
---|
| 18 | +#define cl_data_to_dev(client_data) ishtp_device(client_data->cl_device) |
---|
26 | 19 | |
---|
27 | 20 | /** |
---|
28 | 21 | * report_bad_packets() - Report bad packets |
---|
.. | .. |
---|
37 | 30 | size_t cur_pos, size_t payload_len) |
---|
38 | 31 | { |
---|
39 | 32 | struct hostif_msg *recv_msg = recv_buf; |
---|
40 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 33 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
41 | 34 | |
---|
42 | | - dev_err(&client_data->cl_device->dev, "[hid-ish]: BAD packet %02X\n" |
---|
| 35 | + dev_err(cl_data_to_dev(client_data), "[hid-ish]: BAD packet %02X\n" |
---|
43 | 36 | "total_bad=%u cur_pos=%u\n" |
---|
44 | 37 | "[%02X %02X %02X %02X]\n" |
---|
45 | 38 | "payload_len=%u\n" |
---|
.. | .. |
---|
69 | 62 | unsigned char *payload; |
---|
70 | 63 | struct device_info *dev_info; |
---|
71 | 64 | int i, j; |
---|
72 | | - size_t payload_len, total_len, cur_pos; |
---|
| 65 | + size_t payload_len, total_len, cur_pos, raw_len; |
---|
73 | 66 | int report_type; |
---|
74 | 67 | struct report_list *reports_list; |
---|
75 | 68 | char *reports; |
---|
76 | 69 | size_t report_len; |
---|
77 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 70 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
78 | 71 | int curr_hid_dev = client_data->cur_hid_dev; |
---|
| 72 | + struct ishtp_hid_data *hid_data = NULL; |
---|
| 73 | + struct hid_device *hid = NULL; |
---|
79 | 74 | |
---|
80 | 75 | payload = recv_buf + sizeof(struct hostif_msg_hdr); |
---|
81 | 76 | total_len = data_len; |
---|
.. | .. |
---|
83 | 78 | |
---|
84 | 79 | do { |
---|
85 | 80 | if (cur_pos + sizeof(struct hostif_msg) > total_len) { |
---|
86 | | - dev_err(&client_data->cl_device->dev, |
---|
| 81 | + dev_err(cl_data_to_dev(client_data), |
---|
87 | 82 | "[hid-ish]: error, received %u which is less than data header %u\n", |
---|
88 | 83 | (unsigned int)data_len, |
---|
89 | 84 | (unsigned int)sizeof(struct hostif_msg_hdr)); |
---|
90 | 85 | ++client_data->bad_recv_cnt; |
---|
91 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 86 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
92 | 87 | break; |
---|
93 | 88 | } |
---|
94 | 89 | |
---|
.. | .. |
---|
101 | 96 | ++client_data->bad_recv_cnt; |
---|
102 | 97 | report_bad_packet(hid_ishtp_cl, recv_msg, cur_pos, |
---|
103 | 98 | payload_len); |
---|
104 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 99 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
105 | 100 | break; |
---|
106 | 101 | } |
---|
107 | 102 | |
---|
.. | .. |
---|
116 | 111 | report_bad_packet(hid_ishtp_cl, recv_msg, |
---|
117 | 112 | cur_pos, |
---|
118 | 113 | payload_len); |
---|
119 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 114 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
120 | 115 | break; |
---|
121 | 116 | } |
---|
122 | 117 | client_data->hid_dev_count = (unsigned int)*payload; |
---|
123 | 118 | if (!client_data->hid_devices) |
---|
124 | 119 | client_data->hid_devices = devm_kcalloc( |
---|
125 | | - &client_data->cl_device->dev, |
---|
| 120 | + cl_data_to_dev(client_data), |
---|
126 | 121 | client_data->hid_dev_count, |
---|
127 | 122 | sizeof(struct device_info), |
---|
128 | 123 | GFP_KERNEL); |
---|
129 | 124 | if (!client_data->hid_devices) { |
---|
130 | | - dev_err(&client_data->cl_device->dev, |
---|
| 125 | + dev_err(cl_data_to_dev(client_data), |
---|
131 | 126 | "Mem alloc failed for hid device info\n"); |
---|
132 | 127 | wake_up_interruptible(&client_data->init_wait); |
---|
133 | 128 | break; |
---|
.. | .. |
---|
135 | 130 | for (i = 0; i < client_data->hid_dev_count; ++i) { |
---|
136 | 131 | if (1 + sizeof(struct device_info) * i >= |
---|
137 | 132 | payload_len) { |
---|
138 | | - dev_err(&client_data->cl_device->dev, |
---|
| 133 | + dev_err(cl_data_to_dev(client_data), |
---|
139 | 134 | "[hid-ish]: [ENUM_DEVICES]: content size %zu is bigger than payload_len %zu\n", |
---|
140 | 135 | 1 + sizeof(struct device_info) |
---|
141 | 136 | * i, payload_len); |
---|
.. | .. |
---|
165 | 160 | report_bad_packet(hid_ishtp_cl, recv_msg, |
---|
166 | 161 | cur_pos, |
---|
167 | 162 | payload_len); |
---|
168 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 163 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
169 | 164 | break; |
---|
170 | 165 | } |
---|
171 | 166 | if (!client_data->hid_descr[curr_hid_dev]) |
---|
172 | 167 | client_data->hid_descr[curr_hid_dev] = |
---|
173 | | - devm_kmalloc(&client_data->cl_device->dev, |
---|
| 168 | + devm_kmalloc(cl_data_to_dev(client_data), |
---|
174 | 169 | payload_len, GFP_KERNEL); |
---|
175 | 170 | if (client_data->hid_descr[curr_hid_dev]) { |
---|
176 | 171 | memcpy(client_data->hid_descr[curr_hid_dev], |
---|
.. | .. |
---|
190 | 185 | report_bad_packet(hid_ishtp_cl, recv_msg, |
---|
191 | 186 | cur_pos, |
---|
192 | 187 | payload_len); |
---|
193 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 188 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
194 | 189 | break; |
---|
195 | 190 | } |
---|
196 | 191 | if (!client_data->report_descr[curr_hid_dev]) |
---|
197 | 192 | client_data->report_descr[curr_hid_dev] = |
---|
198 | | - devm_kmalloc(&client_data->cl_device->dev, |
---|
| 193 | + devm_kmalloc(cl_data_to_dev(client_data), |
---|
199 | 194 | payload_len, GFP_KERNEL); |
---|
200 | 195 | if (client_data->report_descr[curr_hid_dev]) { |
---|
201 | 196 | memcpy(client_data->report_descr[curr_hid_dev], |
---|
.. | .. |
---|
219 | 214 | /* Get index of device that matches this id */ |
---|
220 | 215 | for (i = 0; i < client_data->num_hid_devices; ++i) { |
---|
221 | 216 | if (recv_msg->hdr.device_id == |
---|
222 | | - client_data->hid_devices[i].dev_id) |
---|
223 | | - if (client_data->hid_sensor_hubs[i]) { |
---|
224 | | - hid_input_report( |
---|
225 | | - client_data->hid_sensor_hubs[ |
---|
226 | | - i], |
---|
227 | | - report_type, payload, |
---|
228 | | - payload_len, 0); |
---|
229 | | - ishtp_hid_wakeup( |
---|
230 | | - client_data->hid_sensor_hubs[ |
---|
231 | | - i]); |
---|
| 217 | + client_data->hid_devices[i].dev_id) { |
---|
| 218 | + hid = client_data->hid_sensor_hubs[i]; |
---|
| 219 | + if (!hid) |
---|
232 | 220 | break; |
---|
| 221 | + |
---|
| 222 | + hid_data = hid->driver_data; |
---|
| 223 | + if (hid_data->raw_get_req) { |
---|
| 224 | + raw_len = |
---|
| 225 | + (hid_data->raw_buf_size < |
---|
| 226 | + payload_len) ? |
---|
| 227 | + hid_data->raw_buf_size : |
---|
| 228 | + payload_len; |
---|
| 229 | + |
---|
| 230 | + memcpy(hid_data->raw_buf, |
---|
| 231 | + payload, raw_len); |
---|
| 232 | + } else { |
---|
| 233 | + hid_input_report |
---|
| 234 | + (hid, report_type, |
---|
| 235 | + payload, payload_len, |
---|
| 236 | + 0); |
---|
233 | 237 | } |
---|
| 238 | + |
---|
| 239 | + ishtp_hid_wakeup(hid); |
---|
| 240 | + break; |
---|
| 241 | + } |
---|
234 | 242 | } |
---|
235 | 243 | break; |
---|
236 | 244 | |
---|
.. | .. |
---|
295 | 303 | ++client_data->bad_recv_cnt; |
---|
296 | 304 | report_bad_packet(hid_ishtp_cl, recv_msg, cur_pos, |
---|
297 | 305 | payload_len); |
---|
298 | | - ish_hw_reset(hid_ishtp_cl->dev); |
---|
| 306 | + ish_hw_reset(ishtp_get_ishtp_device(hid_ishtp_cl)); |
---|
299 | 307 | break; |
---|
300 | 308 | |
---|
301 | 309 | } |
---|
.. | .. |
---|
320 | 328 | */ |
---|
321 | 329 | static void ish_cl_event_cb(struct ishtp_cl_device *device) |
---|
322 | 330 | { |
---|
323 | | - struct ishtp_cl *hid_ishtp_cl = device->driver_data; |
---|
| 331 | + struct ishtp_cl *hid_ishtp_cl = ishtp_get_drvdata(device); |
---|
324 | 332 | struct ishtp_cl_rb *rb_in_proc; |
---|
325 | 333 | size_t r_length; |
---|
326 | | - unsigned long flags; |
---|
327 | 334 | |
---|
328 | 335 | if (!hid_ishtp_cl) |
---|
329 | 336 | return; |
---|
330 | 337 | |
---|
331 | | - spin_lock_irqsave(&hid_ishtp_cl->in_process_spinlock, flags); |
---|
332 | | - while (!list_empty(&hid_ishtp_cl->in_process_list.list)) { |
---|
333 | | - rb_in_proc = list_entry( |
---|
334 | | - hid_ishtp_cl->in_process_list.list.next, |
---|
335 | | - struct ishtp_cl_rb, list); |
---|
336 | | - list_del_init(&rb_in_proc->list); |
---|
337 | | - spin_unlock_irqrestore(&hid_ishtp_cl->in_process_spinlock, |
---|
338 | | - flags); |
---|
339 | | - |
---|
| 338 | + while ((rb_in_proc = ishtp_cl_rx_get_rb(hid_ishtp_cl)) != NULL) { |
---|
340 | 339 | if (!rb_in_proc->buffer.data) |
---|
341 | 340 | return; |
---|
342 | 341 | |
---|
.. | .. |
---|
346 | 345 | process_recv(hid_ishtp_cl, rb_in_proc->buffer.data, r_length); |
---|
347 | 346 | |
---|
348 | 347 | ishtp_cl_io_rb_recycle(rb_in_proc); |
---|
349 | | - spin_lock_irqsave(&hid_ishtp_cl->in_process_spinlock, flags); |
---|
350 | 348 | } |
---|
351 | | - spin_unlock_irqrestore(&hid_ishtp_cl->in_process_spinlock, flags); |
---|
352 | 349 | } |
---|
353 | 350 | |
---|
354 | 351 | /** |
---|
.. | .. |
---|
486 | 483 | static int ishtp_enum_enum_devices(struct ishtp_cl *hid_ishtp_cl) |
---|
487 | 484 | { |
---|
488 | 485 | struct hostif_msg msg; |
---|
489 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 486 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
490 | 487 | int retry_count; |
---|
491 | 488 | int rv; |
---|
492 | 489 | |
---|
.. | .. |
---|
512 | 509 | sizeof(struct hostif_msg)); |
---|
513 | 510 | } |
---|
514 | 511 | if (!client_data->enum_devices_done) { |
---|
515 | | - dev_err(&client_data->cl_device->dev, |
---|
| 512 | + dev_err(cl_data_to_dev(client_data), |
---|
516 | 513 | "[hid-ish]: timed out waiting for enum_devices\n"); |
---|
517 | 514 | return -ETIMEDOUT; |
---|
518 | 515 | } |
---|
519 | 516 | if (!client_data->hid_devices) { |
---|
520 | | - dev_err(&client_data->cl_device->dev, |
---|
| 517 | + dev_err(cl_data_to_dev(client_data), |
---|
521 | 518 | "[hid-ish]: failed to allocate HID dev structures\n"); |
---|
522 | 519 | return -ENOMEM; |
---|
523 | 520 | } |
---|
524 | 521 | |
---|
525 | 522 | client_data->num_hid_devices = client_data->hid_dev_count; |
---|
526 | | - dev_info(&hid_ishtp_cl->device->dev, |
---|
| 523 | + dev_info(ishtp_device(client_data->cl_device), |
---|
527 | 524 | "[hid-ish]: enum_devices_done OK, num_hid_devices=%d\n", |
---|
528 | 525 | client_data->num_hid_devices); |
---|
529 | 526 | |
---|
.. | .. |
---|
542 | 539 | static int ishtp_get_hid_descriptor(struct ishtp_cl *hid_ishtp_cl, int index) |
---|
543 | 540 | { |
---|
544 | 541 | struct hostif_msg msg; |
---|
545 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 542 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
546 | 543 | int rv; |
---|
547 | 544 | |
---|
548 | 545 | /* Get HID descriptor */ |
---|
.. | .. |
---|
560 | 557 | client_data->hid_descr_done, |
---|
561 | 558 | 3 * HZ); |
---|
562 | 559 | if (!client_data->hid_descr_done) { |
---|
563 | | - dev_err(&client_data->cl_device->dev, |
---|
| 560 | + dev_err(cl_data_to_dev(client_data), |
---|
564 | 561 | "[hid-ish]: timed out for hid_descr_done\n"); |
---|
565 | 562 | return -EIO; |
---|
566 | 563 | } |
---|
567 | 564 | |
---|
568 | 565 | if (!client_data->hid_descr[index]) { |
---|
569 | | - dev_err(&client_data->cl_device->dev, |
---|
| 566 | + dev_err(cl_data_to_dev(client_data), |
---|
570 | 567 | "[hid-ish]: allocation HID desc fail\n"); |
---|
571 | 568 | return -ENOMEM; |
---|
572 | 569 | } |
---|
.. | .. |
---|
589 | 586 | int index) |
---|
590 | 587 | { |
---|
591 | 588 | struct hostif_msg msg; |
---|
592 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 589 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
593 | 590 | int rv; |
---|
594 | 591 | |
---|
595 | 592 | /* Get report descriptor */ |
---|
.. | .. |
---|
607 | 604 | client_data->report_descr_done, |
---|
608 | 605 | 3 * HZ); |
---|
609 | 606 | if (!client_data->report_descr_done) { |
---|
610 | | - dev_err(&client_data->cl_device->dev, |
---|
| 607 | + dev_err(cl_data_to_dev(client_data), |
---|
611 | 608 | "[hid-ish]: timed out for report descr\n"); |
---|
612 | 609 | return -EIO; |
---|
613 | 610 | } |
---|
614 | 611 | if (!client_data->report_descr[index]) { |
---|
615 | | - dev_err(&client_data->cl_device->dev, |
---|
| 612 | + dev_err(cl_data_to_dev(client_data), |
---|
616 | 613 | "[hid-ish]: failed to alloc report descr\n"); |
---|
617 | 614 | return -ENOMEM; |
---|
618 | 615 | } |
---|
.. | .. |
---|
637 | 634 | static int hid_ishtp_cl_init(struct ishtp_cl *hid_ishtp_cl, int reset) |
---|
638 | 635 | { |
---|
639 | 636 | struct ishtp_device *dev; |
---|
640 | | - unsigned long flags; |
---|
641 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 637 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
| 638 | + struct ishtp_fw_client *fw_client; |
---|
642 | 639 | int i; |
---|
643 | 640 | int rv; |
---|
644 | 641 | |
---|
645 | | - dev_dbg(&client_data->cl_device->dev, "%s\n", __func__); |
---|
| 642 | + dev_dbg(cl_data_to_dev(client_data), "%s\n", __func__); |
---|
646 | 643 | hid_ishtp_trace(client_data, "%s reset flag: %d\n", __func__, reset); |
---|
647 | 644 | |
---|
648 | | - rv = ishtp_cl_link(hid_ishtp_cl, ISHTP_HOST_CLIENT_ID_ANY); |
---|
| 645 | + rv = ishtp_cl_link(hid_ishtp_cl); |
---|
649 | 646 | if (rv) { |
---|
650 | | - dev_err(&client_data->cl_device->dev, |
---|
| 647 | + dev_err(cl_data_to_dev(client_data), |
---|
651 | 648 | "ishtp_cl_link failed\n"); |
---|
652 | 649 | return -ENOMEM; |
---|
653 | 650 | } |
---|
654 | 651 | |
---|
655 | 652 | client_data->init_done = 0; |
---|
656 | 653 | |
---|
657 | | - dev = hid_ishtp_cl->dev; |
---|
| 654 | + dev = ishtp_get_ishtp_device(hid_ishtp_cl); |
---|
658 | 655 | |
---|
659 | 656 | /* Connect to FW client */ |
---|
660 | | - hid_ishtp_cl->rx_ring_size = HID_CL_RX_RING_SIZE; |
---|
661 | | - hid_ishtp_cl->tx_ring_size = HID_CL_TX_RING_SIZE; |
---|
| 657 | + ishtp_set_tx_ring_size(hid_ishtp_cl, HID_CL_TX_RING_SIZE); |
---|
| 658 | + ishtp_set_rx_ring_size(hid_ishtp_cl, HID_CL_RX_RING_SIZE); |
---|
662 | 659 | |
---|
663 | | - spin_lock_irqsave(&dev->fw_clients_lock, flags); |
---|
664 | | - i = ishtp_fw_cl_by_uuid(dev, &hid_ishtp_guid); |
---|
665 | | - if (i < 0) { |
---|
666 | | - spin_unlock_irqrestore(&dev->fw_clients_lock, flags); |
---|
667 | | - dev_err(&client_data->cl_device->dev, |
---|
| 660 | + fw_client = ishtp_fw_cl_get_client(dev, &hid_ishtp_guid); |
---|
| 661 | + if (!fw_client) { |
---|
| 662 | + dev_err(cl_data_to_dev(client_data), |
---|
668 | 663 | "ish client uuid not found\n"); |
---|
669 | | - return i; |
---|
| 664 | + return -ENOENT; |
---|
670 | 665 | } |
---|
671 | | - hid_ishtp_cl->fw_client_id = dev->fw_clients[i].client_id; |
---|
672 | | - spin_unlock_irqrestore(&dev->fw_clients_lock, flags); |
---|
673 | | - hid_ishtp_cl->state = ISHTP_CL_CONNECTING; |
---|
| 666 | + ishtp_cl_set_fw_client_id(hid_ishtp_cl, |
---|
| 667 | + ishtp_get_fw_client_id(fw_client)); |
---|
| 668 | + ishtp_set_connection_state(hid_ishtp_cl, ISHTP_CL_CONNECTING); |
---|
674 | 669 | |
---|
675 | 670 | rv = ishtp_cl_connect(hid_ishtp_cl); |
---|
676 | 671 | if (rv) { |
---|
677 | | - dev_err(&client_data->cl_device->dev, |
---|
| 672 | + dev_err(cl_data_to_dev(client_data), |
---|
678 | 673 | "client connect fail\n"); |
---|
679 | 674 | goto err_cl_unlink; |
---|
680 | 675 | } |
---|
.. | .. |
---|
682 | 677 | hid_ishtp_trace(client_data, "%s client connected\n", __func__); |
---|
683 | 678 | |
---|
684 | 679 | /* Register read callback */ |
---|
685 | | - ishtp_register_event_cb(hid_ishtp_cl->device, ish_cl_event_cb); |
---|
| 680 | + ishtp_register_event_cb(client_data->cl_device, ish_cl_event_cb); |
---|
686 | 681 | |
---|
687 | 682 | rv = ishtp_enum_enum_devices(hid_ishtp_cl); |
---|
688 | 683 | if (rv) |
---|
.. | .. |
---|
705 | 700 | if (!reset) { |
---|
706 | 701 | rv = ishtp_hid_probe(i, client_data); |
---|
707 | 702 | if (rv) { |
---|
708 | | - dev_err(&client_data->cl_device->dev, |
---|
| 703 | + dev_err(cl_data_to_dev(client_data), |
---|
709 | 704 | "[hid-ish]: HID probe for #%u failed: %d\n", |
---|
710 | 705 | i, rv); |
---|
711 | 706 | goto err_cl_disconnect; |
---|
.. | .. |
---|
720 | 715 | return 0; |
---|
721 | 716 | |
---|
722 | 717 | err_cl_disconnect: |
---|
723 | | - hid_ishtp_cl->state = ISHTP_CL_DISCONNECTING; |
---|
| 718 | + ishtp_set_connection_state(hid_ishtp_cl, ISHTP_CL_DISCONNECTING); |
---|
724 | 719 | ishtp_cl_disconnect(hid_ishtp_cl); |
---|
725 | 720 | err_cl_unlink: |
---|
726 | 721 | ishtp_cl_unlink(hid_ishtp_cl); |
---|
.. | .. |
---|
757 | 752 | |
---|
758 | 753 | hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__, |
---|
759 | 754 | hid_ishtp_cl); |
---|
760 | | - dev_dbg(&cl_device->dev, "%s\n", __func__); |
---|
| 755 | + dev_dbg(ishtp_device(client_data->cl_device), "%s\n", __func__); |
---|
761 | 756 | |
---|
762 | 757 | hid_ishtp_cl_deinit(hid_ishtp_cl); |
---|
763 | 758 | |
---|
764 | | - hid_ishtp_cl = ishtp_cl_allocate(cl_device->ishtp_dev); |
---|
| 759 | + hid_ishtp_cl = ishtp_cl_allocate(cl_device); |
---|
765 | 760 | if (!hid_ishtp_cl) |
---|
766 | 761 | return; |
---|
767 | 762 | |
---|
768 | | - cl_device->driver_data = hid_ishtp_cl; |
---|
769 | | - hid_ishtp_cl->client_data = client_data; |
---|
| 763 | + ishtp_set_drvdata(cl_device, hid_ishtp_cl); |
---|
| 764 | + ishtp_set_client_data(hid_ishtp_cl, client_data); |
---|
770 | 765 | client_data->hid_ishtp_cl = hid_ishtp_cl; |
---|
771 | 766 | |
---|
772 | 767 | client_data->num_hid_devices = 0; |
---|
.. | .. |
---|
775 | 770 | rv = hid_ishtp_cl_init(hid_ishtp_cl, 1); |
---|
776 | 771 | if (!rv) |
---|
777 | 772 | break; |
---|
778 | | - dev_err(&client_data->cl_device->dev, "Retry reset init\n"); |
---|
| 773 | + dev_err(cl_data_to_dev(client_data), "Retry reset init\n"); |
---|
779 | 774 | } |
---|
780 | 775 | if (rv) { |
---|
781 | | - dev_err(&client_data->cl_device->dev, "Reset Failed\n"); |
---|
| 776 | + dev_err(cl_data_to_dev(client_data), "Reset Failed\n"); |
---|
782 | 777 | hid_ishtp_trace(client_data, "%s Failed hid_ishtp_cl %p\n", |
---|
783 | 778 | __func__, hid_ishtp_cl); |
---|
784 | 779 | } |
---|
785 | 780 | } |
---|
| 781 | + |
---|
| 782 | +void (*hid_print_trace)(void *unused, const char *format, ...); |
---|
786 | 783 | |
---|
787 | 784 | /** |
---|
788 | 785 | * hid_ishtp_cl_probe() - ISHTP client driver probe |
---|
.. | .. |
---|
801 | 798 | if (!cl_device) |
---|
802 | 799 | return -ENODEV; |
---|
803 | 800 | |
---|
804 | | - if (uuid_le_cmp(hid_ishtp_guid, |
---|
805 | | - cl_device->fw_client->props.protocol_name) != 0) |
---|
806 | | - return -ENODEV; |
---|
807 | | - |
---|
808 | | - client_data = devm_kzalloc(&cl_device->dev, sizeof(*client_data), |
---|
| 801 | + client_data = devm_kzalloc(ishtp_device(cl_device), |
---|
| 802 | + sizeof(*client_data), |
---|
809 | 803 | GFP_KERNEL); |
---|
810 | 804 | if (!client_data) |
---|
811 | 805 | return -ENOMEM; |
---|
812 | 806 | |
---|
813 | | - hid_ishtp_cl = ishtp_cl_allocate(cl_device->ishtp_dev); |
---|
| 807 | + hid_ishtp_cl = ishtp_cl_allocate(cl_device); |
---|
814 | 808 | if (!hid_ishtp_cl) |
---|
815 | 809 | return -ENOMEM; |
---|
816 | 810 | |
---|
817 | | - cl_device->driver_data = hid_ishtp_cl; |
---|
818 | | - hid_ishtp_cl->client_data = client_data; |
---|
| 811 | + ishtp_set_drvdata(cl_device, hid_ishtp_cl); |
---|
| 812 | + ishtp_set_client_data(hid_ishtp_cl, client_data); |
---|
819 | 813 | client_data->hid_ishtp_cl = hid_ishtp_cl; |
---|
820 | 814 | client_data->cl_device = cl_device; |
---|
821 | 815 | |
---|
.. | .. |
---|
823 | 817 | init_waitqueue_head(&client_data->ishtp_resume_wait); |
---|
824 | 818 | |
---|
825 | 819 | INIT_WORK(&client_data->work, hid_ishtp_cl_reset_handler); |
---|
| 820 | + |
---|
| 821 | + hid_print_trace = ishtp_trace_callback(cl_device); |
---|
826 | 822 | |
---|
827 | 823 | rv = hid_ishtp_cl_init(hid_ishtp_cl, 0); |
---|
828 | 824 | if (rv) { |
---|
.. | .. |
---|
844 | 840 | */ |
---|
845 | 841 | static int hid_ishtp_cl_remove(struct ishtp_cl_device *cl_device) |
---|
846 | 842 | { |
---|
847 | | - struct ishtp_cl *hid_ishtp_cl = cl_device->driver_data; |
---|
848 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 843 | + struct ishtp_cl *hid_ishtp_cl = ishtp_get_drvdata(cl_device); |
---|
| 844 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
849 | 845 | |
---|
850 | 846 | hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__, |
---|
851 | 847 | hid_ishtp_cl); |
---|
852 | 848 | |
---|
853 | | - dev_dbg(&cl_device->dev, "%s\n", __func__); |
---|
854 | | - hid_ishtp_cl->state = ISHTP_CL_DISCONNECTING; |
---|
| 849 | + dev_dbg(ishtp_device(cl_device), "%s\n", __func__); |
---|
| 850 | + ishtp_set_connection_state(hid_ishtp_cl, ISHTP_CL_DISCONNECTING); |
---|
855 | 851 | ishtp_cl_disconnect(hid_ishtp_cl); |
---|
856 | 852 | ishtp_put_device(cl_device); |
---|
857 | 853 | ishtp_hid_remove(client_data); |
---|
.. | .. |
---|
874 | 870 | */ |
---|
875 | 871 | static int hid_ishtp_cl_reset(struct ishtp_cl_device *cl_device) |
---|
876 | 872 | { |
---|
877 | | - struct ishtp_cl *hid_ishtp_cl = cl_device->driver_data; |
---|
878 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 873 | + struct ishtp_cl *hid_ishtp_cl = ishtp_get_drvdata(cl_device); |
---|
| 874 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
879 | 875 | |
---|
880 | 876 | hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__, |
---|
881 | 877 | hid_ishtp_cl); |
---|
.. | .. |
---|
884 | 880 | |
---|
885 | 881 | return 0; |
---|
886 | 882 | } |
---|
887 | | - |
---|
888 | | -#define to_ishtp_cl_device(d) container_of(d, struct ishtp_cl_device, dev) |
---|
889 | 883 | |
---|
890 | 884 | /** |
---|
891 | 885 | * hid_ishtp_cl_suspend() - ISHTP client driver suspend |
---|
.. | .. |
---|
897 | 891 | */ |
---|
898 | 892 | static int hid_ishtp_cl_suspend(struct device *device) |
---|
899 | 893 | { |
---|
900 | | - struct ishtp_cl_device *cl_device = to_ishtp_cl_device(device); |
---|
901 | | - struct ishtp_cl *hid_ishtp_cl = cl_device->driver_data; |
---|
902 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 894 | + struct ishtp_cl_device *cl_device = ishtp_dev_to_cl_device(device); |
---|
| 895 | + struct ishtp_cl *hid_ishtp_cl = ishtp_get_drvdata(cl_device); |
---|
| 896 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
903 | 897 | |
---|
904 | 898 | hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__, |
---|
905 | 899 | hid_ishtp_cl); |
---|
.. | .. |
---|
918 | 912 | */ |
---|
919 | 913 | static int hid_ishtp_cl_resume(struct device *device) |
---|
920 | 914 | { |
---|
921 | | - struct ishtp_cl_device *cl_device = to_ishtp_cl_device(device); |
---|
922 | | - struct ishtp_cl *hid_ishtp_cl = cl_device->driver_data; |
---|
923 | | - struct ishtp_cl_data *client_data = hid_ishtp_cl->client_data; |
---|
| 915 | + struct ishtp_cl_device *cl_device = ishtp_dev_to_cl_device(device); |
---|
| 916 | + struct ishtp_cl *hid_ishtp_cl = ishtp_get_drvdata(cl_device); |
---|
| 917 | + struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl); |
---|
924 | 918 | |
---|
925 | 919 | hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__, |
---|
926 | 920 | hid_ishtp_cl); |
---|
.. | .. |
---|
935 | 929 | |
---|
936 | 930 | static struct ishtp_cl_driver hid_ishtp_cl_driver = { |
---|
937 | 931 | .name = "ish-hid", |
---|
| 932 | + .guid = &hid_ishtp_guid, |
---|
938 | 933 | .probe = hid_ishtp_cl_probe, |
---|
939 | 934 | .remove = hid_ishtp_cl_remove, |
---|
940 | 935 | .reset = hid_ishtp_cl_reset, |
---|
.. | .. |
---|
946 | 941 | int rv; |
---|
947 | 942 | |
---|
948 | 943 | /* Register ISHTP client device driver with ISHTP Bus */ |
---|
949 | | - rv = ishtp_cl_driver_register(&hid_ishtp_cl_driver); |
---|
| 944 | + rv = ishtp_cl_driver_register(&hid_ishtp_cl_driver, THIS_MODULE); |
---|
950 | 945 | |
---|
951 | 946 | return rv; |
---|
952 | 947 | |
---|