115 static int cros_ec_check_features(struct cros_ec_dev *ec, int feature)  in cros_ec_check_features()  argument
120 	if (ec->features[0] == -1U && ec->features[1] == -1U) {  in cros_ec_check_features()
122 		msg = kzalloc(sizeof(*msg) + sizeof(ec->features), GFP_KERNEL);  in cros_ec_check_features()
126 		msg->command = EC_CMD_GET_FEATURES + ec->cmd_offset;  in cros_ec_check_features()
127 		msg->insize = sizeof(ec->features);  in cros_ec_check_features()
129 		ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);  in cros_ec_check_features()
131 			dev_warn(ec->dev, "cannot get EC features: %d/%d\n",  in cros_ec_check_features()
133 			memset(ec->features, 0, sizeof(ec->features));  in cros_ec_check_features()
135 			memcpy(ec->features, msg->data, sizeof(ec->features));  in cros_ec_check_features()
138 		dev_dbg(ec->dev, "EC features %08x %08x\n",  in cros_ec_check_features()
139 			ec->features[0], ec->features[1]);  in cros_ec_check_features()
144 	return ec->features[feature / 32] & EC_FEATURE_MASK_0(feature);  in cros_ec_check_features()
152 static void cros_ec_sensors_register(struct cros_ec_dev *ec)  in cros_ec_sensors_register()  argument
172 	msg->command = EC_CMD_MOTION_SENSE_CMD + ec->cmd_offset;  in cros_ec_sensors_register()
179 	ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);  in cros_ec_sensors_register()
181 		dev_warn(ec->dev, "cannot get EC sensor information: %d/%d\n",  in cros_ec_sensors_register()
207 		ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);  in cros_ec_sensors_register()
209 			dev_warn(ec->dev, "no info for EC sensor %d : %d/%d\n",  in cros_ec_sensors_register()
236 			dev_warn(ec->dev, "unknown type %d\n", resp->info.type);  in cros_ec_sensors_register()
250 		ec->has_kb_wake_angle = true;  in cros_ec_sensors_register()
252 	if (cros_ec_check_features(ec, EC_FEATURE_MOTION_SENSE_FIFO)) {  in cros_ec_sensors_register()
256 	if (cros_ec_check_features(ec,  in cros_ec_sensors_register()
262 	ret = mfd_add_devices(ec->dev, 0, sensor_cells, id,  in cros_ec_sensors_register()
265 		dev_err(ec->dev, "failed to add EC sensors\n");  in cros_ec_sensors_register()
292 static void cros_ec_accel_legacy_register(struct cros_ec_dev *ec)  in cros_ec_accel_legacy_register()  argument
294 	struct cros_ec_device *ec_dev = ec->ec_dev;  in cros_ec_accel_legacy_register()
302 	if (ec->cmd_offset != 0)  in cros_ec_accel_legacy_register()
313 			dev_warn(ec->dev, "EC direct read error.\n");  in cros_ec_accel_legacy_register()
319 			dev_info(ec->dev, "EC does not have accelerometers.\n");  in cros_ec_accel_legacy_register()
332 	ret = mfd_add_hotplug_devices(ec->dev, cros_ec_accel_legacy_cells,  in cros_ec_accel_legacy_register()
344 	struct cros_ec_dev *ec = kzalloc(sizeof(*ec), GFP_KERNEL);  in ec_device_probe()  local
347 	if (!ec)  in ec_device_probe()
350 	dev_set_drvdata(dev, ec);  in ec_device_probe()
351 	ec->ec_dev = dev_get_drvdata(dev->parent);  in ec_device_probe()
352 	ec->dev = dev;  in ec_device_probe()
353 	ec->cmd_offset = ec_platform->cmd_offset;  in ec_device_probe()
354 	ec->features[0] = -1U; /* Not cached yet */  in ec_device_probe()
355 	ec->features[1] = -1U; /* Not cached yet */  in ec_device_probe()
356 	device_initialize(&ec->class_dev);  in ec_device_probe()
363 		if (cros_ec_check_features(ec, cros_mcu_devices[i].id)) {  in ec_device_probe()
378 	ec->class_dev.class = &cros_class;  in ec_device_probe()
379 	ec->class_dev.parent = dev;  in ec_device_probe()
380 	ec->class_dev.release = cros_ec_class_release;  in ec_device_probe()
382 	retval = dev_set_name(&ec->class_dev, "%s", ec_platform->ec_name);  in ec_device_probe()
388 	retval = device_add(&ec->class_dev);  in ec_device_probe()
393 	if (cros_ec_check_features(ec, EC_FEATURE_MOTION_SENSE))  in ec_device_probe()
394 		cros_ec_sensors_register(ec);  in ec_device_probe()
397 		cros_ec_accel_legacy_register(ec);  in ec_device_probe()
404 		if (cros_ec_check_features(ec, cros_subdevices[i].id)) {  in ec_device_probe()
405 			retval = mfd_add_hotplug_devices(ec->dev,  in ec_device_probe()
409 				dev_err(ec->dev,  in ec_device_probe()
420 	retval = mfd_add_hotplug_devices(ec->dev, cros_ec_platform_cells,  in ec_device_probe()
423 		dev_warn(ec->dev,  in ec_device_probe()
428 	node = ec->ec_dev->dev->of_node;  in ec_device_probe()
430 		retval = mfd_add_hotplug_devices(ec->dev, cros_ec_vbc_cells,  in ec_device_probe()
433 			dev_warn(ec->dev, "failed to add VBC devices: %d\n",  in ec_device_probe()
440 	put_device(&ec->class_dev);  in ec_device_probe()
446 	struct cros_ec_dev *ec = dev_get_drvdata(&pdev->dev);  in ec_device_remove()  local
448 	mfd_remove_devices(ec->dev);  in ec_device_remove()
449 	device_unregister(&ec->class_dev);  in ec_device_remove()