18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0+
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Power supply driver for ChromeOS EC based USB PD Charger.
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (c) 2014 - 2018 Google, Inc
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <linux/module.h>
98c2ecf20Sopenharmony_ci#include <linux/platform_data/cros_ec_commands.h>
108c2ecf20Sopenharmony_ci#include <linux/platform_data/cros_ec_proto.h>
118c2ecf20Sopenharmony_ci#include <linux/platform_data/cros_usbpd_notify.h>
128c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
138c2ecf20Sopenharmony_ci#include <linux/power_supply.h>
148c2ecf20Sopenharmony_ci#include <linux/slab.h>
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#define CHARGER_USBPD_DIR_NAME			"CROS_USBPD_CHARGER%d"
178c2ecf20Sopenharmony_ci#define CHARGER_DEDICATED_DIR_NAME		"CROS_DEDICATED_CHARGER"
188c2ecf20Sopenharmony_ci#define CHARGER_DIR_NAME_LENGTH		(sizeof(CHARGER_USBPD_DIR_NAME) >= \
198c2ecf20Sopenharmony_ci					 sizeof(CHARGER_DEDICATED_DIR_NAME) ? \
208c2ecf20Sopenharmony_ci					 sizeof(CHARGER_USBPD_DIR_NAME) : \
218c2ecf20Sopenharmony_ci					 sizeof(CHARGER_DEDICATED_DIR_NAME))
228c2ecf20Sopenharmony_ci#define CHARGER_CACHE_UPDATE_DELAY		msecs_to_jiffies(500)
238c2ecf20Sopenharmony_ci#define CHARGER_MANUFACTURER_MODEL_LENGTH	32
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci#define DRV_NAME "cros-usbpd-charger"
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_cistruct port_data {
288c2ecf20Sopenharmony_ci	int port_number;
298c2ecf20Sopenharmony_ci	char name[CHARGER_DIR_NAME_LENGTH];
308c2ecf20Sopenharmony_ci	char manufacturer[CHARGER_MANUFACTURER_MODEL_LENGTH];
318c2ecf20Sopenharmony_ci	char model_name[CHARGER_MANUFACTURER_MODEL_LENGTH];
328c2ecf20Sopenharmony_ci	struct power_supply *psy;
338c2ecf20Sopenharmony_ci	struct power_supply_desc psy_desc;
348c2ecf20Sopenharmony_ci	int psy_usb_type;
358c2ecf20Sopenharmony_ci	int psy_online;
368c2ecf20Sopenharmony_ci	int psy_status;
378c2ecf20Sopenharmony_ci	int psy_current_max;
388c2ecf20Sopenharmony_ci	int psy_voltage_max_design;
398c2ecf20Sopenharmony_ci	int psy_voltage_now;
408c2ecf20Sopenharmony_ci	int psy_power_max;
418c2ecf20Sopenharmony_ci	struct charger_data *charger;
428c2ecf20Sopenharmony_ci	unsigned long last_update;
438c2ecf20Sopenharmony_ci};
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_cistruct charger_data {
468c2ecf20Sopenharmony_ci	struct device *dev;
478c2ecf20Sopenharmony_ci	struct cros_ec_dev *ec_dev;
488c2ecf20Sopenharmony_ci	struct cros_ec_device *ec_device;
498c2ecf20Sopenharmony_ci	int num_charger_ports;
508c2ecf20Sopenharmony_ci	int num_usbpd_ports;
518c2ecf20Sopenharmony_ci	int num_registered_psy;
528c2ecf20Sopenharmony_ci	struct port_data *ports[EC_USB_PD_MAX_PORTS];
538c2ecf20Sopenharmony_ci	struct notifier_block notifier;
548c2ecf20Sopenharmony_ci};
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_cistatic enum power_supply_property cros_usbpd_charger_props[] = {
578c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
588c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
598c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_ONLINE,
608c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_STATUS,
618c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_CURRENT_MAX,
628c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
638c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_VOLTAGE_NOW,
648c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_MODEL_NAME,
658c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_MANUFACTURER,
668c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_USB_TYPE
678c2ecf20Sopenharmony_ci};
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_cistatic enum power_supply_property cros_usbpd_dedicated_charger_props[] = {
708c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_ONLINE,
718c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_STATUS,
728c2ecf20Sopenharmony_ci	POWER_SUPPLY_PROP_VOLTAGE_NOW,
738c2ecf20Sopenharmony_ci};
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_cistatic enum power_supply_usb_type cros_usbpd_charger_usb_types[] = {
768c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_UNKNOWN,
778c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_SDP,
788c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_DCP,
798c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_CDP,
808c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_C,
818c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_PD,
828c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_PD_DRP,
838c2ecf20Sopenharmony_ci	POWER_SUPPLY_USB_TYPE_APPLE_BRICK_ID
848c2ecf20Sopenharmony_ci};
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_ci/* Input voltage/current limit in mV/mA. Default to none. */
878c2ecf20Sopenharmony_cistatic u16 input_voltage_limit = EC_POWER_LIMIT_NONE;
888c2ecf20Sopenharmony_cistatic u16 input_current_limit = EC_POWER_LIMIT_NONE;
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_cistatic bool cros_usbpd_charger_port_is_dedicated(struct port_data *port)
918c2ecf20Sopenharmony_ci{
928c2ecf20Sopenharmony_ci	return port->port_number >= port->charger->num_usbpd_ports;
938c2ecf20Sopenharmony_ci}
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_ec_command(struct charger_data *charger,
968c2ecf20Sopenharmony_ci					 unsigned int version,
978c2ecf20Sopenharmony_ci					 unsigned int command,
988c2ecf20Sopenharmony_ci					 void *outdata,
998c2ecf20Sopenharmony_ci					 unsigned int outsize,
1008c2ecf20Sopenharmony_ci					 void *indata,
1018c2ecf20Sopenharmony_ci					 unsigned int insize)
1028c2ecf20Sopenharmony_ci{
1038c2ecf20Sopenharmony_ci	struct cros_ec_dev *ec_dev = charger->ec_dev;
1048c2ecf20Sopenharmony_ci	struct cros_ec_command *msg;
1058c2ecf20Sopenharmony_ci	int ret;
1068c2ecf20Sopenharmony_ci
1078c2ecf20Sopenharmony_ci	msg = kzalloc(sizeof(*msg) + max(outsize, insize), GFP_KERNEL);
1088c2ecf20Sopenharmony_ci	if (!msg)
1098c2ecf20Sopenharmony_ci		return -ENOMEM;
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ci	msg->version = version;
1128c2ecf20Sopenharmony_ci	msg->command = ec_dev->cmd_offset + command;
1138c2ecf20Sopenharmony_ci	msg->outsize = outsize;
1148c2ecf20Sopenharmony_ci	msg->insize = insize;
1158c2ecf20Sopenharmony_ci
1168c2ecf20Sopenharmony_ci	if (outsize)
1178c2ecf20Sopenharmony_ci		memcpy(msg->data, outdata, outsize);
1188c2ecf20Sopenharmony_ci
1198c2ecf20Sopenharmony_ci	ret = cros_ec_cmd_xfer_status(charger->ec_device, msg);
1208c2ecf20Sopenharmony_ci	if (ret >= 0 && insize)
1218c2ecf20Sopenharmony_ci		memcpy(indata, msg->data, insize);
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	kfree(msg);
1248c2ecf20Sopenharmony_ci	return ret;
1258c2ecf20Sopenharmony_ci}
1268c2ecf20Sopenharmony_ci
1278c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_num_ports(struct charger_data *charger)
1288c2ecf20Sopenharmony_ci{
1298c2ecf20Sopenharmony_ci	struct ec_response_charge_port_count resp;
1308c2ecf20Sopenharmony_ci	int ret;
1318c2ecf20Sopenharmony_ci
1328c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_ec_command(charger, 0,
1338c2ecf20Sopenharmony_ci					    EC_CMD_CHARGE_PORT_COUNT,
1348c2ecf20Sopenharmony_ci					    NULL, 0, &resp, sizeof(resp));
1358c2ecf20Sopenharmony_ci	if (ret < 0)
1368c2ecf20Sopenharmony_ci		return ret;
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	return resp.port_count;
1398c2ecf20Sopenharmony_ci}
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_usbpd_num_ports(struct charger_data *charger)
1428c2ecf20Sopenharmony_ci{
1438c2ecf20Sopenharmony_ci	struct ec_response_usb_pd_ports resp;
1448c2ecf20Sopenharmony_ci	int ret;
1458c2ecf20Sopenharmony_ci
1468c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_ec_command(charger, 0, EC_CMD_USB_PD_PORTS,
1478c2ecf20Sopenharmony_ci					    NULL, 0, &resp, sizeof(resp));
1488c2ecf20Sopenharmony_ci	if (ret < 0)
1498c2ecf20Sopenharmony_ci		return ret;
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ci	return resp.num_ports;
1528c2ecf20Sopenharmony_ci}
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_discovery_info(struct port_data *port)
1558c2ecf20Sopenharmony_ci{
1568c2ecf20Sopenharmony_ci	struct charger_data *charger = port->charger;
1578c2ecf20Sopenharmony_ci	struct ec_params_usb_pd_discovery_entry resp;
1588c2ecf20Sopenharmony_ci	struct ec_params_usb_pd_info_request req;
1598c2ecf20Sopenharmony_ci	int ret;
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci	req.port = port->port_number;
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_ec_command(charger, 0,
1648c2ecf20Sopenharmony_ci					    EC_CMD_USB_PD_DISCOVERY,
1658c2ecf20Sopenharmony_ci					    &req, sizeof(req),
1668c2ecf20Sopenharmony_ci					    &resp, sizeof(resp));
1678c2ecf20Sopenharmony_ci	if (ret < 0) {
1688c2ecf20Sopenharmony_ci		dev_err(charger->dev,
1698c2ecf20Sopenharmony_ci			"Unable to query discovery info (err:0x%x)\n", ret);
1708c2ecf20Sopenharmony_ci		return ret;
1718c2ecf20Sopenharmony_ci	}
1728c2ecf20Sopenharmony_ci
1738c2ecf20Sopenharmony_ci	dev_dbg(charger->dev, "Port %d: VID = 0x%x, PID=0x%x, PTYPE=0x%x\n",
1748c2ecf20Sopenharmony_ci		port->port_number, resp.vid, resp.pid, resp.ptype);
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	snprintf(port->manufacturer, sizeof(port->manufacturer), "%x",
1778c2ecf20Sopenharmony_ci		 resp.vid);
1788c2ecf20Sopenharmony_ci	snprintf(port->model_name, sizeof(port->model_name), "%x", resp.pid);
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_ci	return 0;
1818c2ecf20Sopenharmony_ci}
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_power_info(struct port_data *port)
1848c2ecf20Sopenharmony_ci{
1858c2ecf20Sopenharmony_ci	struct charger_data *charger = port->charger;
1868c2ecf20Sopenharmony_ci	struct ec_response_usb_pd_power_info resp;
1878c2ecf20Sopenharmony_ci	struct ec_params_usb_pd_power_info req;
1888c2ecf20Sopenharmony_ci	int last_psy_status, last_psy_usb_type;
1898c2ecf20Sopenharmony_ci	struct device *dev = charger->dev;
1908c2ecf20Sopenharmony_ci	int ret;
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci	req.port = port->port_number;
1938c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_ec_command(charger, 0,
1948c2ecf20Sopenharmony_ci					    EC_CMD_USB_PD_POWER_INFO,
1958c2ecf20Sopenharmony_ci					    &req, sizeof(req),
1968c2ecf20Sopenharmony_ci					    &resp, sizeof(resp));
1978c2ecf20Sopenharmony_ci	if (ret < 0) {
1988c2ecf20Sopenharmony_ci		dev_err(dev, "Unable to query PD power info (err:0x%x)\n", ret);
1998c2ecf20Sopenharmony_ci		return ret;
2008c2ecf20Sopenharmony_ci	}
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci	last_psy_status = port->psy_status;
2038c2ecf20Sopenharmony_ci	last_psy_usb_type = port->psy_usb_type;
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_ci	switch (resp.role) {
2068c2ecf20Sopenharmony_ci	case USB_PD_PORT_POWER_DISCONNECTED:
2078c2ecf20Sopenharmony_ci		port->psy_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
2088c2ecf20Sopenharmony_ci		port->psy_online = 0;
2098c2ecf20Sopenharmony_ci		break;
2108c2ecf20Sopenharmony_ci	case USB_PD_PORT_POWER_SOURCE:
2118c2ecf20Sopenharmony_ci		port->psy_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
2128c2ecf20Sopenharmony_ci		port->psy_online = 0;
2138c2ecf20Sopenharmony_ci		break;
2148c2ecf20Sopenharmony_ci	case USB_PD_PORT_POWER_SINK:
2158c2ecf20Sopenharmony_ci		port->psy_status = POWER_SUPPLY_STATUS_CHARGING;
2168c2ecf20Sopenharmony_ci		port->psy_online = 1;
2178c2ecf20Sopenharmony_ci		break;
2188c2ecf20Sopenharmony_ci	case USB_PD_PORT_POWER_SINK_NOT_CHARGING:
2198c2ecf20Sopenharmony_ci		port->psy_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
2208c2ecf20Sopenharmony_ci		port->psy_online = 1;
2218c2ecf20Sopenharmony_ci		break;
2228c2ecf20Sopenharmony_ci	default:
2238c2ecf20Sopenharmony_ci		dev_err(dev, "Unknown role %d\n", resp.role);
2248c2ecf20Sopenharmony_ci		break;
2258c2ecf20Sopenharmony_ci	}
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	port->psy_voltage_max_design = resp.meas.voltage_max;
2288c2ecf20Sopenharmony_ci	port->psy_voltage_now = resp.meas.voltage_now;
2298c2ecf20Sopenharmony_ci	port->psy_current_max = resp.meas.current_max;
2308c2ecf20Sopenharmony_ci	port->psy_power_max = resp.max_power;
2318c2ecf20Sopenharmony_ci
2328c2ecf20Sopenharmony_ci	switch (resp.type) {
2338c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_BC12_SDP:
2348c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_VBUS:
2358c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_SDP;
2368c2ecf20Sopenharmony_ci		break;
2378c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_NONE:
2388c2ecf20Sopenharmony_ci		/*
2398c2ecf20Sopenharmony_ci		 * For dual-role devices when we are a source, the firmware
2408c2ecf20Sopenharmony_ci		 * reports the type as NONE. Report such chargers as type
2418c2ecf20Sopenharmony_ci		 * USB_PD_DRP.
2428c2ecf20Sopenharmony_ci		 */
2438c2ecf20Sopenharmony_ci		if (resp.role == USB_PD_PORT_POWER_SOURCE && resp.dualrole)
2448c2ecf20Sopenharmony_ci			port->psy_usb_type = POWER_SUPPLY_USB_TYPE_PD_DRP;
2458c2ecf20Sopenharmony_ci		else
2468c2ecf20Sopenharmony_ci			port->psy_usb_type = POWER_SUPPLY_USB_TYPE_SDP;
2478c2ecf20Sopenharmony_ci		break;
2488c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_OTHER:
2498c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_PROPRIETARY:
2508c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_APPLE_BRICK_ID;
2518c2ecf20Sopenharmony_ci		break;
2528c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_C:
2538c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_C;
2548c2ecf20Sopenharmony_ci		break;
2558c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_BC12_DCP:
2568c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_DCP;
2578c2ecf20Sopenharmony_ci		break;
2588c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_BC12_CDP:
2598c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_CDP;
2608c2ecf20Sopenharmony_ci		break;
2618c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_PD:
2628c2ecf20Sopenharmony_ci		if (resp.dualrole)
2638c2ecf20Sopenharmony_ci			port->psy_usb_type = POWER_SUPPLY_USB_TYPE_PD_DRP;
2648c2ecf20Sopenharmony_ci		else
2658c2ecf20Sopenharmony_ci			port->psy_usb_type = POWER_SUPPLY_USB_TYPE_PD;
2668c2ecf20Sopenharmony_ci		break;
2678c2ecf20Sopenharmony_ci	case USB_CHG_TYPE_UNKNOWN:
2688c2ecf20Sopenharmony_ci		/*
2698c2ecf20Sopenharmony_ci		 * While the EC is trying to determine the type of charger that
2708c2ecf20Sopenharmony_ci		 * has been plugged in, it will report the charger type as
2718c2ecf20Sopenharmony_ci		 * unknown. Additionally since the power capabilities are
2728c2ecf20Sopenharmony_ci		 * unknown, report the max current and voltage as zero.
2738c2ecf20Sopenharmony_ci		 */
2748c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_UNKNOWN;
2758c2ecf20Sopenharmony_ci		port->psy_voltage_max_design = 0;
2768c2ecf20Sopenharmony_ci		port->psy_current_max = 0;
2778c2ecf20Sopenharmony_ci		break;
2788c2ecf20Sopenharmony_ci	default:
2798c2ecf20Sopenharmony_ci		dev_dbg(dev, "Port %d: default case!\n", port->port_number);
2808c2ecf20Sopenharmony_ci		port->psy_usb_type = POWER_SUPPLY_USB_TYPE_SDP;
2818c2ecf20Sopenharmony_ci	}
2828c2ecf20Sopenharmony_ci
2838c2ecf20Sopenharmony_ci	if (cros_usbpd_charger_port_is_dedicated(port))
2848c2ecf20Sopenharmony_ci		port->psy_desc.type = POWER_SUPPLY_TYPE_MAINS;
2858c2ecf20Sopenharmony_ci	else
2868c2ecf20Sopenharmony_ci		port->psy_desc.type = POWER_SUPPLY_TYPE_USB;
2878c2ecf20Sopenharmony_ci
2888c2ecf20Sopenharmony_ci	dev_dbg(dev,
2898c2ecf20Sopenharmony_ci		"Port %d: type=%d vmax=%d vnow=%d cmax=%d clim=%d pmax=%d\n",
2908c2ecf20Sopenharmony_ci		port->port_number, resp.type, resp.meas.voltage_max,
2918c2ecf20Sopenharmony_ci		resp.meas.voltage_now, resp.meas.current_max,
2928c2ecf20Sopenharmony_ci		resp.meas.current_lim, resp.max_power);
2938c2ecf20Sopenharmony_ci
2948c2ecf20Sopenharmony_ci	/*
2958c2ecf20Sopenharmony_ci	 * If power supply type or status changed, explicitly call
2968c2ecf20Sopenharmony_ci	 * power_supply_changed. This results in udev event getting generated
2978c2ecf20Sopenharmony_ci	 * and allows user mode apps to react quicker instead of waiting for
2988c2ecf20Sopenharmony_ci	 * their next poll of power supply status.
2998c2ecf20Sopenharmony_ci	 */
3008c2ecf20Sopenharmony_ci	if (last_psy_usb_type != port->psy_usb_type ||
3018c2ecf20Sopenharmony_ci	    last_psy_status != port->psy_status)
3028c2ecf20Sopenharmony_ci		power_supply_changed(port->psy);
3038c2ecf20Sopenharmony_ci
3048c2ecf20Sopenharmony_ci	return 0;
3058c2ecf20Sopenharmony_ci}
3068c2ecf20Sopenharmony_ci
3078c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_port_status(struct port_data *port,
3088c2ecf20Sopenharmony_ci					      bool ratelimit)
3098c2ecf20Sopenharmony_ci{
3108c2ecf20Sopenharmony_ci	int ret;
3118c2ecf20Sopenharmony_ci
3128c2ecf20Sopenharmony_ci	if (ratelimit &&
3138c2ecf20Sopenharmony_ci	    time_is_after_jiffies(port->last_update +
3148c2ecf20Sopenharmony_ci				  CHARGER_CACHE_UPDATE_DELAY))
3158c2ecf20Sopenharmony_ci		return 0;
3168c2ecf20Sopenharmony_ci
3178c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_get_power_info(port);
3188c2ecf20Sopenharmony_ci	if (ret < 0)
3198c2ecf20Sopenharmony_ci		return ret;
3208c2ecf20Sopenharmony_ci
3218c2ecf20Sopenharmony_ci	if (!cros_usbpd_charger_port_is_dedicated(port))
3228c2ecf20Sopenharmony_ci		ret = cros_usbpd_charger_get_discovery_info(port);
3238c2ecf20Sopenharmony_ci	port->last_update = jiffies;
3248c2ecf20Sopenharmony_ci
3258c2ecf20Sopenharmony_ci	return ret;
3268c2ecf20Sopenharmony_ci}
3278c2ecf20Sopenharmony_ci
3288c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_set_ext_power_limit(struct charger_data *charger,
3298c2ecf20Sopenharmony_ci						  u16 current_lim,
3308c2ecf20Sopenharmony_ci						  u16 voltage_lim)
3318c2ecf20Sopenharmony_ci{
3328c2ecf20Sopenharmony_ci	struct ec_params_external_power_limit_v1 req;
3338c2ecf20Sopenharmony_ci	int ret;
3348c2ecf20Sopenharmony_ci
3358c2ecf20Sopenharmony_ci	req.current_lim = current_lim;
3368c2ecf20Sopenharmony_ci	req.voltage_lim = voltage_lim;
3378c2ecf20Sopenharmony_ci
3388c2ecf20Sopenharmony_ci	ret = cros_usbpd_charger_ec_command(charger, 0,
3398c2ecf20Sopenharmony_ci					    EC_CMD_EXTERNAL_POWER_LIMIT,
3408c2ecf20Sopenharmony_ci					    &req, sizeof(req), NULL, 0);
3418c2ecf20Sopenharmony_ci	if (ret < 0)
3428c2ecf20Sopenharmony_ci		dev_err(charger->dev,
3438c2ecf20Sopenharmony_ci			"Unable to set the 'External Power Limit': %d\n", ret);
3448c2ecf20Sopenharmony_ci
3458c2ecf20Sopenharmony_ci	return ret;
3468c2ecf20Sopenharmony_ci}
3478c2ecf20Sopenharmony_ci
3488c2ecf20Sopenharmony_cistatic void cros_usbpd_charger_power_changed(struct power_supply *psy)
3498c2ecf20Sopenharmony_ci{
3508c2ecf20Sopenharmony_ci	struct port_data *port = power_supply_get_drvdata(psy);
3518c2ecf20Sopenharmony_ci	struct charger_data *charger = port->charger;
3528c2ecf20Sopenharmony_ci	int i;
3538c2ecf20Sopenharmony_ci
3548c2ecf20Sopenharmony_ci	for (i = 0; i < charger->num_registered_psy; i++)
3558c2ecf20Sopenharmony_ci		cros_usbpd_charger_get_port_status(charger->ports[i], false);
3568c2ecf20Sopenharmony_ci}
3578c2ecf20Sopenharmony_ci
3588c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_get_prop(struct power_supply *psy,
3598c2ecf20Sopenharmony_ci				       enum power_supply_property psp,
3608c2ecf20Sopenharmony_ci				       union power_supply_propval *val)
3618c2ecf20Sopenharmony_ci{
3628c2ecf20Sopenharmony_ci	struct port_data *port = power_supply_get_drvdata(psy);
3638c2ecf20Sopenharmony_ci	struct charger_data *charger = port->charger;
3648c2ecf20Sopenharmony_ci	struct cros_ec_device *ec_device = charger->ec_device;
3658c2ecf20Sopenharmony_ci	struct device *dev = charger->dev;
3668c2ecf20Sopenharmony_ci	int ret;
3678c2ecf20Sopenharmony_ci
3688c2ecf20Sopenharmony_ci	/* Only refresh ec_port_status for dynamic properties */
3698c2ecf20Sopenharmony_ci	switch (psp) {
3708c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_ONLINE:
3718c2ecf20Sopenharmony_ci		/*
3728c2ecf20Sopenharmony_ci		 * If mkbp_event_supported, then we can be assured that
3738c2ecf20Sopenharmony_ci		 * the driver's state for the online property is consistent
3748c2ecf20Sopenharmony_ci		 * with the hardware. However, if we aren't event driven,
3758c2ecf20Sopenharmony_ci		 * the optimization before to skip an ec_port_status get
3768c2ecf20Sopenharmony_ci		 * and only returned cached values of the online property will
3778c2ecf20Sopenharmony_ci		 * cause a delay in detecting a cable attach until one of the
3788c2ecf20Sopenharmony_ci		 * other properties are read.
3798c2ecf20Sopenharmony_ci		 *
3808c2ecf20Sopenharmony_ci		 * Allow an ec_port_status refresh for online property check
3818c2ecf20Sopenharmony_ci		 * if we're not already online to check for plug events if
3828c2ecf20Sopenharmony_ci		 * not mkbp_event_supported.
3838c2ecf20Sopenharmony_ci		 */
3848c2ecf20Sopenharmony_ci		if (ec_device->mkbp_event_supported || port->psy_online)
3858c2ecf20Sopenharmony_ci			break;
3868c2ecf20Sopenharmony_ci		fallthrough;
3878c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_CURRENT_MAX:
3888c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
3898c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
3908c2ecf20Sopenharmony_ci		ret = cros_usbpd_charger_get_port_status(port, true);
3918c2ecf20Sopenharmony_ci		if (ret < 0) {
3928c2ecf20Sopenharmony_ci			dev_err(dev, "Failed to get port status (err:0x%x)\n",
3938c2ecf20Sopenharmony_ci				ret);
3948c2ecf20Sopenharmony_ci			return -EINVAL;
3958c2ecf20Sopenharmony_ci		}
3968c2ecf20Sopenharmony_ci		break;
3978c2ecf20Sopenharmony_ci	default:
3988c2ecf20Sopenharmony_ci		break;
3998c2ecf20Sopenharmony_ci	}
4008c2ecf20Sopenharmony_ci
4018c2ecf20Sopenharmony_ci	switch (psp) {
4028c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_ONLINE:
4038c2ecf20Sopenharmony_ci		val->intval = port->psy_online;
4048c2ecf20Sopenharmony_ci		break;
4058c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_STATUS:
4068c2ecf20Sopenharmony_ci		val->intval = port->psy_status;
4078c2ecf20Sopenharmony_ci		break;
4088c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_CURRENT_MAX:
4098c2ecf20Sopenharmony_ci		val->intval = port->psy_current_max * 1000;
4108c2ecf20Sopenharmony_ci		break;
4118c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
4128c2ecf20Sopenharmony_ci		val->intval = port->psy_voltage_max_design * 1000;
4138c2ecf20Sopenharmony_ci		break;
4148c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
4158c2ecf20Sopenharmony_ci		val->intval = port->psy_voltage_now * 1000;
4168c2ecf20Sopenharmony_ci		break;
4178c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_USB_TYPE:
4188c2ecf20Sopenharmony_ci		val->intval = port->psy_usb_type;
4198c2ecf20Sopenharmony_ci		break;
4208c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
4218c2ecf20Sopenharmony_ci		if (input_current_limit == EC_POWER_LIMIT_NONE)
4228c2ecf20Sopenharmony_ci			val->intval = -1;
4238c2ecf20Sopenharmony_ci		else
4248c2ecf20Sopenharmony_ci			val->intval = input_current_limit * 1000;
4258c2ecf20Sopenharmony_ci		break;
4268c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
4278c2ecf20Sopenharmony_ci		if (input_voltage_limit == EC_POWER_LIMIT_NONE)
4288c2ecf20Sopenharmony_ci			val->intval = -1;
4298c2ecf20Sopenharmony_ci		else
4308c2ecf20Sopenharmony_ci			val->intval = input_voltage_limit * 1000;
4318c2ecf20Sopenharmony_ci		break;
4328c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_MODEL_NAME:
4338c2ecf20Sopenharmony_ci		val->strval = port->model_name;
4348c2ecf20Sopenharmony_ci		break;
4358c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_MANUFACTURER:
4368c2ecf20Sopenharmony_ci		val->strval = port->manufacturer;
4378c2ecf20Sopenharmony_ci		break;
4388c2ecf20Sopenharmony_ci	default:
4398c2ecf20Sopenharmony_ci		return -EINVAL;
4408c2ecf20Sopenharmony_ci	}
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci	return 0;
4438c2ecf20Sopenharmony_ci}
4448c2ecf20Sopenharmony_ci
4458c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_set_prop(struct power_supply *psy,
4468c2ecf20Sopenharmony_ci				       enum power_supply_property psp,
4478c2ecf20Sopenharmony_ci				       const union power_supply_propval *val)
4488c2ecf20Sopenharmony_ci{
4498c2ecf20Sopenharmony_ci	struct port_data *port = power_supply_get_drvdata(psy);
4508c2ecf20Sopenharmony_ci	struct charger_data *charger = port->charger;
4518c2ecf20Sopenharmony_ci	struct device *dev = charger->dev;
4528c2ecf20Sopenharmony_ci	u16 intval;
4538c2ecf20Sopenharmony_ci	int ret;
4548c2ecf20Sopenharmony_ci
4558c2ecf20Sopenharmony_ci	/* U16_MAX in mV/mA is the maximum supported value */
4568c2ecf20Sopenharmony_ci	if (val->intval >= U16_MAX * 1000)
4578c2ecf20Sopenharmony_ci		return -EINVAL;
4588c2ecf20Sopenharmony_ci	/* A negative number is used to clear the limit */
4598c2ecf20Sopenharmony_ci	if (val->intval < 0)
4608c2ecf20Sopenharmony_ci		intval = EC_POWER_LIMIT_NONE;
4618c2ecf20Sopenharmony_ci	else	/* Convert from uA/uV to mA/mV */
4628c2ecf20Sopenharmony_ci		intval = val->intval / 1000;
4638c2ecf20Sopenharmony_ci
4648c2ecf20Sopenharmony_ci	switch (psp) {
4658c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
4668c2ecf20Sopenharmony_ci		ret = cros_usbpd_charger_set_ext_power_limit(charger, intval,
4678c2ecf20Sopenharmony_ci							input_voltage_limit);
4688c2ecf20Sopenharmony_ci		if (ret < 0)
4698c2ecf20Sopenharmony_ci			break;
4708c2ecf20Sopenharmony_ci
4718c2ecf20Sopenharmony_ci		input_current_limit = intval;
4728c2ecf20Sopenharmony_ci		if (input_current_limit == EC_POWER_LIMIT_NONE)
4738c2ecf20Sopenharmony_ci			dev_info(dev,
4748c2ecf20Sopenharmony_ci			  "External Current Limit cleared for all ports\n");
4758c2ecf20Sopenharmony_ci		else
4768c2ecf20Sopenharmony_ci			dev_info(dev,
4778c2ecf20Sopenharmony_ci			  "External Current Limit set to %dmA for all ports\n",
4788c2ecf20Sopenharmony_ci			  input_current_limit);
4798c2ecf20Sopenharmony_ci		break;
4808c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
4818c2ecf20Sopenharmony_ci		ret = cros_usbpd_charger_set_ext_power_limit(charger,
4828c2ecf20Sopenharmony_ci							input_current_limit,
4838c2ecf20Sopenharmony_ci							intval);
4848c2ecf20Sopenharmony_ci		if (ret < 0)
4858c2ecf20Sopenharmony_ci			break;
4868c2ecf20Sopenharmony_ci
4878c2ecf20Sopenharmony_ci		input_voltage_limit = intval;
4888c2ecf20Sopenharmony_ci		if (input_voltage_limit == EC_POWER_LIMIT_NONE)
4898c2ecf20Sopenharmony_ci			dev_info(dev,
4908c2ecf20Sopenharmony_ci			  "External Voltage Limit cleared for all ports\n");
4918c2ecf20Sopenharmony_ci		else
4928c2ecf20Sopenharmony_ci			dev_info(dev,
4938c2ecf20Sopenharmony_ci			  "External Voltage Limit set to %dmV for all ports\n",
4948c2ecf20Sopenharmony_ci			  input_voltage_limit);
4958c2ecf20Sopenharmony_ci		break;
4968c2ecf20Sopenharmony_ci	default:
4978c2ecf20Sopenharmony_ci		ret = -EINVAL;
4988c2ecf20Sopenharmony_ci	}
4998c2ecf20Sopenharmony_ci
5008c2ecf20Sopenharmony_ci	return ret;
5018c2ecf20Sopenharmony_ci}
5028c2ecf20Sopenharmony_ci
5038c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_property_is_writeable(struct power_supply *psy,
5048c2ecf20Sopenharmony_ci						enum power_supply_property psp)
5058c2ecf20Sopenharmony_ci{
5068c2ecf20Sopenharmony_ci	int ret;
5078c2ecf20Sopenharmony_ci
5088c2ecf20Sopenharmony_ci	switch (psp) {
5098c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
5108c2ecf20Sopenharmony_ci	case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
5118c2ecf20Sopenharmony_ci		ret = 1;
5128c2ecf20Sopenharmony_ci		break;
5138c2ecf20Sopenharmony_ci	default:
5148c2ecf20Sopenharmony_ci		ret = 0;
5158c2ecf20Sopenharmony_ci	}
5168c2ecf20Sopenharmony_ci
5178c2ecf20Sopenharmony_ci	return ret;
5188c2ecf20Sopenharmony_ci}
5198c2ecf20Sopenharmony_ci
5208c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_ec_event(struct notifier_block *nb,
5218c2ecf20Sopenharmony_ci				       unsigned long host_event,
5228c2ecf20Sopenharmony_ci				       void *_notify)
5238c2ecf20Sopenharmony_ci{
5248c2ecf20Sopenharmony_ci	struct charger_data *charger = container_of(nb, struct charger_data,
5258c2ecf20Sopenharmony_ci						    notifier);
5268c2ecf20Sopenharmony_ci
5278c2ecf20Sopenharmony_ci	cros_usbpd_charger_power_changed(charger->ports[0]->psy);
5288c2ecf20Sopenharmony_ci	return NOTIFY_OK;
5298c2ecf20Sopenharmony_ci}
5308c2ecf20Sopenharmony_ci
5318c2ecf20Sopenharmony_cistatic void cros_usbpd_charger_unregister_notifier(void *data)
5328c2ecf20Sopenharmony_ci{
5338c2ecf20Sopenharmony_ci	struct charger_data *charger = data;
5348c2ecf20Sopenharmony_ci
5358c2ecf20Sopenharmony_ci	cros_usbpd_unregister_notify(&charger->notifier);
5368c2ecf20Sopenharmony_ci}
5378c2ecf20Sopenharmony_ci
5388c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_probe(struct platform_device *pd)
5398c2ecf20Sopenharmony_ci{
5408c2ecf20Sopenharmony_ci	struct cros_ec_dev *ec_dev = dev_get_drvdata(pd->dev.parent);
5418c2ecf20Sopenharmony_ci	struct cros_ec_device *ec_device = ec_dev->ec_dev;
5428c2ecf20Sopenharmony_ci	struct power_supply_desc *psy_desc;
5438c2ecf20Sopenharmony_ci	struct device *dev = &pd->dev;
5448c2ecf20Sopenharmony_ci	struct charger_data *charger;
5458c2ecf20Sopenharmony_ci	struct power_supply *psy;
5468c2ecf20Sopenharmony_ci	struct port_data *port;
5478c2ecf20Sopenharmony_ci	int ret = -EINVAL;
5488c2ecf20Sopenharmony_ci	int i;
5498c2ecf20Sopenharmony_ci
5508c2ecf20Sopenharmony_ci	charger = devm_kzalloc(dev, sizeof(struct charger_data),
5518c2ecf20Sopenharmony_ci			       GFP_KERNEL);
5528c2ecf20Sopenharmony_ci	if (!charger)
5538c2ecf20Sopenharmony_ci		return -ENOMEM;
5548c2ecf20Sopenharmony_ci
5558c2ecf20Sopenharmony_ci	charger->dev = dev;
5568c2ecf20Sopenharmony_ci	charger->ec_dev = ec_dev;
5578c2ecf20Sopenharmony_ci	charger->ec_device = ec_device;
5588c2ecf20Sopenharmony_ci
5598c2ecf20Sopenharmony_ci	platform_set_drvdata(pd, charger);
5608c2ecf20Sopenharmony_ci
5618c2ecf20Sopenharmony_ci	/*
5628c2ecf20Sopenharmony_ci	 * We need to know the number of USB PD ports in order to know whether
5638c2ecf20Sopenharmony_ci	 * there is a dedicated port. The dedicated port will always be
5648c2ecf20Sopenharmony_ci	 * after the USB PD ports, and there should be only one.
5658c2ecf20Sopenharmony_ci	 */
5668c2ecf20Sopenharmony_ci	charger->num_usbpd_ports =
5678c2ecf20Sopenharmony_ci		cros_usbpd_charger_get_usbpd_num_ports(charger);
5688c2ecf20Sopenharmony_ci	if (charger->num_usbpd_ports <= 0) {
5698c2ecf20Sopenharmony_ci		/*
5708c2ecf20Sopenharmony_ci		 * This can happen on a system that doesn't support USB PD.
5718c2ecf20Sopenharmony_ci		 * Log a message, but no need to warn.
5728c2ecf20Sopenharmony_ci		 */
5738c2ecf20Sopenharmony_ci		dev_info(dev, "No USB PD charging ports found\n");
5748c2ecf20Sopenharmony_ci	}
5758c2ecf20Sopenharmony_ci
5768c2ecf20Sopenharmony_ci	charger->num_charger_ports = cros_usbpd_charger_get_num_ports(charger);
5778c2ecf20Sopenharmony_ci	if (charger->num_charger_ports < 0) {
5788c2ecf20Sopenharmony_ci		/*
5798c2ecf20Sopenharmony_ci		 * This can happen on a system that doesn't support USB PD.
5808c2ecf20Sopenharmony_ci		 * Log a message, but no need to warn.
5818c2ecf20Sopenharmony_ci		 * Older ECs do not support the above command, in that case
5828c2ecf20Sopenharmony_ci		 * let's set up the number of charger ports equal to the number
5838c2ecf20Sopenharmony_ci		 * of USB PD ports
5848c2ecf20Sopenharmony_ci		 */
5858c2ecf20Sopenharmony_ci		dev_info(dev, "Could not get charger port count\n");
5868c2ecf20Sopenharmony_ci		charger->num_charger_ports = charger->num_usbpd_ports;
5878c2ecf20Sopenharmony_ci	}
5888c2ecf20Sopenharmony_ci
5898c2ecf20Sopenharmony_ci	if (charger->num_charger_ports <= 0) {
5908c2ecf20Sopenharmony_ci		/*
5918c2ecf20Sopenharmony_ci		 * This can happen on a system that doesn't support USB PD and
5928c2ecf20Sopenharmony_ci		 * doesn't have a dedicated port.
5938c2ecf20Sopenharmony_ci		 * Log a message, but no need to warn.
5948c2ecf20Sopenharmony_ci		 */
5958c2ecf20Sopenharmony_ci		dev_info(dev, "No charging ports found\n");
5968c2ecf20Sopenharmony_ci		ret = -ENODEV;
5978c2ecf20Sopenharmony_ci		goto fail_nowarn;
5988c2ecf20Sopenharmony_ci	}
5998c2ecf20Sopenharmony_ci
6008c2ecf20Sopenharmony_ci	/*
6018c2ecf20Sopenharmony_ci	 * Sanity checks on the number of ports:
6028c2ecf20Sopenharmony_ci	 *  there should be at most 1 dedicated port
6038c2ecf20Sopenharmony_ci	 */
6048c2ecf20Sopenharmony_ci	if (charger->num_charger_ports < charger->num_usbpd_ports ||
6058c2ecf20Sopenharmony_ci	    charger->num_charger_ports > (charger->num_usbpd_ports + 1)) {
6068c2ecf20Sopenharmony_ci		dev_err(dev, "Unexpected number of charge port count\n");
6078c2ecf20Sopenharmony_ci		ret = -EPROTO;
6088c2ecf20Sopenharmony_ci		goto fail_nowarn;
6098c2ecf20Sopenharmony_ci	}
6108c2ecf20Sopenharmony_ci
6118c2ecf20Sopenharmony_ci	for (i = 0; i < charger->num_charger_ports; i++) {
6128c2ecf20Sopenharmony_ci		struct power_supply_config psy_cfg = {};
6138c2ecf20Sopenharmony_ci
6148c2ecf20Sopenharmony_ci		port = devm_kzalloc(dev, sizeof(struct port_data), GFP_KERNEL);
6158c2ecf20Sopenharmony_ci		if (!port) {
6168c2ecf20Sopenharmony_ci			ret = -ENOMEM;
6178c2ecf20Sopenharmony_ci			goto fail;
6188c2ecf20Sopenharmony_ci		}
6198c2ecf20Sopenharmony_ci
6208c2ecf20Sopenharmony_ci		port->charger = charger;
6218c2ecf20Sopenharmony_ci		port->port_number = i;
6228c2ecf20Sopenharmony_ci
6238c2ecf20Sopenharmony_ci		psy_desc = &port->psy_desc;
6248c2ecf20Sopenharmony_ci		psy_desc->get_property = cros_usbpd_charger_get_prop;
6258c2ecf20Sopenharmony_ci		psy_desc->set_property = cros_usbpd_charger_set_prop;
6268c2ecf20Sopenharmony_ci		psy_desc->property_is_writeable =
6278c2ecf20Sopenharmony_ci				cros_usbpd_charger_property_is_writeable;
6288c2ecf20Sopenharmony_ci		psy_desc->external_power_changed =
6298c2ecf20Sopenharmony_ci					cros_usbpd_charger_power_changed;
6308c2ecf20Sopenharmony_ci		psy_cfg.drv_data = port;
6318c2ecf20Sopenharmony_ci
6328c2ecf20Sopenharmony_ci		if (cros_usbpd_charger_port_is_dedicated(port)) {
6338c2ecf20Sopenharmony_ci			sprintf(port->name, CHARGER_DEDICATED_DIR_NAME);
6348c2ecf20Sopenharmony_ci			psy_desc->type = POWER_SUPPLY_TYPE_MAINS;
6358c2ecf20Sopenharmony_ci			psy_desc->properties =
6368c2ecf20Sopenharmony_ci				cros_usbpd_dedicated_charger_props;
6378c2ecf20Sopenharmony_ci			psy_desc->num_properties =
6388c2ecf20Sopenharmony_ci				ARRAY_SIZE(cros_usbpd_dedicated_charger_props);
6398c2ecf20Sopenharmony_ci		} else {
6408c2ecf20Sopenharmony_ci			sprintf(port->name, CHARGER_USBPD_DIR_NAME, i);
6418c2ecf20Sopenharmony_ci			psy_desc->type = POWER_SUPPLY_TYPE_USB;
6428c2ecf20Sopenharmony_ci			psy_desc->properties = cros_usbpd_charger_props;
6438c2ecf20Sopenharmony_ci			psy_desc->num_properties =
6448c2ecf20Sopenharmony_ci				ARRAY_SIZE(cros_usbpd_charger_props);
6458c2ecf20Sopenharmony_ci			psy_desc->usb_types = cros_usbpd_charger_usb_types;
6468c2ecf20Sopenharmony_ci			psy_desc->num_usb_types =
6478c2ecf20Sopenharmony_ci				ARRAY_SIZE(cros_usbpd_charger_usb_types);
6488c2ecf20Sopenharmony_ci		}
6498c2ecf20Sopenharmony_ci
6508c2ecf20Sopenharmony_ci		psy_desc->name = port->name;
6518c2ecf20Sopenharmony_ci
6528c2ecf20Sopenharmony_ci		psy = devm_power_supply_register_no_ws(dev, psy_desc,
6538c2ecf20Sopenharmony_ci						       &psy_cfg);
6548c2ecf20Sopenharmony_ci		if (IS_ERR(psy)) {
6558c2ecf20Sopenharmony_ci			dev_err(dev, "Failed to register power supply\n");
6568c2ecf20Sopenharmony_ci			continue;
6578c2ecf20Sopenharmony_ci		}
6588c2ecf20Sopenharmony_ci		port->psy = psy;
6598c2ecf20Sopenharmony_ci
6608c2ecf20Sopenharmony_ci		charger->ports[charger->num_registered_psy++] = port;
6618c2ecf20Sopenharmony_ci	}
6628c2ecf20Sopenharmony_ci
6638c2ecf20Sopenharmony_ci	if (!charger->num_registered_psy) {
6648c2ecf20Sopenharmony_ci		ret = -ENODEV;
6658c2ecf20Sopenharmony_ci		dev_err(dev, "No power supplies registered\n");
6668c2ecf20Sopenharmony_ci		goto fail;
6678c2ecf20Sopenharmony_ci	}
6688c2ecf20Sopenharmony_ci
6698c2ecf20Sopenharmony_ci	/* Get PD events from the EC */
6708c2ecf20Sopenharmony_ci	charger->notifier.notifier_call = cros_usbpd_charger_ec_event;
6718c2ecf20Sopenharmony_ci	ret = cros_usbpd_register_notify(&charger->notifier);
6728c2ecf20Sopenharmony_ci	if (ret < 0) {
6738c2ecf20Sopenharmony_ci		dev_warn(dev, "failed to register notifier\n");
6748c2ecf20Sopenharmony_ci	} else {
6758c2ecf20Sopenharmony_ci		ret = devm_add_action_or_reset(dev,
6768c2ecf20Sopenharmony_ci				cros_usbpd_charger_unregister_notifier,
6778c2ecf20Sopenharmony_ci				charger);
6788c2ecf20Sopenharmony_ci		if (ret < 0)
6798c2ecf20Sopenharmony_ci			goto fail;
6808c2ecf20Sopenharmony_ci	}
6818c2ecf20Sopenharmony_ci
6828c2ecf20Sopenharmony_ci	return 0;
6838c2ecf20Sopenharmony_ci
6848c2ecf20Sopenharmony_cifail:
6858c2ecf20Sopenharmony_ci	WARN(1, "%s: Failing probe (err:0x%x)\n", dev_name(dev), ret);
6868c2ecf20Sopenharmony_ci
6878c2ecf20Sopenharmony_cifail_nowarn:
6888c2ecf20Sopenharmony_ci	dev_info(dev, "Failing probe (err:0x%x)\n", ret);
6898c2ecf20Sopenharmony_ci	return ret;
6908c2ecf20Sopenharmony_ci}
6918c2ecf20Sopenharmony_ci
6928c2ecf20Sopenharmony_ci#ifdef CONFIG_PM_SLEEP
6938c2ecf20Sopenharmony_cistatic int cros_usbpd_charger_resume(struct device *dev)
6948c2ecf20Sopenharmony_ci{
6958c2ecf20Sopenharmony_ci	struct charger_data *charger = dev_get_drvdata(dev);
6968c2ecf20Sopenharmony_ci	int i;
6978c2ecf20Sopenharmony_ci
6988c2ecf20Sopenharmony_ci	if (!charger)
6998c2ecf20Sopenharmony_ci		return 0;
7008c2ecf20Sopenharmony_ci
7018c2ecf20Sopenharmony_ci	for (i = 0; i < charger->num_registered_psy; i++) {
7028c2ecf20Sopenharmony_ci		power_supply_changed(charger->ports[i]->psy);
7038c2ecf20Sopenharmony_ci		charger->ports[i]->last_update =
7048c2ecf20Sopenharmony_ci				jiffies - CHARGER_CACHE_UPDATE_DELAY;
7058c2ecf20Sopenharmony_ci	}
7068c2ecf20Sopenharmony_ci
7078c2ecf20Sopenharmony_ci	return 0;
7088c2ecf20Sopenharmony_ci}
7098c2ecf20Sopenharmony_ci#endif
7108c2ecf20Sopenharmony_ci
7118c2ecf20Sopenharmony_cistatic SIMPLE_DEV_PM_OPS(cros_usbpd_charger_pm_ops, NULL,
7128c2ecf20Sopenharmony_ci			 cros_usbpd_charger_resume);
7138c2ecf20Sopenharmony_ci
7148c2ecf20Sopenharmony_cistatic struct platform_driver cros_usbpd_charger_driver = {
7158c2ecf20Sopenharmony_ci	.driver = {
7168c2ecf20Sopenharmony_ci		.name = DRV_NAME,
7178c2ecf20Sopenharmony_ci		.pm = &cros_usbpd_charger_pm_ops,
7188c2ecf20Sopenharmony_ci	},
7198c2ecf20Sopenharmony_ci	.probe = cros_usbpd_charger_probe
7208c2ecf20Sopenharmony_ci};
7218c2ecf20Sopenharmony_ci
7228c2ecf20Sopenharmony_cimodule_platform_driver(cros_usbpd_charger_driver);
7238c2ecf20Sopenharmony_ci
7248c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
7258c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("ChromeOS EC USBPD charger");
7268c2ecf20Sopenharmony_ciMODULE_ALIAS("platform:" DRV_NAME);
727