55 static int prepare_packet(struct cros_ec_device *ec_dev,  in prepare_packet()  argument
63 	BUG_ON(ec_dev->proto_version != EC_HOST_REQUEST_VERSION);  in prepare_packet()
64 	BUG_ON(msg->outsize + sizeof(*request) > ec_dev->dout_size);  in prepare_packet()
66 	out = ec_dev->dout;  in prepare_packet()
88 static int send_command(struct cros_ec_device *ec_dev,  in send_command()  argument
94 	if (ec_dev->proto_version > 2)  in send_command()
95 		xfer_fxn = ec_dev->pkt_xfer;  in send_command()
97 		xfer_fxn = ec_dev->cmd_xfer;  in send_command()
105 		dev_err_once(ec_dev->dev,  in send_command()
111 	ret = (*xfer_fxn)(ec_dev, msg);  in send_command()
136 			ret = (*xfer_fxn)(ec_dev, status_msg);  in send_command()
170 int cros_ec_prepare_tx(struct cros_ec_device *ec_dev,  in cros_ec_prepare_tx()  argument
177 	if (ec_dev->proto_version > 2)  in cros_ec_prepare_tx()
178 		return prepare_packet(ec_dev, msg);  in cros_ec_prepare_tx()
181 	out = ec_dev->dout;  in cros_ec_prepare_tx()
204 int cros_ec_check_result(struct cros_ec_device *ec_dev,  in cros_ec_check_result()  argument
211 		dev_dbg(ec_dev->dev, "command 0x%02x in progress\n",  in cros_ec_check_result()
215 		dev_dbg(ec_dev->dev, "command 0x%02x returned %d\n",  in cros_ec_check_result()
235 static int cros_ec_get_host_event_wake_mask(struct cros_ec_device *ec_dev,  in cros_ec_get_host_event_wake_mask()  argument
247 	ret = send_command(ec_dev, msg);  in cros_ec_get_host_event_wake_mask()
262 static int cros_ec_host_command_proto_query(struct cros_ec_device *ec_dev,  in cros_ec_host_command_proto_query()  argument
274 	if (!ec_dev->pkt_xfer)  in cros_ec_host_command_proto_query()
281 	ret = send_command(ec_dev, msg);  in cros_ec_host_command_proto_query()
284 		dev_dbg(ec_dev->dev,  in cros_ec_host_command_proto_query()
298 static int cros_ec_host_command_proto_query_v2(struct cros_ec_device *ec_dev)  in cros_ec_host_command_proto_query_v2()  argument
319 	ret = send_command(ec_dev, msg);  in cros_ec_host_command_proto_query_v2()
322 		dev_dbg(ec_dev->dev,  in cros_ec_host_command_proto_query_v2()
327 		dev_err(ec_dev->dev,  in cros_ec_host_command_proto_query_v2()
333 		dev_err(ec_dev->dev,  in cros_ec_host_command_proto_query_v2()
363 static int cros_ec_get_host_command_version_mask(struct cros_ec_device *ec_dev,  in cros_ec_get_host_command_version_mask()  argument
384 	ret = send_command(ec_dev, msg);  in cros_ec_get_host_command_version_mask()
402 int cros_ec_query_all(struct cros_ec_device *ec_dev)  in cros_ec_query_all()  argument
404 	struct device *dev = ec_dev->dev;  in cros_ec_query_all()
416 	ec_dev->proto_version = 3;  in cros_ec_query_all()
417 	ret = cros_ec_host_command_proto_query(ec_dev, 0, proto_msg);  in cros_ec_query_all()
422 		ec_dev->max_request = proto_info->max_request_packet_size -  in cros_ec_query_all()
424 		ec_dev->max_response = proto_info->max_response_packet_size -  in cros_ec_query_all()
426 		ec_dev->proto_version =  in cros_ec_query_all()
429 		dev_dbg(ec_dev->dev,  in cros_ec_query_all()
431 			ec_dev->proto_version);  in cros_ec_query_all()
433 		ec_dev->din_size = ec_dev->max_response +  in cros_ec_query_all()
436 		ec_dev->dout_size = ec_dev->max_request +  in cros_ec_query_all()
443 		ret = cros_ec_host_command_proto_query(ec_dev, 1, proto_msg);  in cros_ec_query_all()
446 			dev_dbg(ec_dev->dev, "no PD chip found: %d\n", ret);  in cros_ec_query_all()
447 			ec_dev->max_passthru = 0;  in cros_ec_query_all()
449 			dev_dbg(ec_dev->dev, "found PD chip\n");  in cros_ec_query_all()
450 			ec_dev->max_passthru =  in cros_ec_query_all()
456 		ec_dev->proto_version = 2;  in cros_ec_query_all()
457 		ret = cros_ec_host_command_proto_query_v2(ec_dev);  in cros_ec_query_all()
461 			dev_dbg(ec_dev->dev, "falling back to proto v2\n");  in cros_ec_query_all()
463 			ec_dev->max_request = EC_PROTO2_MAX_PARAM_SIZE;  in cros_ec_query_all()
464 			ec_dev->max_response = EC_PROTO2_MAX_PARAM_SIZE;  in cros_ec_query_all()
465 			ec_dev->max_passthru = 0;  in cros_ec_query_all()
466 			ec_dev->pkt_xfer = NULL;  in cros_ec_query_all()
467 			ec_dev->din_size = EC_PROTO2_MSG_BYTES;  in cros_ec_query_all()
468 			ec_dev->dout_size = EC_PROTO2_MSG_BYTES;  in cros_ec_query_all()
475 			ec_dev->proto_version = EC_PROTO_VERSION_UNKNOWN;  in cros_ec_query_all()
476 			dev_dbg(ec_dev->dev, "EC query failed: %d\n", ret);  in cros_ec_query_all()
481 	devm_kfree(dev, ec_dev->din);  in cros_ec_query_all()
482 	devm_kfree(dev, ec_dev->dout);  in cros_ec_query_all()
484 	ec_dev->din = devm_kzalloc(dev, ec_dev->din_size, GFP_KERNEL);  in cros_ec_query_all()
485 	if (!ec_dev->din) {  in cros_ec_query_all()
490 	ec_dev->dout = devm_kzalloc(dev, ec_dev->dout_size, GFP_KERNEL);  in cros_ec_query_all()
491 	if (!ec_dev->dout) {  in cros_ec_query_all()
492 		devm_kfree(dev, ec_dev->din);  in cros_ec_query_all()
498 	ret = cros_ec_get_host_command_version_mask(ec_dev,  in cros_ec_query_all()
502 		ec_dev->mkbp_event_supported = 0;  in cros_ec_query_all()
504 		ec_dev->mkbp_event_supported = fls(ver_mask);  in cros_ec_query_all()
506 	dev_dbg(ec_dev->dev, "MKBP support version %u\n",  in cros_ec_query_all()
507 		ec_dev->mkbp_event_supported - 1);  in cros_ec_query_all()
510 	ret = cros_ec_get_host_command_version_mask(ec_dev,  in cros_ec_query_all()
513 	ec_dev->host_sleep_v1 = (ret >= 0 && (ver_mask & EC_VER_MASK(1)));  in cros_ec_query_all()
516 	ret = cros_ec_get_host_event_wake_mask(ec_dev, proto_msg,  in cros_ec_query_all()
517 					       &ec_dev->host_event_wake_mask);  in cros_ec_query_all()
528 		ec_dev->host_event_wake_mask = U32_MAX &  in cros_ec_query_all()
539 			dev_err(ec_dev->dev,  in cros_ec_query_all()
564 int cros_ec_cmd_xfer_status(struct cros_ec_device *ec_dev,  in cros_ec_cmd_xfer_status()  argument
569 	mutex_lock(&ec_dev->lock);  in cros_ec_cmd_xfer_status()
570 	if (ec_dev->proto_version == EC_PROTO_VERSION_UNKNOWN) {  in cros_ec_cmd_xfer_status()
571 		ret = cros_ec_query_all(ec_dev);  in cros_ec_cmd_xfer_status()
573 			dev_err(ec_dev->dev,  in cros_ec_cmd_xfer_status()
575 			mutex_unlock(&ec_dev->lock);  in cros_ec_cmd_xfer_status()
580 	if (msg->insize > ec_dev->max_response) {  in cros_ec_cmd_xfer_status()
581 		dev_dbg(ec_dev->dev, "clamping message receive buffer\n");  in cros_ec_cmd_xfer_status()
582 		msg->insize = ec_dev->max_response;  in cros_ec_cmd_xfer_status()
586 		if (msg->outsize > ec_dev->max_request) {  in cros_ec_cmd_xfer_status()
587 			dev_err(ec_dev->dev,  in cros_ec_cmd_xfer_status()
590 				ec_dev->max_request);  in cros_ec_cmd_xfer_status()
591 			mutex_unlock(&ec_dev->lock);  in cros_ec_cmd_xfer_status()
595 		if (msg->outsize > ec_dev->max_passthru) {  in cros_ec_cmd_xfer_status()
596 			dev_err(ec_dev->dev,  in cros_ec_cmd_xfer_status()
599 				ec_dev->max_passthru);  in cros_ec_cmd_xfer_status()
600 			mutex_unlock(&ec_dev->lock);  in cros_ec_cmd_xfer_status()
605 	ret = send_command(ec_dev, msg);  in cros_ec_cmd_xfer_status()
606 	mutex_unlock(&ec_dev->lock);  in cros_ec_cmd_xfer_status()
610 		dev_dbg(ec_dev->dev, "Command result (err: %d [%d])\n",  in cros_ec_cmd_xfer_status()
619 static int get_next_event_xfer(struct cros_ec_device *ec_dev,  in get_next_event_xfer()  argument
631 	ret = cros_ec_cmd_xfer_status(ec_dev, msg);  in get_next_event_xfer()
633 		ec_dev->event_size = ret - 1;  in get_next_event_xfer()
634 		ec_dev->event_data = *event;  in get_next_event_xfer()
640 static int get_next_event(struct cros_ec_device *ec_dev)  in get_next_event()  argument
648 	const int cmd_version = ec_dev->mkbp_event_supported - 1;  in get_next_event()
651 	if (ec_dev->suspended) {  in get_next_event()
652 		dev_dbg(ec_dev->dev, "Device suspended.\n");  in get_next_event()
657 		return get_next_event_xfer(ec_dev, msg, event, 0,  in get_next_event()
660 	return get_next_event_xfer(ec_dev, msg, event, cmd_version,  in get_next_event()
664 static int get_keyboard_state_event(struct cros_ec_device *ec_dev)  in get_keyboard_state_event()  argument
667 		  sizeof(ec_dev->event_data.data)];  in get_keyboard_state_event()
672 	msg->insize = sizeof(ec_dev->event_data.data);  in get_keyboard_state_event()
675 	ec_dev->event_size = cros_ec_cmd_xfer_status(ec_dev, msg);  in get_keyboard_state_event()
676 	ec_dev->event_data.event_type = EC_MKBP_EVENT_KEY_MATRIX;  in get_keyboard_state_event()
677 	memcpy(&ec_dev->event_data.data, msg->data,  in get_keyboard_state_event()
678 	       sizeof(ec_dev->event_data.data));  in get_keyboard_state_event()
680 	return ec_dev->event_size;  in get_keyboard_state_event()
701 int cros_ec_get_next_event(struct cros_ec_device *ec_dev,  in cros_ec_get_next_event()  argument
725 	if (!ec_dev->mkbp_event_supported)  in cros_ec_get_next_event()
726 		return get_keyboard_state_event(ec_dev);  in cros_ec_get_next_event()
728 	ret = get_next_event(ec_dev);  in cros_ec_get_next_event()
733 		*has_more_events = ec_dev->event_data.event_type &  in cros_ec_get_next_event()
735 	ec_dev->event_data.event_type &= EC_MKBP_EVENT_TYPE_MASK;  in cros_ec_get_next_event()
738 		event_type = ec_dev->event_data.event_type;  in cros_ec_get_next_event()
739 		host_event = cros_ec_get_host_event(ec_dev);  in cros_ec_get_next_event()
749 			 !(host_event & ec_dev->host_event_wake_mask))  in cros_ec_get_next_event()
767 u32 cros_ec_get_host_event(struct cros_ec_device *ec_dev)  in cros_ec_get_host_event()  argument
771 	BUG_ON(!ec_dev->mkbp_event_supported);  in cros_ec_get_host_event()
773 	if (ec_dev->event_data.event_type != EC_MKBP_EVENT_HOST_EVENT)  in cros_ec_get_host_event()
776 	if (ec_dev->event_size != sizeof(host_event)) {  in cros_ec_get_host_event()
777 		dev_warn(ec_dev->dev, "Invalid host event size\n");  in cros_ec_get_host_event()
781 	host_event = get_unaligned_le32(&ec_dev->event_data.data.host_event);  in cros_ec_get_host_event()
812 		ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);  in cros_ec_check_features()
848 	struct cros_ec_device *ec_dev = ec->ec_dev;  in cros_ec_get_sensor_count()  local
864 	ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);  in cros_ec_get_sensor_count()
877 	if (sensor_count < 0 && ec->cmd_offset == 0 && ec_dev->cmd_readmem) {  in cros_ec_get_sensor_count()
878 		ret = ec_dev->cmd_readmem(ec_dev, EC_MEMMAP_ACC_STATUS,  in cros_ec_get_sensor_count()