usb_notifier.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2019-2023 Samsung Electronics Co. Ltd.
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation; either version 2 of the License, or
  8. * (at your option) any later version.
  9. */
  10. #define pr_fmt(fmt) "usb_notifier: " fmt
  11. #include <linux/module.h>
  12. #include <linux/delay.h>
  13. #include <linux/usb_notify.h>
  14. #ifdef CONFIG_OF
  15. #include <linux/of_device.h>
  16. #include <linux/of_gpio.h>
  17. #endif
  18. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  19. #include <linux/usb/typec/common/pdic_notifier.h>
  20. #endif
  21. #if IS_ENABLED(CONFIG_MUIC_NOTIFIER)
  22. #include <linux/muic/common/muic.h>
  23. #include <linux/muic/common/muic_notifier.h>
  24. #endif
  25. #if IS_ENABLED(CONFIG_VBUS_NOTIFIER)
  26. #include <linux/vbus_notifier.h>
  27. #endif
  28. #if IS_ENABLED(CONFIG_USB_TYPEC_MANAGER_NOTIFIER)
  29. #include <linux/usb/typec/manager/usb_typec_manager_notifier.h>
  30. #endif
  31. #include <linux/battery/sec_battery_common.h>
  32. #if IS_ENABLED(CONFIG_COMBO_REDRIVER_PS5169)
  33. #include <linux/combo_redriver/ps5169.h>
  34. #endif
  35. #include "usb_notifier.h"
  36. struct usb_notifier_platform_data {
  37. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  38. struct notifier_block ccic_usb_nb;
  39. int is_host;
  40. #endif
  41. #if IS_ENABLED(CONFIG_MUIC_NOTIFIER)
  42. struct notifier_block muic_usb_nb;
  43. #endif
  44. #if IS_ENABLED(CONFIG_VBUS_NOTIFIER)
  45. struct notifier_block vbus_nb;
  46. #endif
  47. int gpio_redriver_en;
  48. int disable_control_en;
  49. int unsupport_host_en;
  50. int support_reverse_bypass_en;
  51. };
  52. #ifdef CONFIG_OF
  53. static void of_get_usb_redriver_dt(struct device_node *np,
  54. struct usb_notifier_platform_data *pdata)
  55. {
  56. pdata->gpio_redriver_en = of_get_named_gpio(np, "qcom,gpios_redriver_en", 0);
  57. if (pdata->gpio_redriver_en < 0)
  58. pr_info("There is not USB 3.0 redriver pin\n");
  59. if (!gpio_is_valid(pdata->gpio_redriver_en))
  60. pr_err("%s: usb30_redriver_en: Invalied gpio pins\n", __func__);
  61. pr_info("redriver_en : %d\n", pdata->gpio_redriver_en);
  62. }
  63. static void of_get_disable_control_en_dt(struct device_node *np,
  64. struct usb_notifier_platform_data *pdata)
  65. {
  66. of_property_read_u32(np, "qcom,disable_control_en", &pdata->disable_control_en);
  67. pr_info("disable_control_en : %d\n", pdata->disable_control_en);
  68. }
  69. static void of_get_unsupport_host_dt(struct device_node *np,
  70. struct usb_notifier_platform_data *pdata)
  71. {
  72. of_property_read_u32(np, "qcom,unsupport_host_en", &pdata->unsupport_host_en);
  73. pr_info("unsupport_host_en : %d\n", pdata->unsupport_host_en);
  74. }
  75. static void of_get_support_reverse_bypass_dt(struct device_node *np,
  76. struct usb_notifier_platform_data *pdata)
  77. {
  78. pdata->support_reverse_bypass_en = of_property_read_bool(np, "support_reverse_bypass_en");
  79. pr_info("support_reverse_bypass_en : %d\n", pdata->support_reverse_bypass_en);
  80. }
  81. static int of_usb_notifier_dt(struct device *dev,
  82. struct usb_notifier_platform_data *pdata)
  83. {
  84. struct device_node *np = dev->of_node;
  85. if (!np)
  86. return -EINVAL;
  87. of_get_usb_redriver_dt(np, pdata);
  88. of_get_disable_control_en_dt(np, pdata);
  89. of_get_unsupport_host_dt(np, pdata);
  90. of_get_support_reverse_bypass_dt(np, pdata);
  91. return 0;
  92. }
  93. #endif
  94. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  95. static int ccic_usb_handle_notification(struct notifier_block *nb,
  96. unsigned long action, void *data)
  97. {
  98. PD_NOTI_USB_STATUS_TYPEDEF usb_status = *(PD_NOTI_USB_STATUS_TYPEDEF *)data;
  99. struct otg_notify *o_notify = get_otg_notify();
  100. struct usb_notifier_platform_data *pdata =
  101. container_of(nb, struct usb_notifier_platform_data, ccic_usb_nb);
  102. if (usb_status.dest != PDIC_NOTIFY_DEV_USB)
  103. return 0;
  104. switch (usb_status.drp) {
  105. case USB_STATUS_NOTIFY_ATTACH_DFP:
  106. pr_info("%s: Turn On Host(DFP), max speed restrict = %d\n", __func__, usb_status.sub3);
  107. //UFP = 0, DFP = 1
  108. #if IS_ENABLED(CONFIG_COMBO_REDRIVER_PS5169)
  109. ps5169_config(USB_ONLY_MODE, 1);
  110. #endif
  111. dwc3_max_speed_setting(usb_status.sub3);
  112. send_otg_notify(o_notify, NOTIFY_EVENT_HOST, 1);
  113. pdata->is_host = 1;
  114. break;
  115. case USB_STATUS_NOTIFY_ATTACH_UFP:
  116. pr_info("%s: Turn On Device(UFP)\n", __func__);
  117. dwc3_max_speed_setting(usb_status.sub3);
  118. send_otg_notify(o_notify, NOTIFY_EVENT_VBUS, 1);
  119. #ifdef CONFIG_DISABLE_LOCKSCREEN_USB_RESTRICTION
  120. if (is_blocked(o_notify, NOTIFY_BLOCK_TYPE_CLIENT))
  121. return -EPERM;
  122. #endif
  123. break;
  124. case USB_STATUS_NOTIFY_DETACH:
  125. if (pdata->is_host) {
  126. pr_info("%s: Turn Off Host(DFP)\n", __func__);
  127. send_otg_notify(o_notify, NOTIFY_EVENT_HOST, 0);
  128. pdata->is_host = 0;
  129. } else {
  130. pr_info("%s: Turn Off Device(UFP)\n", __func__);
  131. send_otg_notify(o_notify, NOTIFY_EVENT_VBUS, 0);
  132. }
  133. #if IS_ENABLED(CONFIG_COMBO_REDRIVER_PS5169)
  134. ps5169_config(CLEAR_STATE, 0);
  135. #endif
  136. break;
  137. default:
  138. pr_info("%s: unsupported DRP type : %d.\n", __func__, usb_status.drp);
  139. break;
  140. }
  141. return 0;
  142. }
  143. #endif
  144. #if IS_ENABLED(CONFIG_MUIC_NOTIFIER)
  145. static int muic_usb_handle_notification(struct notifier_block *nb,
  146. unsigned long action, void *data)
  147. {
  148. struct otg_notify *o_notify = get_otg_notify();
  149. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  150. PD_NOTI_ATTACH_TYPEDEF *p_noti = (PD_NOTI_ATTACH_TYPEDEF *)data;
  151. muic_attached_dev_t attached_dev = p_noti->cable_type;
  152. pr_info("%s action=%lu, attached_dev=%d\n",
  153. __func__, action, attached_dev);
  154. switch (attached_dev) {
  155. case ATTACHED_DEV_USB_MUIC:
  156. case ATTACHED_DEV_CDP_MUIC:
  157. case ATTACHED_DEV_UNOFFICIAL_ID_USB_MUIC:
  158. case ATTACHED_DEV_UNOFFICIAL_ID_CDP_MUIC:
  159. if (action == MUIC_NOTIFY_CMD_DETACH)
  160. send_otg_notify(o_notify, NOTIFY_EVENT_USB_CABLE, 0);
  161. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  162. send_otg_notify(o_notify, NOTIFY_EVENT_USB_CABLE, 1);
  163. else
  164. pr_err("%s - ACTION Error!\n", __func__);
  165. break;
  166. default:
  167. break;
  168. }
  169. #else
  170. muic_attached_dev_t attached_dev = *(muic_attached_dev_t *)data;
  171. pr_info("%s action=%lu, attached_dev=%d\n",
  172. __func__, action, attached_dev);
  173. switch (attached_dev) {
  174. case ATTACHED_DEV_USB_MUIC:
  175. case ATTACHED_DEV_CDP_MUIC:
  176. case ATTACHED_DEV_UNOFFICIAL_ID_USB_MUIC:
  177. case ATTACHED_DEV_UNOFFICIAL_ID_CDP_MUIC:
  178. if (action == MUIC_NOTIFY_CMD_DETACH)
  179. send_otg_notify(o_notify, NOTIFY_EVENT_USB_CABLE, 0);
  180. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  181. send_otg_notify(o_notify, NOTIFY_EVENT_USB_CABLE, 1);
  182. else
  183. ;
  184. #if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 1, 0)
  185. fallthrough;
  186. #endif
  187. case ATTACHED_DEV_JIG_USB_OFF_MUIC:
  188. case ATTACHED_DEV_JIG_USB_ON_MUIC:
  189. if (action == MUIC_NOTIFY_CMD_DETACH)
  190. send_otg_notify(o_notify, NOTIFY_EVENT_VBUS, 0);
  191. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  192. send_otg_notify(o_notify, NOTIFY_EVENT_VBUS, 1);
  193. else
  194. pr_err("%s - ACTION Error!\n", __func__);
  195. break;
  196. case ATTACHED_DEV_OTG_MUIC:
  197. if (action == MUIC_NOTIFY_CMD_DETACH)
  198. send_otg_notify(o_notify, NOTIFY_EVENT_HOST, 0);
  199. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  200. send_otg_notify(o_notify, NOTIFY_EVENT_HOST, 1);
  201. else
  202. pr_err("%s - ACTION Error!\n", __func__);
  203. break;
  204. case ATTACHED_DEV_HMT_MUIC:
  205. if (action == MUIC_NOTIFY_CMD_DETACH)
  206. send_otg_notify(o_notify, NOTIFY_EVENT_HMT, 0);
  207. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  208. send_otg_notify(o_notify, NOTIFY_EVENT_HMT, 1);
  209. else
  210. pr_err("%s - ACTION Error!\n", __func__);
  211. break;
  212. case ATTACHED_DEV_JIG_UART_OFF_VB_OTG_MUIC:
  213. if (action == MUIC_NOTIFY_CMD_DETACH)
  214. pr_info("%s - USB_HOST_TEST_DETACHED\n", __func__);
  215. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  216. pr_info("%s - USB_HOST_TEST_ATTACHED\n", __func__);
  217. else
  218. pr_err("%s - ACTION Error!\n", __func__);
  219. break;
  220. case ATTACHED_DEV_SMARTDOCK_TA_MUIC:
  221. if (action == MUIC_NOTIFY_CMD_DETACH)
  222. send_otg_notify(o_notify, NOTIFY_EVENT_SMARTDOCK_TA, 0);
  223. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  224. send_otg_notify(o_notify, NOTIFY_EVENT_SMARTDOCK_TA, 1);
  225. else
  226. pr_err("%s - ACTION Error!\n", __func__);
  227. break;
  228. case ATTACHED_DEV_SMARTDOCK_USB_MUIC:
  229. if (action == MUIC_NOTIFY_CMD_DETACH)
  230. send_otg_notify
  231. (o_notify, NOTIFY_EVENT_SMARTDOCK_USB, 0);
  232. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  233. send_otg_notify
  234. (o_notify, NOTIFY_EVENT_SMARTDOCK_USB, 1);
  235. else
  236. pr_err("%s - ACTION Error!\n", __func__);
  237. break;
  238. case ATTACHED_DEV_AUDIODOCK_MUIC:
  239. if (action == MUIC_NOTIFY_CMD_DETACH)
  240. send_otg_notify(o_notify, NOTIFY_EVENT_AUDIODOCK, 0);
  241. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  242. send_otg_notify(o_notify, NOTIFY_EVENT_AUDIODOCK, 1);
  243. else
  244. pr_err("%s - ACTION Error!\n", __func__);
  245. break;
  246. case ATTACHED_DEV_UNIVERSAL_MMDOCK_MUIC:
  247. if (action == MUIC_NOTIFY_CMD_DETACH)
  248. send_otg_notify(o_notify, NOTIFY_EVENT_MMDOCK, 0);
  249. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  250. send_otg_notify(o_notify, NOTIFY_EVENT_MMDOCK, 1);
  251. else
  252. pr_err("%s - ACTION Error!\n", __func__);
  253. break;
  254. case ATTACHED_DEV_USB_LANHUB_MUIC:
  255. if (action == MUIC_NOTIFY_CMD_DETACH)
  256. send_otg_notify(o_notify, NOTIFY_EVENT_LANHUB, 0);
  257. else if (action == MUIC_NOTIFY_CMD_ATTACH) {
  258. send_otg_notify(o_notify, NOTIFY_EVENT_DRIVE_VBUS, 0);
  259. send_otg_notify(o_notify, NOTIFY_EVENT_LANHUB, 1);
  260. } else
  261. pr_err("%s - ACTION Error!\n", __func__);
  262. break;
  263. case ATTACHED_DEV_GAMEPAD_MUIC:
  264. if (action == MUIC_NOTIFY_CMD_DETACH)
  265. send_otg_notify(o_notify, NOTIFY_EVENT_GAMEPAD, 0);
  266. else if (action == MUIC_NOTIFY_CMD_ATTACH)
  267. send_otg_notify(o_notify, NOTIFY_EVENT_GAMEPAD, 1);
  268. else
  269. pr_err("%s - ACTION Error!\n", __func__);
  270. break;
  271. default:
  272. break;
  273. }
  274. #endif
  275. return 0;
  276. }
  277. #endif
  278. #if IS_ENABLED(CONFIG_VBUS_NOTIFIER)
  279. static int vbus_handle_notification(struct notifier_block *nb,
  280. unsigned long cmd, void *data)
  281. {
  282. vbus_status_t vbus_type = *(vbus_status_t *)data;
  283. struct otg_notify *o_notify;
  284. o_notify = get_otg_notify();
  285. pr_info("%s cmd=%lu, vbus_type=%s\n",
  286. __func__, cmd, vbus_type == STATUS_VBUS_HIGH ? "HIGH" : "LOW");
  287. switch (vbus_type) {
  288. case STATUS_VBUS_HIGH:
  289. send_otg_notify(o_notify, NOTIFY_EVENT_VBUSPOWER, 1);
  290. break;
  291. case STATUS_VBUS_LOW:
  292. send_otg_notify(o_notify, NOTIFY_EVENT_VBUSPOWER, 0);
  293. break;
  294. default:
  295. break;
  296. }
  297. return 0;
  298. }
  299. #endif
  300. static int otg_accessory_power(bool enable)
  301. {
  302. struct power_supply *psy_otg;
  303. union power_supply_propval val;
  304. int on = !!enable;
  305. int ret = 0;
  306. pr_info("%s %d, enable=%d\n", __func__, __LINE__, enable);
  307. /* otg psy test */
  308. psy_otg = get_power_supply_by_name("otg");
  309. if (psy_otg) {
  310. val.intval = enable;
  311. ret = psy_otg->desc->set_property(psy_otg, POWER_SUPPLY_PROP_ONLINE, &val);
  312. } else {
  313. pr_err("%s: Fail to get psy battery\n", __func__);
  314. return -1;
  315. }
  316. if (ret) {
  317. pr_err("%s: fail to set power_suppy ONLINE property(%d)\n",
  318. __func__, ret);
  319. } else {
  320. pr_info("otg accessory power = %d\n", on);
  321. }
  322. return ret;
  323. }
  324. static int set_online(int event, int state)
  325. {
  326. union power_supply_propval value;
  327. struct power_supply *psy, *psy_otg;
  328. pr_info("%s: %d, %d\n", __func__, event, state);
  329. psy = power_supply_get_by_name("battery");
  330. if (!psy) {
  331. pr_err("%s: fail to get battery power_supply\n", __func__);
  332. return -1;
  333. }
  334. psy_otg = get_power_supply_by_name("otg");
  335. if (!psy_otg) {
  336. pr_err("%s: fail to get battery power_supply_otg\n", __func__);
  337. return -1;
  338. }
  339. if (event == NOTIFY_EVENT_HMD_EXT_CURRENT) {
  340. value.intval = state;
  341. psy_otg->desc->set_property(psy_otg, POWER_SUPPLY_PROP_VOLTAGE_MAX, &value);
  342. } else {
  343. if (state)
  344. value.intval = SEC_BATTERY_CABLE_SMART_OTG;
  345. else
  346. value.intval = SEC_BATTERY_CABLE_SMART_NOTG;
  347. psy->desc->set_property(psy, POWER_SUPPLY_PROP_ONLINE, &value);
  348. }
  349. return 0;
  350. }
  351. static int qcom_set_host(bool enable)
  352. {
  353. dwc_msm_id_event(enable);
  354. return 0;
  355. }
  356. static int qcom_set_peripheral(bool enable)
  357. {
  358. #if IS_ENABLED(CONFIG_COMBO_REDRIVER_PS5169)
  359. if (enable)
  360. ps5169_config(USB_ONLY_MODE, 0);
  361. #endif
  362. dwc_msm_vbus_event(enable);
  363. return 0;
  364. }
  365. static int qcom_get_gadget_speed(void)
  366. {
  367. return gadget_speed();
  368. }
  369. static int usb_set_chg_current(int state)
  370. {
  371. union power_supply_propval val;
  372. struct device_node *np_charger = NULL;
  373. char *charger_name;
  374. np_charger = of_find_node_by_name(NULL, "battery");
  375. if (!np_charger) {
  376. pr_err("%s: failed to get the battery device node\n", __func__);
  377. return 0;
  378. } else {
  379. if (!of_property_read_string(np_charger, "battery,charger_name",
  380. (char const **)&charger_name)) {
  381. pr_info("%s: charger_name = %s\n", __func__,
  382. charger_name);
  383. } else {
  384. pr_err("%s: failed to get the charger name\n", __func__);
  385. return 0;
  386. }
  387. }
  388. /* current setting */
  389. pr_info("usb : charing current set = %d\n", state);
  390. switch (state) {
  391. case NOTIFY_USB_SUSPENDED:
  392. val.intval = USB_CURRENT_SUSPENDED;
  393. break;
  394. case NOTIFY_USB_UNCONFIGURED:
  395. val.intval = USB_CURRENT_UNCONFIGURED;
  396. break;
  397. case NOTIFY_USB_CONFIGURED:
  398. val.intval = USB_CURRENT_HIGH_SPEED;
  399. break;
  400. default:
  401. val.intval = USB_CURRENT_HIGH_SPEED;
  402. break;
  403. }
  404. psy_do_property("battery", set,
  405. POWER_SUPPLY_EXT_PROP_USB_CONFIGURE, val);
  406. return 0;
  407. }
  408. #if IS_ENABLED(CONFIG_USB_HW_PARAM)
  409. static int is_skip_list(int index)
  410. {
  411. int ret = 0;
  412. switch (index) {
  413. case USB_CCIC_VR_USE_COUNT:
  414. case USB_HOST_CLASS_COMM_COUNT:
  415. case USB_HOST_CLASS_PHYSICAL_COUNT:
  416. case USB_HOST_CLASS_IMAGE_COUNT:
  417. case USB_HOST_CLASS_PRINTER_COUNT:
  418. case USB_HOST_CLASS_CDC_COUNT:
  419. case USB_HOST_CLASS_CSCID_COUNT:
  420. case USB_HOST_CLASS_CONTENT_COUNT:
  421. case USB_HOST_CLASS_VIDEO_COUNT:
  422. case USB_HOST_CLASS_WIRELESS_COUNT:
  423. case USB_HOST_CLASS_MISC_COUNT:
  424. case USB_HOST_CLASS_APP_COUNT:
  425. case USB_HALL_FOLDING_COUNT:
  426. case USB_HOST_CLASS_VENDOR_COUNT:
  427. case USB_CCIC_FWUP_ERROR_COUNT:
  428. case USB_CCIC_VERSION:
  429. ret = 1;
  430. break;
  431. default:
  432. break;
  433. }
  434. return ret;
  435. }
  436. #endif
  437. static int reverse_bypass_power(int mode)
  438. {
  439. union power_supply_propval val;
  440. int ret = 0;
  441. pr_info("%s %d, mode=%d\n", __func__, __LINE__, mode);
  442. if (mode)
  443. val.intval = TURN_OTG_OFF_RB_ON;
  444. else
  445. val.intval = TURN_RB_OFF;
  446. ret = psy_do_property("otg", set, POWER_SUPPLY_EXT_PROP_OTG_VBUS_CTRL, val);
  447. if (ret < 0) {
  448. pr_err("%s: Fail to control reverse bypass\n", __func__);
  449. return -1;
  450. }
  451. return ret;
  452. }
  453. static int get_support_reverse_bypass_en(void *data)
  454. {
  455. struct usb_notifier_platform_data *pdata =
  456. (struct usb_notifier_platform_data *)(data);
  457. return pdata->support_reverse_bypass_en;
  458. }
  459. static struct otg_notify sec_otg_notify = {
  460. .vbus_drive = otg_accessory_power,
  461. .reverse_bypass_drive = reverse_bypass_power,
  462. .get_support_reverse_bypass_en = get_support_reverse_bypass_en,
  463. .set_host = qcom_set_host,
  464. .set_peripheral = qcom_set_peripheral,
  465. .get_gadget_speed = qcom_get_gadget_speed,
  466. .vbus_detect_gpio = -1,
  467. .is_host_wakelock = 0,
  468. .is_wakelock = 1,
  469. .unsupport_host = 0,
  470. #if IS_ENABLED(CONFIG_COMBO_REDRIVER_PS5169)
  471. .booting_delay_sec = 16,
  472. #else
  473. .booting_delay_sec = 10,
  474. #endif
  475. #if !IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  476. .auto_drive_vbus = NOTIFY_OP_PRE,
  477. #endif
  478. .disable_control = 1,
  479. .device_check_sec = 3,
  480. .set_battcall = set_online,
  481. .set_chg_current = usb_set_chg_current,
  482. #if IS_ENABLED(CONFIG_USB_HW_PARAM)
  483. .is_skip_list = is_skip_list,
  484. #endif
  485. .pre_peri_delay_us = 6,
  486. };
  487. static int usb_notifier_probe(struct platform_device *pdev)
  488. {
  489. struct usb_notifier_platform_data *pdata = NULL;
  490. int ret = 0;
  491. pr_info("notifier_probe\n");
  492. if (pdev->dev.of_node) {
  493. pdata = devm_kzalloc(&pdev->dev,
  494. sizeof(struct usb_notifier_platform_data), GFP_KERNEL);
  495. if (!pdata) {
  496. dev_err(&pdev->dev, "Failed to allocate memory\n");
  497. return -ENOMEM;
  498. }
  499. ret = of_usb_notifier_dt(&pdev->dev, pdata);
  500. if (ret < 0) {
  501. dev_err(&pdev->dev, "Failed to get device of_node\n");
  502. return ret;
  503. }
  504. pdev->dev.platform_data = pdata;
  505. } else
  506. pdata = pdev->dev.platform_data;
  507. sec_otg_notify.redriver_en_gpio = pdata->gpio_redriver_en;
  508. if (pdata->disable_control_en == 1)
  509. sec_otg_notify.disable_control = 1;
  510. if (pdata->unsupport_host_en == 1)
  511. sec_otg_notify.unsupport_host = 1;
  512. set_otg_notify(&sec_otg_notify);
  513. set_notify_data(&sec_otg_notify, pdata);
  514. sec_otg_notify.booting_delay_sync_usb = is_dwc3_msm_probe_done() ? 0 : 1;
  515. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  516. pdata->is_host = 0;
  517. #if IS_ENABLED(CONFIG_USB_TYPEC_MANAGER_NOTIFIER)
  518. manager_notifier_register(&pdata->ccic_usb_nb, ccic_usb_handle_notification,
  519. MANAGER_NOTIFY_PDIC_USB);
  520. #else
  521. ccic_notifier_register(&pdata->ccic_usb_nb, ccic_usb_handle_notification,
  522. PDIC_NOTIFY_DEV_USB);
  523. #endif
  524. #endif
  525. #if IS_ENABLED(CONFIG_MUIC_NOTIFIER)
  526. muic_notifier_register(&pdata->muic_usb_nb, muic_usb_handle_notification,
  527. MUIC_NOTIFY_DEV_USB);
  528. #endif
  529. #if IS_ENABLED(CONFIG_VBUS_NOTIFIER)
  530. vbus_notifier_register(&pdata->vbus_nb, vbus_handle_notification,
  531. VBUS_NOTIFY_DEV_USB);
  532. #endif
  533. dev_info(&pdev->dev, "usb notifier probe\n");
  534. return 0;
  535. }
  536. static int usb_notifier_remove(struct platform_device *pdev)
  537. {
  538. struct usb_notifier_platform_data *pdata = dev_get_platdata(&pdev->dev);
  539. #if IS_ENABLED(CONFIG_PDIC_NOTIFIER)
  540. #if IS_ENABLED(CONFIG_USB_TYPEC_MANAGER_NOTIFIER)
  541. manager_notifier_unregister(&pdata->ccic_usb_nb);
  542. #else
  543. ccic_notifier_unregister(&pdata->ccic_usb_nb);
  544. #endif
  545. #elif IS_ENABLED(CONFIG_MUIC_NOTIFIER)
  546. muic_notifier_unregister(&pdata->muic_usb_nb);
  547. #endif
  548. #if IS_ENABLED(CONFIG_VBUS_NOTIFIER)
  549. vbus_notifier_unregister(&pdata->vbus_nb);
  550. #endif
  551. return 0;
  552. }
  553. #ifdef CONFIG_OF
  554. static const struct of_device_id usb_notifier_dt_ids[] = {
  555. { .compatible = "samsung,usb-notifier",
  556. },
  557. { },
  558. };
  559. MODULE_DEVICE_TABLE(of, usb_notifier_dt_ids);
  560. #endif
  561. static struct platform_driver usb_notifier_driver = {
  562. .probe = usb_notifier_probe,
  563. .remove = usb_notifier_remove,
  564. .driver = {
  565. .name = "usb_notifier",
  566. .owner = THIS_MODULE,
  567. #ifdef CONFIG_OF
  568. .of_match_table = of_match_ptr(usb_notifier_dt_ids),
  569. #endif
  570. },
  571. };
  572. static int __init usb_notifier_init(void)
  573. {
  574. return platform_driver_register(&usb_notifier_driver);
  575. }
  576. static void __exit usb_notifier_exit(void)
  577. {
  578. platform_driver_unregister(&usb_notifier_driver);
  579. }
  580. late_initcall(usb_notifier_init);
  581. module_exit(usb_notifier_exit);
  582. MODULE_AUTHOR("Samsung USB Team");
  583. MODULE_DESCRIPTION("USB Notifier");
  584. MODULE_LICENSE("GPL");