Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2)  * universal charger driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (C) 2016 Fuzhou Rockchip Electronics Co., Ltd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * This program is free software; you can redistribute it and/or modify
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  * it under the terms of the GNU General Public License as published by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * the Free Software Foundation; either version 2 of the License, or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * (at your option) any later version.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * This program is distributed in the hope that it will be useful,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  * but WITHOUT ANY WARRANTY; without even the implied warranty of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  * GNU General Public License for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/extcon.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/of_gpio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/power_supply.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/power/rk_usbbc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/property.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/workqueue.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) enum charger_t {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	USB_TYPE_UNKNOWN_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	USB_TYPE_NONE_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	USB_TYPE_USB_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	USB_TYPE_AC_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	USB_TYPE_CDP_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	DC_TYPE_DC_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	DC_TYPE_NONE_CHARGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) struct universal_charger {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	struct power_supply *usb_psy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	struct workqueue_struct *usb_charger_wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	struct delayed_work usb_work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	struct workqueue_struct *dc_charger_wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	struct delayed_work dc_work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct delayed_work discnt_work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	struct notifier_block cable_cg_nb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	struct notifier_block cable_discnt_nb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	unsigned int bc_event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	enum charger_t usb_charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	enum charger_t dc_charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	bool extcon;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	struct extcon_dev *cable_edev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	struct gpio_desc *dc_det_pin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	bool support_dc_det;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) static void universal_cg_bc_evt_worker(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	struct universal_charger *cg =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 		container_of(work, struct universal_charger, usb_work.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	struct extcon_dev *edev = cg->cable_edev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	enum charger_t charger = USB_TYPE_UNKNOWN_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	const char *event[5] = {"UN", "NONE", "USB", "AC", "CDP1.5A"};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	/* Determine cable/charger type */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	if (extcon_get_cable_state_(edev, EXTCON_CHG_USB_SDP) > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 		charger = USB_TYPE_USB_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	else if (extcon_get_cable_state_(edev, EXTCON_CHG_USB_DCP) > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 		charger = USB_TYPE_AC_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	else if (extcon_get_cable_state_(edev, EXTCON_CHG_USB_CDP) > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 		charger = USB_TYPE_CDP_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	else if (extcon_get_cable_state_(edev, EXTCON_CHG_USB_DCP) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 		charger = USB_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	else if (extcon_get_cable_state_(edev, EXTCON_CHG_USB_CDP) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		charger = USB_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	if (charger != USB_TYPE_UNKNOWN_CHARGER) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		dev_info(cg->dev, "receive usb notifier event: %s...\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 			 event[charger]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		cg->usb_charger = charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) static int universal_cg_charger_evt_notifier(struct notifier_block *nb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 					     unsigned long event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 					     void *ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	struct universal_charger *cg =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		container_of(nb, struct universal_charger, cable_cg_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	queue_delayed_work(cg->usb_charger_wq, &cg->usb_work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 			   msecs_to_jiffies(10));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) static void universal_cg_discnt_evt_worker(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	struct universal_charger *cg = container_of(work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 			struct universal_charger, discnt_work.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	if (extcon_get_cable_state_(cg->cable_edev, EXTCON_USB) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		dev_info(cg->dev, "receive usb notifier event: DISCNT...\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		cg->usb_charger = USB_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) static int universal_cg_discnt_evt_notfier(struct notifier_block *nb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 					   unsigned long event, void *ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	struct universal_charger *cg =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		container_of(nb, struct universal_charger, cable_discnt_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	queue_delayed_work(cg->usb_charger_wq, &cg->discnt_work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 			   msecs_to_jiffies(10));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) static int universal_cg_init_usb(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	struct device *dev = cg->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	struct extcon_dev *edev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	if (!cg->extcon)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	edev = extcon_get_edev_by_phandle(dev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	if (IS_ERR(edev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		if (PTR_ERR(edev) != -EPROBE_DEFER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 			dev_err(dev, "Invalid or missing extcon\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 		return PTR_ERR(edev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	cg->usb_charger_wq = alloc_ordered_workqueue("%s",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 				WQ_MEM_RECLAIM | WQ_FREEZABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 				"universal-usb-wq");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	if (!cg->usb_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	cg->usb_charger = USB_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	/* Register chargers  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	INIT_DELAYED_WORK(&cg->usb_work, universal_cg_bc_evt_worker);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	cg->cable_cg_nb.notifier_call = universal_cg_charger_evt_notifier;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	ret = devm_extcon_register_notifier(dev, edev, EXTCON_CHG_USB_SDP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 					    &cg->cable_cg_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		dev_err(dev, "failed to register notifier for SDP\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 		goto __fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	ret = devm_extcon_register_notifier(dev, edev, EXTCON_CHG_USB_DCP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 					    &cg->cable_cg_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 		dev_err(dev, "failed to register notifier for DCP\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 		goto __fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	ret = devm_extcon_register_notifier(dev, edev, EXTCON_CHG_USB_CDP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 					    &cg->cable_cg_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		dev_err(dev, "failed to register notifier for CDP\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		goto __fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	/* Register discnt usb */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	INIT_DELAYED_WORK(&cg->discnt_work, universal_cg_discnt_evt_worker);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	cg->cable_discnt_nb.notifier_call = universal_cg_discnt_evt_notfier;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	ret = devm_extcon_register_notifier(dev, edev, EXTCON_USB,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 					    &cg->cable_discnt_nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		dev_err(dev, "failed to register notifier for HOST\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		goto __fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	cg->cable_edev = edev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	schedule_delayed_work(&cg->usb_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	dev_info(cg->dev, "register extcon evt notifier\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) __fail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	destroy_workqueue(cg->usb_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) static enum power_supply_property universal_usb_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	POWER_SUPPLY_PROP_ONLINE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	POWER_SUPPLY_PROP_STATUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) static int universal_cg_usb_get_property(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 					 enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 					 union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	struct universal_charger *cg = power_supply_get_drvdata(psy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	int online = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	if (cg->usb_charger != USB_TYPE_UNKNOWN_CHARGER &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	    cg->usb_charger != USB_TYPE_NONE_CHARGER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		online = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	if (cg->dc_charger != DC_TYPE_NONE_CHARGER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 		online = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	case POWER_SUPPLY_PROP_ONLINE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		val->intval = online;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		dev_dbg(cg->dev, "report online: %d\n", val->intval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	case POWER_SUPPLY_PROP_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		if (online)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			val->intval = POWER_SUPPLY_STATUS_CHARGING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 			val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		dev_dbg(cg->dev, "report prop: %d\n", val->intval);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) static const struct power_supply_desc universal_usb_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	.name		= "universal_usb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	.type		= POWER_SUPPLY_TYPE_USB,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	.properties	= universal_usb_props,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	.num_properties	= ARRAY_SIZE(universal_usb_props),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	.get_property	= universal_cg_usb_get_property,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) static int universal_cg_init_power_supply(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	struct power_supply_config psy_cfg = { .drv_data = cg, };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	cg->usb_psy = devm_power_supply_register(cg->dev, &universal_usb_desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 						 &psy_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	if (IS_ERR(cg->usb_psy)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		dev_err(cg->dev, "register usb power supply fail\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 		return PTR_ERR(cg->usb_psy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) static int universal_charger_parse_dt(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	struct device *dev = cg->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	cg->dc_det_pin = devm_gpiod_get_optional(dev, "dc-det",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 						    GPIOD_IN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	if (!IS_ERR_OR_NULL(cg->dc_det_pin)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		cg->support_dc_det = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 		dev_err(dev, "invalid dc det gpio!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		cg->support_dc_det = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) static int universal_charger_parse_dt(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) static enum
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) charger_t universal_charger_get_dc_state(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	return (gpiod_get_value(cg->dc_det_pin)) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		DC_TYPE_DC_CHARGER : DC_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) static void universal_charger_dc_det_worker(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	enum charger_t charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	struct universal_charger *cg = container_of(work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 			struct universal_charger, dc_work.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	charger = universal_charger_get_dc_state(cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	if (charger == DC_TYPE_DC_CHARGER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		cg->dc_charger = charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 		cg->dc_charger = DC_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) static irqreturn_t universal_charger_dc_det_isr(int irq, void *charger)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	struct universal_charger *cg = (struct universal_charger *)charger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	queue_delayed_work(cg->dc_charger_wq, &cg->dc_work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 			   msecs_to_jiffies(10));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) static int universal_charger_init_dc(struct universal_charger *cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	unsigned long irq_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	unsigned int dc_det_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	if (!cg->support_dc_det)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	cg->dc_charger_wq = alloc_ordered_workqueue("%s",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 				WQ_MEM_RECLAIM | WQ_FREEZABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 				"universal-dc-wq");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	if (!cg->dc_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	INIT_DELAYED_WORK(&cg->dc_work, universal_charger_dc_det_worker);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	cg->dc_charger = DC_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	if (gpiod_get_value(cg->dc_det_pin))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		cg->dc_charger = DC_TYPE_DC_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 		cg->dc_charger = DC_TYPE_NONE_CHARGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	dc_det_irq = gpiod_to_irq(cg->dc_det_pin);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	ret = devm_request_irq(cg->dev, dc_det_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 			       universal_charger_dc_det_isr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 			       irq_flags, "universal_dc_det", cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	if (ret != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 		destroy_workqueue(cg->dc_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 		dev_err(cg->dev, "universal_dc_det_irq request failed!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	enable_irq_wake(dc_det_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) static int universal_charger_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	struct universal_charger *cg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	cg = devm_kzalloc(&pdev->dev, sizeof(*cg), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	if (!cg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	cg->dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 	universal_charger_parse_dt(cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	ret = universal_charger_init_dc(cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		dev_err(cg->dev, "init dc failed!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	cg->extcon = device_property_read_bool(cg->dev, "extcon");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	ret = universal_cg_init_usb(cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 		dev_err(cg->dev, "init usb failed!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 		goto __init_usb_fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 	ret = universal_cg_init_power_supply(cg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 		dev_err(cg->dev, "init power supply fail!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 		goto ___init_psy_fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	dev_info(cg->dev, "driver registered\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) ___init_psy_fail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	if (cg->usb_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 		destroy_workqueue(cg->usb_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) __init_usb_fail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	if (cg->dc_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 		destroy_workqueue(cg->dc_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) static int universal_charger_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	struct universal_charger *cg = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	if (cg->usb_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 		destroy_workqueue(cg->usb_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 	if (cg->dc_charger_wq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 		destroy_workqueue(cg->dc_charger_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) static const struct of_device_id universal_charger_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 		.compatible = "universal-charger",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	{},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) static struct platform_driver universal_charger_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	.probe = universal_charger_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 	.remove = universal_charger_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		.name	= "universal-charger",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 		.of_match_table = universal_charger_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) module_platform_driver(universal_charger_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) MODULE_ALIAS("platform:universal-charger");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) MODULE_AUTHOR("chen Shunqing<csq@rock-chips.com>");