| .. | .. |
|---|
| 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 | |
|---|