26 #define cl_data_to_dev(client_data) ishtp_device(client_data->cl_device)  argument
41 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in report_bad_packet()  local
43 	dev_err(cl_data_to_dev(client_data), "[hid-ish]: BAD packet %02X\n"  in report_bad_packet()
49 		recv_msg->hdr.command, client_data->bad_recv_cnt,  in report_bad_packet()
53 		(unsigned int)payload_len, client_data->multi_packet_cnt,  in report_bad_packet()
78 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in process_recv()  local
79 	int curr_hid_dev = client_data->cur_hid_dev;  in process_recv()
89 			dev_err(cl_data_to_dev(client_data),  in process_recv()
93 			++client_data->bad_recv_cnt;  in process_recv()
104 			++client_data->bad_recv_cnt;  in process_recv()
111 		hid_ishtp_trace(client_data,  "%s %d\n",  in process_recv()
117 					client_data->init_done)) {  in process_recv()
118 				++client_data->bad_recv_cnt;  in process_recv()
125 			client_data->hid_dev_count = (unsigned int)*payload;  in process_recv()
126 			if (!client_data->hid_devices)  in process_recv()
127 				client_data->hid_devices = devm_kcalloc(  in process_recv()
128 						cl_data_to_dev(client_data),  in process_recv()
129 						client_data->hid_dev_count,  in process_recv()
132 			if (!client_data->hid_devices) {  in process_recv()
133 				dev_err(cl_data_to_dev(client_data),  in process_recv()
135 				wake_up_interruptible(&client_data->init_wait);  in process_recv()
138 			for (i = 0; i < client_data->hid_dev_count; ++i) {  in process_recv()
141 					dev_err(cl_data_to_dev(client_data),  in process_recv()
153 				if (client_data->hid_devices)  in process_recv()
154 					memcpy(client_data->hid_devices + i,  in process_recv()
159 			client_data->enum_devices_done = true;  in process_recv()
160 			wake_up_interruptible(&client_data->init_wait);  in process_recv()
166 					client_data->init_done)) {  in process_recv()
167 				++client_data->bad_recv_cnt;  in process_recv()
174 			if (!client_data->hid_descr[curr_hid_dev])  in process_recv()
175 				client_data->hid_descr[curr_hid_dev] =  in process_recv()
176 				devm_kmalloc(cl_data_to_dev(client_data),  in process_recv()
178 			if (client_data->hid_descr[curr_hid_dev]) {  in process_recv()
179 				memcpy(client_data->hid_descr[curr_hid_dev],  in process_recv()
181 				client_data->hid_descr_size[curr_hid_dev] =  in process_recv()
183 				client_data->hid_descr_done = true;  in process_recv()
185 			wake_up_interruptible(&client_data->init_wait);  in process_recv()
191 					client_data->init_done)) {  in process_recv()
192 				++client_data->bad_recv_cnt;  in process_recv()
199 			if (!client_data->report_descr[curr_hid_dev])  in process_recv()
200 				client_data->report_descr[curr_hid_dev] =  in process_recv()
201 				devm_kmalloc(cl_data_to_dev(client_data),  in process_recv()
203 			if (client_data->report_descr[curr_hid_dev])  {  in process_recv()
204 				memcpy(client_data->report_descr[curr_hid_dev],  in process_recv()
207 				client_data->report_descr_size[curr_hid_dev] =  in process_recv()
209 				client_data->report_descr_done = true;  in process_recv()
211 			wake_up_interruptible(&client_data->init_wait);  in process_recv()
223 			for (i = 0; i < client_data->num_hid_devices; ++i) {  in process_recv()
225 					  client_data->hid_devices[i].dev_id) {  in process_recv()
226 					hid = client_data->hid_sensor_hubs[i];  in process_recv()
255 			for (i = 0; i < client_data->num_hid_devices; ++i) {  in process_recv()
257 					client_data->hid_devices[i].dev_id)  in process_recv()
258 					if (client_data->hid_sensor_hubs[i]) {  in process_recv()
260 						client_data->hid_sensor_hubs[  in process_recv()
269 			for (i = 0; i < client_data->num_hid_devices; ++i)  in process_recv()
271 					client_data->hid_devices[i].dev_id)  in process_recv()
272 					if (client_data->hid_sensor_hubs[i])  in process_recv()
274 						client_data->hid_sensor_hubs[  in process_recv()
294 				for (i = 0; i < client_data->num_hid_devices;  in process_recv()
297 					client_data->hid_devices[i].dev_id &&  in process_recv()
298 					client_data->hid_sensor_hubs[i]) {  in process_recv()
300 						client_data->hid_sensor_hubs[  in process_recv()
311 			++client_data->bad_recv_cnt;  in process_recv()
321 			++client_data->multi_packet_cnt;  in process_recv()
373 	struct ishtp_cl_data *client_data = hid_data->client_data;  in hid_ishtp_set_feature()  local
378 	hid_ishtp_trace(client_data,  "%s hid %p\n", __func__, hid);  in hid_ishtp_set_feature()
380 	rv = ishtp_hid_link_ready_wait(client_data);  in hid_ishtp_set_feature()
382 		hid_ishtp_trace(client_data,  "%s hid %p link not ready\n",  in hid_ishtp_set_feature()
389 	for (i = 0; i < client_data->num_hid_devices; ++i) {  in hid_ishtp_set_feature()
390 		if (hid == client_data->hid_sensor_hubs[i]) {  in hid_ishtp_set_feature()
392 				client_data->hid_devices[i].dev_id;  in hid_ishtp_set_feature()
397 	if (i == client_data->num_hid_devices)  in hid_ishtp_set_feature()
400 	rv = ishtp_cl_send(client_data->hid_ishtp_cl, buf, len);  in hid_ishtp_set_feature()
402 		hid_ishtp_trace(client_data,  "%s hid %p send failed\n",  in hid_ishtp_set_feature()
419 	struct ishtp_cl_data *client_data = hid_data->client_data;  in hid_ishtp_get_report()  local
424 	hid_ishtp_trace(client_data,  "%s hid %p\n", __func__, hid);  in hid_ishtp_get_report()
425 	rv = ishtp_hid_link_ready_wait(client_data);  in hid_ishtp_get_report()
427 		hid_ishtp_trace(client_data,  "%s hid %p link not ready\n",  in hid_ishtp_get_report()
434 	for (i = 0; i < client_data->num_hid_devices; ++i) {  in hid_ishtp_get_report()
435 		if (hid == client_data->hid_sensor_hubs[i]) {  in hid_ishtp_get_report()
437 				client_data->hid_devices[i].dev_id;  in hid_ishtp_get_report()
442 	if (i == client_data->num_hid_devices)  in hid_ishtp_get_report()
446 	rv = ishtp_cl_send(client_data->hid_ishtp_cl, (uint8_t *)&msg,  in hid_ishtp_get_report()
449 		hid_ishtp_trace(client_data,  "%s hid %p send failed\n",  in hid_ishtp_get_report()
462 int ishtp_hid_link_ready_wait(struct ishtp_cl_data *client_data)  in ishtp_hid_link_ready_wait()  argument
466 	if (client_data->suspended) {  in ishtp_hid_link_ready_wait()
467 		hid_ishtp_trace(client_data,  "wait for link ready\n");  in ishtp_hid_link_ready_wait()
469 					client_data->ishtp_resume_wait,  in ishtp_hid_link_ready_wait()
470 					!client_data->suspended,  in ishtp_hid_link_ready_wait()
474 			hid_ishtp_trace(client_data,  "link not ready\n");  in ishtp_hid_link_ready_wait()
477 		hid_ishtp_trace(client_data,  "link ready\n");  in ishtp_hid_link_ready_wait()
494 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in ishtp_enum_enum_devices()  local
507 	while (!client_data->enum_devices_done &&  in ishtp_enum_enum_devices()
509 		wait_event_interruptible_timeout(client_data->init_wait,  in ishtp_enum_enum_devices()
510 					 client_data->enum_devices_done,  in ishtp_enum_enum_devices()
513 		if (!client_data->enum_devices_done)  in ishtp_enum_enum_devices()
519 	if (!client_data->enum_devices_done) {  in ishtp_enum_enum_devices()
520 		dev_err(cl_data_to_dev(client_data),  in ishtp_enum_enum_devices()
524 	if (!client_data->hid_devices) {  in ishtp_enum_enum_devices()
525 		dev_err(cl_data_to_dev(client_data),  in ishtp_enum_enum_devices()
530 	client_data->num_hid_devices = client_data->hid_dev_count;  in ishtp_enum_enum_devices()
531 	dev_info(ishtp_device(client_data->cl_device),  in ishtp_enum_enum_devices()
533 		client_data->num_hid_devices);  in ishtp_enum_enum_devices()
550 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in ishtp_get_hid_descriptor()  local
554 	client_data->hid_descr_done = false;  in ishtp_get_hid_descriptor()
557 	msg.hdr.device_id = client_data->hid_devices[index].dev_id;  in ishtp_get_hid_descriptor()
563 	if (!client_data->hid_descr_done) {  in ishtp_get_hid_descriptor()
564 		wait_event_interruptible_timeout(client_data->init_wait,  in ishtp_get_hid_descriptor()
565 						 client_data->hid_descr_done,  in ishtp_get_hid_descriptor()
567 		if (!client_data->hid_descr_done) {  in ishtp_get_hid_descriptor()
568 			dev_err(cl_data_to_dev(client_data),  in ishtp_get_hid_descriptor()
573 		if (!client_data->hid_descr[index]) {  in ishtp_get_hid_descriptor()
574 			dev_err(cl_data_to_dev(client_data),  in ishtp_get_hid_descriptor()
597 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in ishtp_get_report_descriptor()  local
601 	client_data->report_descr_done = false;  in ishtp_get_report_descriptor()
604 	msg.hdr.device_id = client_data->hid_devices[index].dev_id;  in ishtp_get_report_descriptor()
610 	if (!client_data->report_descr_done)  in ishtp_get_report_descriptor()
611 		wait_event_interruptible_timeout(client_data->init_wait,  in ishtp_get_report_descriptor()
612 					 client_data->report_descr_done,  in ishtp_get_report_descriptor()
614 	if (!client_data->report_descr_done) {  in ishtp_get_report_descriptor()
615 		dev_err(cl_data_to_dev(client_data),  in ishtp_get_report_descriptor()
619 	if (!client_data->report_descr[index]) {  in ishtp_get_report_descriptor()
620 		dev_err(cl_data_to_dev(client_data),  in ishtp_get_report_descriptor()
645 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in hid_ishtp_cl_init()  local
650 	dev_dbg(cl_data_to_dev(client_data), "%s\n", __func__);  in hid_ishtp_cl_init()
651 	hid_ishtp_trace(client_data,  "%s reset flag: %d\n", __func__, reset);  in hid_ishtp_cl_init()
655 		dev_err(cl_data_to_dev(client_data),  in hid_ishtp_cl_init()
660 	client_data->init_done = 0;  in hid_ishtp_cl_init()
670 		dev_err(cl_data_to_dev(client_data),  in hid_ishtp_cl_init()
680 		dev_err(cl_data_to_dev(client_data),  in hid_ishtp_cl_init()
685 	hid_ishtp_trace(client_data,  "%s client connected\n", __func__);  in hid_ishtp_cl_init()
688 	ishtp_register_event_cb(client_data->cl_device, ish_cl_event_cb);  in hid_ishtp_cl_init()
694 	hid_ishtp_trace(client_data,  "%s enumerated device count %d\n",  in hid_ishtp_cl_init()
695 			__func__, client_data->num_hid_devices);  in hid_ishtp_cl_init()
697 	for (i = 0; i < client_data->num_hid_devices; ++i) {  in hid_ishtp_cl_init()
698 		client_data->cur_hid_dev = i;  in hid_ishtp_cl_init()
709 			rv = ishtp_hid_probe(i, client_data);  in hid_ishtp_cl_init()
711 				dev_err(cl_data_to_dev(client_data),  in hid_ishtp_cl_init()
719 	client_data->init_done = 1;  in hid_ishtp_cl_init()
720 	client_data->suspended = false;  in hid_ishtp_cl_init()
721 	wake_up_interruptible(&client_data->ishtp_resume_wait);  in hid_ishtp_cl_init()
722 	hid_ishtp_trace(client_data,  "%s successful init\n", __func__);  in hid_ishtp_cl_init()
750 	struct ishtp_cl_data *client_data;  in hid_ishtp_cl_reset_handler()  local
756 	client_data = container_of(work, struct ishtp_cl_data, work);  in hid_ishtp_cl_reset_handler()
758 	hid_ishtp_cl = client_data->hid_ishtp_cl;  in hid_ishtp_cl_reset_handler()
759 	cl_device = client_data->cl_device;  in hid_ishtp_cl_reset_handler()
761 	hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__,  in hid_ishtp_cl_reset_handler()
763 	dev_dbg(ishtp_device(client_data->cl_device), "%s\n", __func__);  in hid_ishtp_cl_reset_handler()
772 	ishtp_set_client_data(hid_ishtp_cl, client_data);  in hid_ishtp_cl_reset_handler()
773 	client_data->hid_ishtp_cl = hid_ishtp_cl;  in hid_ishtp_cl_reset_handler()
775 	client_data->num_hid_devices = 0;  in hid_ishtp_cl_reset_handler()
781 		dev_err(cl_data_to_dev(client_data), "Retry reset init\n");  in hid_ishtp_cl_reset_handler()
784 		dev_err(cl_data_to_dev(client_data), "Reset Failed\n");  in hid_ishtp_cl_reset_handler()
785 		hid_ishtp_trace(client_data, "%s Failed hid_ishtp_cl %p\n",  in hid_ishtp_cl_reset_handler()
792 	struct ishtp_cl_data *client_data = container_of(work, struct ishtp_cl_data, resume_work);  in hid_ishtp_cl_resume_handler()  local
793 	struct ishtp_cl *hid_ishtp_cl = client_data->hid_ishtp_cl;  in hid_ishtp_cl_resume_handler()
796 		client_data->suspended = false;  in hid_ishtp_cl_resume_handler()
797 		wake_up_interruptible(&client_data->ishtp_resume_wait);  in hid_ishtp_cl_resume_handler()
814 	struct ishtp_cl_data *client_data;  in hid_ishtp_cl_probe()  local
820 	client_data = devm_kzalloc(ishtp_device(cl_device),  in hid_ishtp_cl_probe()
821 				   sizeof(*client_data),  in hid_ishtp_cl_probe()
823 	if (!client_data)  in hid_ishtp_cl_probe()
831 	ishtp_set_client_data(hid_ishtp_cl, client_data);  in hid_ishtp_cl_probe()
832 	client_data->hid_ishtp_cl = hid_ishtp_cl;  in hid_ishtp_cl_probe()
833 	client_data->cl_device = cl_device;  in hid_ishtp_cl_probe()
835 	init_waitqueue_head(&client_data->init_wait);  in hid_ishtp_cl_probe()
836 	init_waitqueue_head(&client_data->ishtp_resume_wait);  in hid_ishtp_cl_probe()
838 	INIT_WORK(&client_data->work, hid_ishtp_cl_reset_handler);  in hid_ishtp_cl_probe()
839 	INIT_WORK(&client_data->resume_work, hid_ishtp_cl_resume_handler);  in hid_ishtp_cl_probe()
865 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in hid_ishtp_cl_remove()  local
867 	hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__,  in hid_ishtp_cl_remove()
874 	ishtp_hid_remove(client_data);  in hid_ishtp_cl_remove()
879 	client_data->num_hid_devices = 0;  in hid_ishtp_cl_remove()
893 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in hid_ishtp_cl_reset()  local
895 	hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__,  in hid_ishtp_cl_reset()
898 	schedule_work(&client_data->work);  in hid_ishtp_cl_reset()
915 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in hid_ishtp_cl_suspend()  local
917 	hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__,  in hid_ishtp_cl_suspend()
919 	client_data->suspended = true;  in hid_ishtp_cl_suspend()
936 	struct ishtp_cl_data *client_data = ishtp_get_client_data(hid_ishtp_cl);  in hid_ishtp_cl_resume()  local
938 	hid_ishtp_trace(client_data, "%s hid_ishtp_cl %p\n", __func__,  in hid_ishtp_cl_resume()
940 	schedule_work(&client_data->resume_work);  in hid_ishtp_cl_resume()