1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
4 * Copyright (c) 2023, Linaro Ltd
5 */
6 #include <linux/auxiliary_bus.h>
7 #include <linux/module.h>
8 #include <linux/mutex.h>
9 #include <linux/of_device.h>
10 #include <linux/property.h>
11 #include <linux/soc/qcom/pdr.h>
12 #include <linux/usb/typec_mux.h>
13 #include <linux/gpio/consumer.h>
14 #include <linux/soc/qcom/pmic_glink.h>
15 #include "ucsi.h"
16
17 #define PMIC_GLINK_MAX_PORTS 3
18
19 #define UCSI_BUF_SIZE 48
20
21 #define MSG_TYPE_REQ_RESP 1
22 #define UCSI_BUF_SIZE 48
23
24 #define UC_NOTIFY_RECEIVER_UCSI 0x0
25 #define UC_UCSI_READ_BUF_REQ 0x11
26 #define UC_UCSI_WRITE_BUF_REQ 0x12
27 #define UC_UCSI_USBC_NOTIFY_IND 0x13
28
29 struct ucsi_read_buf_req_msg {
30 struct pmic_glink_hdr hdr;
31 };
32
33 struct ucsi_read_buf_resp_msg {
34 struct pmic_glink_hdr hdr;
35 u8 buf[UCSI_BUF_SIZE];
36 u32 ret_code;
37 };
38
39 struct ucsi_write_buf_req_msg {
40 struct pmic_glink_hdr hdr;
41 u8 buf[UCSI_BUF_SIZE];
42 u32 reserved;
43 };
44
45 struct ucsi_write_buf_resp_msg {
46 struct pmic_glink_hdr hdr;
47 u32 ret_code;
48 };
49
50 struct ucsi_notify_ind_msg {
51 struct pmic_glink_hdr hdr;
52 u32 notification;
53 u32 receiver;
54 u32 reserved;
55 };
56
57 struct pmic_glink_ucsi {
58 struct device *dev;
59
60 struct gpio_desc *port_orientation[PMIC_GLINK_MAX_PORTS];
61
62 struct pmic_glink_client *client;
63
64 struct ucsi *ucsi;
65 struct completion read_ack;
66 struct completion write_ack;
67 struct mutex lock; /* protects concurrent access to PMIC Glink interface */
68
69 struct work_struct notify_work;
70 struct work_struct register_work;
71 spinlock_t state_lock;
72 bool ucsi_registered;
73 bool pd_running;
74
75 u8 read_buf[UCSI_BUF_SIZE];
76 };
77
pmic_glink_ucsi_read(struct ucsi * __ucsi,unsigned int offset,void * val,size_t val_len)78 static int pmic_glink_ucsi_read(struct ucsi *__ucsi, unsigned int offset,
79 void *val, size_t val_len)
80 {
81 struct pmic_glink_ucsi *ucsi = ucsi_get_drvdata(__ucsi);
82 struct ucsi_read_buf_req_msg req = {};
83 unsigned long left;
84 int ret;
85
86 req.hdr.owner = PMIC_GLINK_OWNER_USBC;
87 req.hdr.type = MSG_TYPE_REQ_RESP;
88 req.hdr.opcode = UC_UCSI_READ_BUF_REQ;
89
90 mutex_lock(&ucsi->lock);
91 memset(ucsi->read_buf, 0, sizeof(ucsi->read_buf));
92 reinit_completion(&ucsi->read_ack);
93
94 ret = pmic_glink_send(ucsi->client, &req, sizeof(req));
95 if (ret < 0) {
96 dev_err(ucsi->dev, "failed to send UCSI read request: %d\n", ret);
97 goto out_unlock;
98 }
99
100 left = wait_for_completion_timeout(&ucsi->read_ack, 5 * HZ);
101 if (!left) {
102 dev_err(ucsi->dev, "timeout waiting for UCSI read response\n");
103 ret = -ETIMEDOUT;
104 goto out_unlock;
105 }
106
107 memcpy(val, &ucsi->read_buf[offset], val_len);
108 ret = 0;
109
110 out_unlock:
111 mutex_unlock(&ucsi->lock);
112
113 return ret;
114 }
115
pmic_glink_ucsi_read_version(struct ucsi * ucsi,u16 * version)116 static int pmic_glink_ucsi_read_version(struct ucsi *ucsi, u16 *version)
117 {
118 return pmic_glink_ucsi_read(ucsi, UCSI_VERSION, version, sizeof(*version));
119 }
120
pmic_glink_ucsi_read_cci(struct ucsi * ucsi,u32 * cci)121 static int pmic_glink_ucsi_read_cci(struct ucsi *ucsi, u32 *cci)
122 {
123 return pmic_glink_ucsi_read(ucsi, UCSI_CCI, cci, sizeof(*cci));
124 }
125
pmic_glink_ucsi_read_message_in(struct ucsi * ucsi,void * val,size_t val_len)126 static int pmic_glink_ucsi_read_message_in(struct ucsi *ucsi, void *val, size_t val_len)
127 {
128 return pmic_glink_ucsi_read(ucsi, UCSI_MESSAGE_IN, val, val_len);
129 }
130
pmic_glink_ucsi_locked_write(struct pmic_glink_ucsi * ucsi,unsigned int offset,const void * val,size_t val_len)131 static int pmic_glink_ucsi_locked_write(struct pmic_glink_ucsi *ucsi, unsigned int offset,
132 const void *val, size_t val_len)
133 {
134 struct ucsi_write_buf_req_msg req = {};
135 unsigned long left;
136 int ret;
137
138 req.hdr.owner = PMIC_GLINK_OWNER_USBC;
139 req.hdr.type = MSG_TYPE_REQ_RESP;
140 req.hdr.opcode = UC_UCSI_WRITE_BUF_REQ;
141 memcpy(&req.buf[offset], val, val_len);
142
143 reinit_completion(&ucsi->write_ack);
144
145 ret = pmic_glink_send(ucsi->client, &req, sizeof(req));
146 if (ret < 0) {
147 dev_err(ucsi->dev, "failed to send UCSI write request: %d\n", ret);
148 return ret;
149 }
150
151 left = wait_for_completion_timeout(&ucsi->write_ack, 5 * HZ);
152 if (!left) {
153 dev_err(ucsi->dev, "timeout waiting for UCSI write response\n");
154 return -ETIMEDOUT;
155 }
156
157 return 0;
158 }
159
pmic_glink_ucsi_async_control(struct ucsi * __ucsi,u64 command)160 static int pmic_glink_ucsi_async_control(struct ucsi *__ucsi, u64 command)
161 {
162 struct pmic_glink_ucsi *ucsi = ucsi_get_drvdata(__ucsi);
163 int ret;
164
165 mutex_lock(&ucsi->lock);
166 ret = pmic_glink_ucsi_locked_write(ucsi, UCSI_CONTROL, &command, sizeof(command));
167 mutex_unlock(&ucsi->lock);
168
169 return ret;
170 }
171
pmic_glink_ucsi_update_connector(struct ucsi_connector * con)172 static void pmic_glink_ucsi_update_connector(struct ucsi_connector *con)
173 {
174 struct pmic_glink_ucsi *ucsi = ucsi_get_drvdata(con->ucsi);
175 int i;
176
177 for (i = 0; i < PMIC_GLINK_MAX_PORTS; i++) {
178 if (ucsi->port_orientation[i])
179 con->typec_cap.orientation_aware = true;
180 }
181 }
182
pmic_glink_ucsi_connector_status(struct ucsi_connector * con)183 static void pmic_glink_ucsi_connector_status(struct ucsi_connector *con)
184 {
185 struct pmic_glink_ucsi *ucsi = ucsi_get_drvdata(con->ucsi);
186 int orientation;
187
188 if (con->num >= PMIC_GLINK_MAX_PORTS ||
189 !ucsi->port_orientation[con->num - 1])
190 return;
191
192 orientation = gpiod_get_value(ucsi->port_orientation[con->num - 1]);
193 if (orientation >= 0) {
194 typec_set_orientation(con->port,
195 orientation ?
196 TYPEC_ORIENTATION_REVERSE :
197 TYPEC_ORIENTATION_NORMAL);
198 }
199 }
200
201 static const struct ucsi_operations pmic_glink_ucsi_ops = {
202 .read_version = pmic_glink_ucsi_read_version,
203 .read_cci = pmic_glink_ucsi_read_cci,
204 .read_message_in = pmic_glink_ucsi_read_message_in,
205 .sync_control = ucsi_sync_control_common,
206 .async_control = pmic_glink_ucsi_async_control,
207 .update_connector = pmic_glink_ucsi_update_connector,
208 .connector_status = pmic_glink_ucsi_connector_status,
209 };
210
pmic_glink_ucsi_read_ack(struct pmic_glink_ucsi * ucsi,const void * data,int len)211 static void pmic_glink_ucsi_read_ack(struct pmic_glink_ucsi *ucsi, const void *data, int len)
212 {
213 const struct ucsi_read_buf_resp_msg *resp = data;
214
215 if (resp->ret_code)
216 return;
217
218 memcpy(ucsi->read_buf, resp->buf, UCSI_BUF_SIZE);
219 complete(&ucsi->read_ack);
220 }
221
pmic_glink_ucsi_write_ack(struct pmic_glink_ucsi * ucsi,const void * data,int len)222 static void pmic_glink_ucsi_write_ack(struct pmic_glink_ucsi *ucsi, const void *data, int len)
223 {
224 const struct ucsi_write_buf_resp_msg *resp = data;
225
226 if (resp->ret_code)
227 return;
228
229 complete(&ucsi->write_ack);
230 }
231
pmic_glink_ucsi_notify(struct work_struct * work)232 static void pmic_glink_ucsi_notify(struct work_struct *work)
233 {
234 struct pmic_glink_ucsi *ucsi = container_of(work, struct pmic_glink_ucsi, notify_work);
235 u32 cci;
236 int ret;
237
238 ret = pmic_glink_ucsi_read(ucsi->ucsi, UCSI_CCI, &cci, sizeof(cci));
239 if (ret) {
240 dev_err(ucsi->dev, "failed to read CCI on notification\n");
241 return;
242 }
243
244 ucsi_notify_common(ucsi->ucsi, cci);
245 }
246
pmic_glink_ucsi_register(struct work_struct * work)247 static void pmic_glink_ucsi_register(struct work_struct *work)
248 {
249 struct pmic_glink_ucsi *ucsi = container_of(work, struct pmic_glink_ucsi, register_work);
250 unsigned long flags;
251 bool pd_running;
252
253 spin_lock_irqsave(&ucsi->state_lock, flags);
254 pd_running = ucsi->pd_running;
255 spin_unlock_irqrestore(&ucsi->state_lock, flags);
256
257 if (!ucsi->ucsi_registered && pd_running) {
258 ucsi_register(ucsi->ucsi);
259 ucsi->ucsi_registered = true;
260 } else if (ucsi->ucsi_registered && !pd_running) {
261 ucsi_unregister(ucsi->ucsi);
262 ucsi->ucsi_registered = false;
263 }
264 }
265
pmic_glink_ucsi_callback(const void * data,size_t len,void * priv)266 static void pmic_glink_ucsi_callback(const void *data, size_t len, void *priv)
267 {
268 struct pmic_glink_ucsi *ucsi = priv;
269 const struct pmic_glink_hdr *hdr = data;
270
271 switch (le32_to_cpu(hdr->opcode)) {
272 case UC_UCSI_READ_BUF_REQ:
273 pmic_glink_ucsi_read_ack(ucsi, data, len);
274 break;
275 case UC_UCSI_WRITE_BUF_REQ:
276 pmic_glink_ucsi_write_ack(ucsi, data, len);
277 break;
278 case UC_UCSI_USBC_NOTIFY_IND:
279 schedule_work(&ucsi->notify_work);
280 break;
281 }
282 }
283
pmic_glink_ucsi_pdr_notify(void * priv,int state)284 static void pmic_glink_ucsi_pdr_notify(void *priv, int state)
285 {
286 struct pmic_glink_ucsi *ucsi = priv;
287 unsigned long flags;
288
289 spin_lock_irqsave(&ucsi->state_lock, flags);
290 ucsi->pd_running = (state == SERVREG_SERVICE_STATE_UP);
291 spin_unlock_irqrestore(&ucsi->state_lock, flags);
292 schedule_work(&ucsi->register_work);
293 }
294
pmic_glink_ucsi_destroy(void * data)295 static void pmic_glink_ucsi_destroy(void *data)
296 {
297 struct pmic_glink_ucsi *ucsi = data;
298
299 /* Protect to make sure we're not in a middle of a transaction from a glink callback */
300 mutex_lock(&ucsi->lock);
301 ucsi_destroy(ucsi->ucsi);
302 mutex_unlock(&ucsi->lock);
303 }
304
305 static unsigned long quirk_sc8180x = UCSI_NO_PARTNER_PDOS;
306 static unsigned long quirk_sc8280xp = UCSI_NO_PARTNER_PDOS | UCSI_DELAY_DEVICE_PDOS;
307 static unsigned long quirk_sm8450 = UCSI_DELAY_DEVICE_PDOS;
308
309 static const struct of_device_id pmic_glink_ucsi_of_quirks[] = {
310 { .compatible = "qcom,qcm6490-pmic-glink", .data = &quirk_sc8280xp, },
311 { .compatible = "qcom,sc8180x-pmic-glink", .data = &quirk_sc8180x, },
312 { .compatible = "qcom,sc8280xp-pmic-glink", .data = &quirk_sc8280xp, },
313 { .compatible = "qcom,sm8350-pmic-glink", .data = &quirk_sc8180x, },
314 { .compatible = "qcom,sm8450-pmic-glink", .data = &quirk_sm8450, },
315 { .compatible = "qcom,sm8550-pmic-glink", .data = &quirk_sm8450, },
316 {}
317 };
318
pmic_glink_ucsi_probe(struct auxiliary_device * adev,const struct auxiliary_device_id * id)319 static int pmic_glink_ucsi_probe(struct auxiliary_device *adev,
320 const struct auxiliary_device_id *id)
321 {
322 struct pmic_glink_ucsi *ucsi;
323 struct device *dev = &adev->dev;
324 const struct of_device_id *match;
325 struct fwnode_handle *fwnode;
326 int ret;
327
328 ucsi = devm_kzalloc(dev, sizeof(*ucsi), GFP_KERNEL);
329 if (!ucsi)
330 return -ENOMEM;
331
332 ucsi->dev = dev;
333 dev_set_drvdata(dev, ucsi);
334
335 INIT_WORK(&ucsi->notify_work, pmic_glink_ucsi_notify);
336 INIT_WORK(&ucsi->register_work, pmic_glink_ucsi_register);
337 init_completion(&ucsi->read_ack);
338 init_completion(&ucsi->write_ack);
339 spin_lock_init(&ucsi->state_lock);
340 mutex_init(&ucsi->lock);
341
342 ucsi->ucsi = ucsi_create(dev, &pmic_glink_ucsi_ops);
343 if (IS_ERR(ucsi->ucsi))
344 return PTR_ERR(ucsi->ucsi);
345
346 /* Make sure we destroy *after* pmic_glink unregister */
347 ret = devm_add_action_or_reset(dev, pmic_glink_ucsi_destroy, ucsi);
348 if (ret)
349 return ret;
350
351 match = of_match_device(pmic_glink_ucsi_of_quirks, dev->parent);
352 if (match)
353 ucsi->ucsi->quirks = *(unsigned long *)match->data;
354
355 ucsi_set_drvdata(ucsi->ucsi, ucsi);
356
357 device_for_each_child_node(dev, fwnode) {
358 struct gpio_desc *desc;
359 u32 port;
360
361 ret = fwnode_property_read_u32(fwnode, "reg", &port);
362 if (ret < 0) {
363 dev_err(dev, "missing reg property of %pOFn\n", fwnode);
364 fwnode_handle_put(fwnode);
365 return ret;
366 }
367
368 if (port >= PMIC_GLINK_MAX_PORTS) {
369 dev_warn(dev, "invalid connector number, ignoring\n");
370 continue;
371 }
372
373 desc = devm_gpiod_get_index_optional(&adev->dev, "orientation", port, GPIOD_IN);
374
375 /* If GPIO isn't found, continue */
376 if (!desc)
377 continue;
378
379 if (IS_ERR(desc)) {
380 fwnode_handle_put(fwnode);
381 return dev_err_probe(dev, PTR_ERR(desc),
382 "unable to acquire orientation gpio\n");
383 }
384 ucsi->port_orientation[port] = desc;
385 }
386
387 ucsi->client = devm_pmic_glink_client_alloc(dev, PMIC_GLINK_OWNER_USBC,
388 pmic_glink_ucsi_callback,
389 pmic_glink_ucsi_pdr_notify,
390 ucsi);
391 if (IS_ERR(ucsi->client))
392 return PTR_ERR(ucsi->client);
393
394 pmic_glink_client_register(ucsi->client);
395
396 return 0;
397 }
398
pmic_glink_ucsi_remove(struct auxiliary_device * adev)399 static void pmic_glink_ucsi_remove(struct auxiliary_device *adev)
400 {
401 struct pmic_glink_ucsi *ucsi = dev_get_drvdata(&adev->dev);
402
403 /* Unregister first to stop having read & writes */
404 ucsi_unregister(ucsi->ucsi);
405 }
406
407 static const struct auxiliary_device_id pmic_glink_ucsi_id_table[] = {
408 { .name = "pmic_glink.ucsi", },
409 {},
410 };
411 MODULE_DEVICE_TABLE(auxiliary, pmic_glink_ucsi_id_table);
412
413 static struct auxiliary_driver pmic_glink_ucsi_driver = {
414 .name = "pmic_glink_ucsi",
415 .probe = pmic_glink_ucsi_probe,
416 .remove = pmic_glink_ucsi_remove,
417 .id_table = pmic_glink_ucsi_id_table,
418 };
419
420 module_auxiliary_driver(pmic_glink_ucsi_driver);
421
422 MODULE_DESCRIPTION("Qualcomm PMIC GLINK UCSI driver");
423 MODULE_LICENSE("GPL");
424