1dacb1287SKranthi Kuntala // SPDX-License-Identifier: GPL-2.0
2dacb1287SKranthi Kuntala /*
3dacb1287SKranthi Kuntala * Thunderbolt/USB4 retimer support.
4dacb1287SKranthi Kuntala *
5dacb1287SKranthi Kuntala * Copyright (C) 2020, Intel Corporation
6dacb1287SKranthi Kuntala * Authors: Kranthi Kuntala <kranthi.kuntala@intel.com>
7dacb1287SKranthi Kuntala * Mika Westerberg <mika.westerberg@linux.intel.com>
8dacb1287SKranthi Kuntala */
9dacb1287SKranthi Kuntala
10dacb1287SKranthi Kuntala #include <linux/delay.h>
11dacb1287SKranthi Kuntala #include <linux/pm_runtime.h>
12dacb1287SKranthi Kuntala #include <linux/sched/signal.h>
13dacb1287SKranthi Kuntala
14dacb1287SKranthi Kuntala #include "sb_regs.h"
15dacb1287SKranthi Kuntala #include "tb.h"
16dacb1287SKranthi Kuntala
17dacb1287SKranthi Kuntala #define TB_MAX_RETIMER_INDEX 6
18dacb1287SKranthi Kuntala
198b02b2daSMika Westerberg /**
208b02b2daSMika Westerberg * tb_retimer_nvm_read() - Read contents of retimer NVM
218b02b2daSMika Westerberg * @rt: Retimer device
228b02b2daSMika Westerberg * @address: NVM address (in bytes) to start reading
238b02b2daSMika Westerberg * @buf: Data read from NVM is stored here
248b02b2daSMika Westerberg * @size: Number of bytes to read
258b02b2daSMika Westerberg *
268b02b2daSMika Westerberg * Reads retimer NVM and copies the contents to @buf. Returns %0 if the
278b02b2daSMika Westerberg * read was successful and negative errno in case of failure.
288b02b2daSMika Westerberg */
tb_retimer_nvm_read(struct tb_retimer * rt,unsigned int address,void * buf,size_t size)298b02b2daSMika Westerberg int tb_retimer_nvm_read(struct tb_retimer *rt, unsigned int address, void *buf,
308b02b2daSMika Westerberg size_t size)
318b02b2daSMika Westerberg {
328b02b2daSMika Westerberg return usb4_port_retimer_nvm_read(rt->port, rt->index, address, buf, size);
338b02b2daSMika Westerberg }
348b02b2daSMika Westerberg
nvm_read(void * priv,unsigned int offset,void * val,size_t bytes)358b02b2daSMika Westerberg static int nvm_read(void *priv, unsigned int offset, void *val, size_t bytes)
36dacb1287SKranthi Kuntala {
37dacb1287SKranthi Kuntala struct tb_nvm *nvm = priv;
38dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(nvm->dev);
39dacb1287SKranthi Kuntala int ret;
40dacb1287SKranthi Kuntala
41dacb1287SKranthi Kuntala pm_runtime_get_sync(&rt->dev);
42dacb1287SKranthi Kuntala
43dacb1287SKranthi Kuntala if (!mutex_trylock(&rt->tb->lock)) {
44dacb1287SKranthi Kuntala ret = restart_syscall();
45dacb1287SKranthi Kuntala goto out;
46dacb1287SKranthi Kuntala }
47dacb1287SKranthi Kuntala
488b02b2daSMika Westerberg ret = tb_retimer_nvm_read(rt, offset, val, bytes);
49dacb1287SKranthi Kuntala mutex_unlock(&rt->tb->lock);
50dacb1287SKranthi Kuntala
51dacb1287SKranthi Kuntala out:
52dacb1287SKranthi Kuntala pm_runtime_mark_last_busy(&rt->dev);
53dacb1287SKranthi Kuntala pm_runtime_put_autosuspend(&rt->dev);
54dacb1287SKranthi Kuntala
55dacb1287SKranthi Kuntala return ret;
56dacb1287SKranthi Kuntala }
57dacb1287SKranthi Kuntala
nvm_write(void * priv,unsigned int offset,void * val,size_t bytes)588b02b2daSMika Westerberg static int nvm_write(void *priv, unsigned int offset, void *val, size_t bytes)
59dacb1287SKranthi Kuntala {
60dacb1287SKranthi Kuntala struct tb_nvm *nvm = priv;
61dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(nvm->dev);
62dacb1287SKranthi Kuntala int ret = 0;
63dacb1287SKranthi Kuntala
64dacb1287SKranthi Kuntala if (!mutex_trylock(&rt->tb->lock))
65dacb1287SKranthi Kuntala return restart_syscall();
66dacb1287SKranthi Kuntala
67dacb1287SKranthi Kuntala ret = tb_nvm_write_buf(nvm, offset, val, bytes);
68dacb1287SKranthi Kuntala mutex_unlock(&rt->tb->lock);
69dacb1287SKranthi Kuntala
70dacb1287SKranthi Kuntala return ret;
71dacb1287SKranthi Kuntala }
72dacb1287SKranthi Kuntala
tb_retimer_nvm_add(struct tb_retimer * rt)73dacb1287SKranthi Kuntala static int tb_retimer_nvm_add(struct tb_retimer *rt)
74dacb1287SKranthi Kuntala {
75dacb1287SKranthi Kuntala struct tb_nvm *nvm;
76dacb1287SKranthi Kuntala int ret;
77dacb1287SKranthi Kuntala
78dacb1287SKranthi Kuntala nvm = tb_nvm_alloc(&rt->dev);
79aef9c693SSzuying Chen if (IS_ERR(nvm)) {
80aef9c693SSzuying Chen ret = PTR_ERR(nvm) == -EOPNOTSUPP ? 0 : PTR_ERR(nvm);
81aef9c693SSzuying Chen goto err_nvm;
82aef9c693SSzuying Chen }
83dacb1287SKranthi Kuntala
84aef9c693SSzuying Chen ret = tb_nvm_read_version(nvm);
85dacb1287SKranthi Kuntala if (ret)
86dacb1287SKranthi Kuntala goto err_nvm;
87dacb1287SKranthi Kuntala
88aef9c693SSzuying Chen ret = tb_nvm_add_active(nvm, nvm_read);
89dacb1287SKranthi Kuntala if (ret)
90dacb1287SKranthi Kuntala goto err_nvm;
91dacb1287SKranthi Kuntala
92aef9c693SSzuying Chen ret = tb_nvm_add_non_active(nvm, nvm_write);
93dacb1287SKranthi Kuntala if (ret)
94dacb1287SKranthi Kuntala goto err_nvm;
95dacb1287SKranthi Kuntala
96dacb1287SKranthi Kuntala rt->nvm = nvm;
97dacb1287SKranthi Kuntala return 0;
98dacb1287SKranthi Kuntala
99dacb1287SKranthi Kuntala err_nvm:
100aef9c693SSzuying Chen dev_dbg(&rt->dev, "NVM upgrade disabled\n");
101aef9c693SSzuying Chen if (!IS_ERR(nvm))
102dacb1287SKranthi Kuntala tb_nvm_free(nvm);
103aef9c693SSzuying Chen
104dacb1287SKranthi Kuntala return ret;
105dacb1287SKranthi Kuntala }
106dacb1287SKranthi Kuntala
tb_retimer_nvm_validate_and_write(struct tb_retimer * rt)107dacb1287SKranthi Kuntala static int tb_retimer_nvm_validate_and_write(struct tb_retimer *rt)
108dacb1287SKranthi Kuntala {
109aef9c693SSzuying Chen unsigned int image_size;
110aef9c693SSzuying Chen const u8 *buf;
111faa1c615SRajmohan Mani int ret;
112dacb1287SKranthi Kuntala
113aef9c693SSzuying Chen ret = tb_nvm_validate(rt->nvm);
114aef9c693SSzuying Chen if (ret)
115aef9c693SSzuying Chen return ret;
116aef9c693SSzuying Chen
117aef9c693SSzuying Chen buf = rt->nvm->buf_data_start;
118dacb1287SKranthi Kuntala image_size = rt->nvm->buf_data_size;
119dacb1287SKranthi Kuntala
120faa1c615SRajmohan Mani ret = usb4_port_retimer_nvm_write(rt->port, rt->index, 0, buf,
121dacb1287SKranthi Kuntala image_size);
122aef9c693SSzuying Chen if (ret)
123faa1c615SRajmohan Mani return ret;
124aef9c693SSzuying Chen
125aef9c693SSzuying Chen rt->nvm->flushed = true;
126aef9c693SSzuying Chen return 0;
127faa1c615SRajmohan Mani }
128faa1c615SRajmohan Mani
tb_retimer_nvm_authenticate(struct tb_retimer * rt,bool auth_only)129faa1c615SRajmohan Mani static int tb_retimer_nvm_authenticate(struct tb_retimer *rt, bool auth_only)
130faa1c615SRajmohan Mani {
13125335b30SMika Westerberg u32 status;
132faa1c615SRajmohan Mani int ret;
133faa1c615SRajmohan Mani
134faa1c615SRajmohan Mani if (auth_only) {
135faa1c615SRajmohan Mani ret = usb4_port_retimer_nvm_set_offset(rt->port, rt->index, 0);
136faa1c615SRajmohan Mani if (ret)
137faa1c615SRajmohan Mani return ret;
138faa1c615SRajmohan Mani }
139faa1c615SRajmohan Mani
14025335b30SMika Westerberg ret = usb4_port_retimer_nvm_authenticate(rt->port, rt->index);
14125335b30SMika Westerberg if (ret)
14225335b30SMika Westerberg return ret;
14325335b30SMika Westerberg
14425335b30SMika Westerberg usleep_range(100, 150);
14525335b30SMika Westerberg
14625335b30SMika Westerberg /*
14725335b30SMika Westerberg * Check the status now if we still can access the retimer. It
14825335b30SMika Westerberg * is expected that the below fails.
14925335b30SMika Westerberg */
15025335b30SMika Westerberg ret = usb4_port_retimer_nvm_authenticate_status(rt->port, rt->index,
15125335b30SMika Westerberg &status);
15225335b30SMika Westerberg if (!ret) {
15325335b30SMika Westerberg rt->auth_status = status;
15425335b30SMika Westerberg return status ? -EINVAL : 0;
15525335b30SMika Westerberg }
15625335b30SMika Westerberg
15725335b30SMika Westerberg return 0;
158dacb1287SKranthi Kuntala }
159dacb1287SKranthi Kuntala
device_show(struct device * dev,struct device_attribute * attr,char * buf)160dacb1287SKranthi Kuntala static ssize_t device_show(struct device *dev, struct device_attribute *attr,
161dacb1287SKranthi Kuntala char *buf)
162dacb1287SKranthi Kuntala {
163dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
164dacb1287SKranthi Kuntala
1658283fb57SAndy Shevchenko return sysfs_emit(buf, "%#x\n", rt->device);
166dacb1287SKranthi Kuntala }
167dacb1287SKranthi Kuntala static DEVICE_ATTR_RO(device);
168dacb1287SKranthi Kuntala
nvm_authenticate_show(struct device * dev,struct device_attribute * attr,char * buf)169dacb1287SKranthi Kuntala static ssize_t nvm_authenticate_show(struct device *dev,
170dacb1287SKranthi Kuntala struct device_attribute *attr, char *buf)
171dacb1287SKranthi Kuntala {
172dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
173dacb1287SKranthi Kuntala int ret;
174dacb1287SKranthi Kuntala
175dacb1287SKranthi Kuntala if (!mutex_trylock(&rt->tb->lock))
176dacb1287SKranthi Kuntala return restart_syscall();
177dacb1287SKranthi Kuntala
178dacb1287SKranthi Kuntala if (!rt->nvm)
179dacb1287SKranthi Kuntala ret = -EAGAIN;
180aef9c693SSzuying Chen else if (rt->no_nvm_upgrade)
181aef9c693SSzuying Chen ret = -EOPNOTSUPP;
182dacb1287SKranthi Kuntala else
1838283fb57SAndy Shevchenko ret = sysfs_emit(buf, "%#x\n", rt->auth_status);
184dacb1287SKranthi Kuntala
185dacb1287SKranthi Kuntala mutex_unlock(&rt->tb->lock);
186dacb1287SKranthi Kuntala
187dacb1287SKranthi Kuntala return ret;
188dacb1287SKranthi Kuntala }
189dacb1287SKranthi Kuntala
tb_retimer_nvm_authenticate_status(struct tb_port * port,u32 * status)1901402ba08SMika Westerberg static void tb_retimer_nvm_authenticate_status(struct tb_port *port, u32 *status)
1911402ba08SMika Westerberg {
1921402ba08SMika Westerberg int i;
1931402ba08SMika Westerberg
1941402ba08SMika Westerberg tb_port_dbg(port, "reading NVM authentication status of retimers\n");
1951402ba08SMika Westerberg
1961402ba08SMika Westerberg /*
1971402ba08SMika Westerberg * Before doing anything else, read the authentication status.
1981402ba08SMika Westerberg * If the retimer has it set, store it for the new retimer
1991402ba08SMika Westerberg * device instance.
2001402ba08SMika Westerberg */
2011402ba08SMika Westerberg for (i = 1; i <= TB_MAX_RETIMER_INDEX; i++)
2021402ba08SMika Westerberg usb4_port_retimer_nvm_authenticate_status(port, i, &status[i]);
2031402ba08SMika Westerberg }
2041402ba08SMika Westerberg
tb_retimer_set_inbound_sbtx(struct tb_port * port)205cd0c1e58SGil Fine static void tb_retimer_set_inbound_sbtx(struct tb_port *port)
206cd0c1e58SGil Fine {
207cd0c1e58SGil Fine int i;
208cd0c1e58SGil Fine
209*87200371SMika Westerberg /*
210*87200371SMika Westerberg * When USB4 port is online sideband communications are
211*87200371SMika Westerberg * already up.
212*87200371SMika Westerberg */
213*87200371SMika Westerberg if (!usb4_port_device_is_offline(port->usb4))
214*87200371SMika Westerberg return;
215*87200371SMika Westerberg
216*87200371SMika Westerberg tb_port_dbg(port, "enabling sideband transactions\n");
217*87200371SMika Westerberg
218cd0c1e58SGil Fine for (i = 1; i <= TB_MAX_RETIMER_INDEX; i++)
219cd0c1e58SGil Fine usb4_port_retimer_set_inbound_sbtx(port, i);
220cd0c1e58SGil Fine }
221cd0c1e58SGil Fine
tb_retimer_unset_inbound_sbtx(struct tb_port * port)222cd0c1e58SGil Fine static void tb_retimer_unset_inbound_sbtx(struct tb_port *port)
223cd0c1e58SGil Fine {
224cd0c1e58SGil Fine int i;
225cd0c1e58SGil Fine
226*87200371SMika Westerberg /*
227*87200371SMika Westerberg * When USB4 port is offline we need to keep the sideband
228*87200371SMika Westerberg * communications up to make it possible to communicate with
229*87200371SMika Westerberg * the connected retimers.
230*87200371SMika Westerberg */
231*87200371SMika Westerberg if (usb4_port_device_is_offline(port->usb4))
232*87200371SMika Westerberg return;
233*87200371SMika Westerberg
234*87200371SMika Westerberg tb_port_dbg(port, "disabling sideband transactions\n");
235*87200371SMika Westerberg
236cd0c1e58SGil Fine for (i = TB_MAX_RETIMER_INDEX; i >= 1; i--)
237cd0c1e58SGil Fine usb4_port_retimer_unset_inbound_sbtx(port, i);
238cd0c1e58SGil Fine }
239cd0c1e58SGil Fine
nvm_authenticate_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)240dacb1287SKranthi Kuntala static ssize_t nvm_authenticate_store(struct device *dev,
241dacb1287SKranthi Kuntala struct device_attribute *attr, const char *buf, size_t count)
242dacb1287SKranthi Kuntala {
243dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
244faa1c615SRajmohan Mani int val, ret;
245dacb1287SKranthi Kuntala
246dacb1287SKranthi Kuntala pm_runtime_get_sync(&rt->dev);
247dacb1287SKranthi Kuntala
248dacb1287SKranthi Kuntala if (!mutex_trylock(&rt->tb->lock)) {
249dacb1287SKranthi Kuntala ret = restart_syscall();
250dacb1287SKranthi Kuntala goto exit_rpm;
251dacb1287SKranthi Kuntala }
252dacb1287SKranthi Kuntala
253dacb1287SKranthi Kuntala if (!rt->nvm) {
254dacb1287SKranthi Kuntala ret = -EAGAIN;
255dacb1287SKranthi Kuntala goto exit_unlock;
256dacb1287SKranthi Kuntala }
257dacb1287SKranthi Kuntala
258faa1c615SRajmohan Mani ret = kstrtoint(buf, 10, &val);
259dacb1287SKranthi Kuntala if (ret)
260dacb1287SKranthi Kuntala goto exit_unlock;
261dacb1287SKranthi Kuntala
262dacb1287SKranthi Kuntala /* Always clear status */
263dacb1287SKranthi Kuntala rt->auth_status = 0;
264dacb1287SKranthi Kuntala
265dacb1287SKranthi Kuntala if (val) {
266b7b83911SMika Westerberg /*
267b7b83911SMika Westerberg * When NVM authentication starts the retimer is not
268b7b83911SMika Westerberg * accessible so calling tb_retimer_unset_inbound_sbtx()
269b7b83911SMika Westerberg * will fail and therefore we do not call it. Exception
270b7b83911SMika Westerberg * is when the validation fails or we only write the new
271b7b83911SMika Westerberg * NVM image without authentication.
272b7b83911SMika Westerberg */
273cd0c1e58SGil Fine tb_retimer_set_inbound_sbtx(rt->port);
274faa1c615SRajmohan Mani if (val == AUTHENTICATE_ONLY) {
275faa1c615SRajmohan Mani ret = tb_retimer_nvm_authenticate(rt, true);
276faa1c615SRajmohan Mani } else {
277faa1c615SRajmohan Mani if (!rt->nvm->flushed) {
278dacb1287SKranthi Kuntala if (!rt->nvm->buf) {
279dacb1287SKranthi Kuntala ret = -EINVAL;
280dacb1287SKranthi Kuntala goto exit_unlock;
281dacb1287SKranthi Kuntala }
282dacb1287SKranthi Kuntala
283dacb1287SKranthi Kuntala ret = tb_retimer_nvm_validate_and_write(rt);
284faa1c615SRajmohan Mani if (ret || val == WRITE_ONLY)
285dacb1287SKranthi Kuntala goto exit_unlock;
286faa1c615SRajmohan Mani }
287faa1c615SRajmohan Mani if (val == WRITE_AND_AUTHENTICATE)
288faa1c615SRajmohan Mani ret = tb_retimer_nvm_authenticate(rt, false);
289faa1c615SRajmohan Mani }
290dacb1287SKranthi Kuntala }
291dacb1287SKranthi Kuntala
292dacb1287SKranthi Kuntala exit_unlock:
293b7b83911SMika Westerberg if (ret || val == WRITE_ONLY)
294cd0c1e58SGil Fine tb_retimer_unset_inbound_sbtx(rt->port);
295dacb1287SKranthi Kuntala mutex_unlock(&rt->tb->lock);
296dacb1287SKranthi Kuntala exit_rpm:
297dacb1287SKranthi Kuntala pm_runtime_mark_last_busy(&rt->dev);
298dacb1287SKranthi Kuntala pm_runtime_put_autosuspend(&rt->dev);
299dacb1287SKranthi Kuntala
300dacb1287SKranthi Kuntala if (ret)
301dacb1287SKranthi Kuntala return ret;
302dacb1287SKranthi Kuntala return count;
303dacb1287SKranthi Kuntala }
304dacb1287SKranthi Kuntala static DEVICE_ATTR_RW(nvm_authenticate);
305dacb1287SKranthi Kuntala
nvm_version_show(struct device * dev,struct device_attribute * attr,char * buf)306dacb1287SKranthi Kuntala static ssize_t nvm_version_show(struct device *dev,
307dacb1287SKranthi Kuntala struct device_attribute *attr, char *buf)
308dacb1287SKranthi Kuntala {
309dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
310dacb1287SKranthi Kuntala int ret;
311dacb1287SKranthi Kuntala
312dacb1287SKranthi Kuntala if (!mutex_trylock(&rt->tb->lock))
313dacb1287SKranthi Kuntala return restart_syscall();
314dacb1287SKranthi Kuntala
315dacb1287SKranthi Kuntala if (!rt->nvm)
316dacb1287SKranthi Kuntala ret = -EAGAIN;
317dacb1287SKranthi Kuntala else
3188283fb57SAndy Shevchenko ret = sysfs_emit(buf, "%x.%x\n", rt->nvm->major, rt->nvm->minor);
319dacb1287SKranthi Kuntala
320dacb1287SKranthi Kuntala mutex_unlock(&rt->tb->lock);
321dacb1287SKranthi Kuntala return ret;
322dacb1287SKranthi Kuntala }
323dacb1287SKranthi Kuntala static DEVICE_ATTR_RO(nvm_version);
324dacb1287SKranthi Kuntala
vendor_show(struct device * dev,struct device_attribute * attr,char * buf)325dacb1287SKranthi Kuntala static ssize_t vendor_show(struct device *dev, struct device_attribute *attr,
326dacb1287SKranthi Kuntala char *buf)
327dacb1287SKranthi Kuntala {
328dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
329dacb1287SKranthi Kuntala
3308283fb57SAndy Shevchenko return sysfs_emit(buf, "%#x\n", rt->vendor);
331dacb1287SKranthi Kuntala }
332dacb1287SKranthi Kuntala static DEVICE_ATTR_RO(vendor);
333dacb1287SKranthi Kuntala
334dacb1287SKranthi Kuntala static struct attribute *retimer_attrs[] = {
335dacb1287SKranthi Kuntala &dev_attr_device.attr,
336dacb1287SKranthi Kuntala &dev_attr_nvm_authenticate.attr,
337dacb1287SKranthi Kuntala &dev_attr_nvm_version.attr,
338dacb1287SKranthi Kuntala &dev_attr_vendor.attr,
339dacb1287SKranthi Kuntala NULL
340dacb1287SKranthi Kuntala };
341dacb1287SKranthi Kuntala
342dacb1287SKranthi Kuntala static const struct attribute_group retimer_group = {
343dacb1287SKranthi Kuntala .attrs = retimer_attrs,
344dacb1287SKranthi Kuntala };
345dacb1287SKranthi Kuntala
346dacb1287SKranthi Kuntala static const struct attribute_group *retimer_groups[] = {
347dacb1287SKranthi Kuntala &retimer_group,
348dacb1287SKranthi Kuntala NULL
349dacb1287SKranthi Kuntala };
350dacb1287SKranthi Kuntala
tb_retimer_release(struct device * dev)351dacb1287SKranthi Kuntala static void tb_retimer_release(struct device *dev)
352dacb1287SKranthi Kuntala {
353dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
354dacb1287SKranthi Kuntala
355dacb1287SKranthi Kuntala kfree(rt);
356dacb1287SKranthi Kuntala }
357dacb1287SKranthi Kuntala
358dacb1287SKranthi Kuntala struct device_type tb_retimer_type = {
359dacb1287SKranthi Kuntala .name = "thunderbolt_retimer",
360dacb1287SKranthi Kuntala .groups = retimer_groups,
361dacb1287SKranthi Kuntala .release = tb_retimer_release,
362dacb1287SKranthi Kuntala };
363dacb1287SKranthi Kuntala
tb_retimer_add(struct tb_port * port,u8 index,u32 auth_status)364dacb1287SKranthi Kuntala static int tb_retimer_add(struct tb_port *port, u8 index, u32 auth_status)
365dacb1287SKranthi Kuntala {
366dacb1287SKranthi Kuntala struct tb_retimer *rt;
367dacb1287SKranthi Kuntala u32 vendor, device;
368dacb1287SKranthi Kuntala int ret;
369dacb1287SKranthi Kuntala
370dacb1287SKranthi Kuntala ret = usb4_port_retimer_read(port, index, USB4_SB_VENDOR_ID, &vendor,
371dacb1287SKranthi Kuntala sizeof(vendor));
372dacb1287SKranthi Kuntala if (ret) {
373dacb1287SKranthi Kuntala if (ret != -ENODEV)
374dacb1287SKranthi Kuntala tb_port_warn(port, "failed read retimer VendorId: %d\n", ret);
375dacb1287SKranthi Kuntala return ret;
376dacb1287SKranthi Kuntala }
377dacb1287SKranthi Kuntala
378dacb1287SKranthi Kuntala ret = usb4_port_retimer_read(port, index, USB4_SB_PRODUCT_ID, &device,
379dacb1287SKranthi Kuntala sizeof(device));
380dacb1287SKranthi Kuntala if (ret) {
381dacb1287SKranthi Kuntala if (ret != -ENODEV)
382dacb1287SKranthi Kuntala tb_port_warn(port, "failed read retimer ProductId: %d\n", ret);
383dacb1287SKranthi Kuntala return ret;
384dacb1287SKranthi Kuntala }
385dacb1287SKranthi Kuntala
386dacb1287SKranthi Kuntala /*
387dacb1287SKranthi Kuntala * Check that it supports NVM operations. If not then don't add
388dacb1287SKranthi Kuntala * the device at all.
389dacb1287SKranthi Kuntala */
390dacb1287SKranthi Kuntala ret = usb4_port_retimer_nvm_sector_size(port, index);
391dacb1287SKranthi Kuntala if (ret < 0)
392dacb1287SKranthi Kuntala return ret;
393dacb1287SKranthi Kuntala
394dacb1287SKranthi Kuntala rt = kzalloc(sizeof(*rt), GFP_KERNEL);
395dacb1287SKranthi Kuntala if (!rt)
396dacb1287SKranthi Kuntala return -ENOMEM;
397dacb1287SKranthi Kuntala
398dacb1287SKranthi Kuntala rt->index = index;
399dacb1287SKranthi Kuntala rt->vendor = vendor;
400dacb1287SKranthi Kuntala rt->device = device;
401dacb1287SKranthi Kuntala rt->auth_status = auth_status;
402dacb1287SKranthi Kuntala rt->port = port;
403dacb1287SKranthi Kuntala rt->tb = port->sw->tb;
404dacb1287SKranthi Kuntala
4051e56c88aSMika Westerberg rt->dev.parent = &port->usb4->dev;
406dacb1287SKranthi Kuntala rt->dev.bus = &tb_bus_type;
407dacb1287SKranthi Kuntala rt->dev.type = &tb_retimer_type;
408dacb1287SKranthi Kuntala dev_set_name(&rt->dev, "%s:%u.%u", dev_name(&port->sw->dev),
409dacb1287SKranthi Kuntala port->port, index);
410dacb1287SKranthi Kuntala
411dacb1287SKranthi Kuntala ret = device_register(&rt->dev);
412dacb1287SKranthi Kuntala if (ret) {
413dacb1287SKranthi Kuntala dev_err(&rt->dev, "failed to register retimer: %d\n", ret);
414dacb1287SKranthi Kuntala put_device(&rt->dev);
415dacb1287SKranthi Kuntala return ret;
416dacb1287SKranthi Kuntala }
417dacb1287SKranthi Kuntala
418dacb1287SKranthi Kuntala ret = tb_retimer_nvm_add(rt);
419dacb1287SKranthi Kuntala if (ret) {
420dacb1287SKranthi Kuntala dev_err(&rt->dev, "failed to add NVM devices: %d\n", ret);
421bec4d7c9SDan Carpenter device_unregister(&rt->dev);
422dacb1287SKranthi Kuntala return ret;
423dacb1287SKranthi Kuntala }
424dacb1287SKranthi Kuntala
425dacb1287SKranthi Kuntala dev_info(&rt->dev, "new retimer found, vendor=%#x device=%#x\n",
426dacb1287SKranthi Kuntala rt->vendor, rt->device);
427dacb1287SKranthi Kuntala
428dacb1287SKranthi Kuntala pm_runtime_no_callbacks(&rt->dev);
429dacb1287SKranthi Kuntala pm_runtime_set_active(&rt->dev);
430dacb1287SKranthi Kuntala pm_runtime_enable(&rt->dev);
431dacb1287SKranthi Kuntala pm_runtime_set_autosuspend_delay(&rt->dev, TB_AUTOSUSPEND_DELAY);
432dacb1287SKranthi Kuntala pm_runtime_mark_last_busy(&rt->dev);
433dacb1287SKranthi Kuntala pm_runtime_use_autosuspend(&rt->dev);
434dacb1287SKranthi Kuntala
435dacb1287SKranthi Kuntala return 0;
436dacb1287SKranthi Kuntala }
437dacb1287SKranthi Kuntala
tb_retimer_remove(struct tb_retimer * rt)438dacb1287SKranthi Kuntala static void tb_retimer_remove(struct tb_retimer *rt)
439dacb1287SKranthi Kuntala {
440dacb1287SKranthi Kuntala dev_info(&rt->dev, "retimer disconnected\n");
441dacb1287SKranthi Kuntala tb_nvm_free(rt->nvm);
442dacb1287SKranthi Kuntala device_unregister(&rt->dev);
443dacb1287SKranthi Kuntala }
444dacb1287SKranthi Kuntala
445dacb1287SKranthi Kuntala struct tb_retimer_lookup {
446dacb1287SKranthi Kuntala const struct tb_port *port;
447dacb1287SKranthi Kuntala u8 index;
448dacb1287SKranthi Kuntala };
449dacb1287SKranthi Kuntala
retimer_match(struct device * dev,void * data)450dacb1287SKranthi Kuntala static int retimer_match(struct device *dev, void *data)
451dacb1287SKranthi Kuntala {
452dacb1287SKranthi Kuntala const struct tb_retimer_lookup *lookup = data;
453dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
454dacb1287SKranthi Kuntala
455dacb1287SKranthi Kuntala return rt && rt->port == lookup->port && rt->index == lookup->index;
456dacb1287SKranthi Kuntala }
457dacb1287SKranthi Kuntala
tb_port_find_retimer(struct tb_port * port,u8 index)458dacb1287SKranthi Kuntala static struct tb_retimer *tb_port_find_retimer(struct tb_port *port, u8 index)
459dacb1287SKranthi Kuntala {
460dacb1287SKranthi Kuntala struct tb_retimer_lookup lookup = { .port = port, .index = index };
461dacb1287SKranthi Kuntala struct device *dev;
462dacb1287SKranthi Kuntala
463cae5f515SMika Westerberg dev = device_find_child(&port->usb4->dev, &lookup, retimer_match);
464dacb1287SKranthi Kuntala if (dev)
465dacb1287SKranthi Kuntala return tb_to_retimer(dev);
466dacb1287SKranthi Kuntala
467dacb1287SKranthi Kuntala return NULL;
468dacb1287SKranthi Kuntala }
469dacb1287SKranthi Kuntala
470dacb1287SKranthi Kuntala /**
471dacb1287SKranthi Kuntala * tb_retimer_scan() - Scan for on-board retimers under port
472dacb1287SKranthi Kuntala * @port: USB4 port to scan
4733fb10ea4SRajmohan Mani * @add: If true also registers found retimers
474dacb1287SKranthi Kuntala *
4753fb10ea4SRajmohan Mani * Brings the sideband into a state where retimers can be accessed.
4763fb10ea4SRajmohan Mani * Then Tries to enumerate on-board retimers connected to @port. Found
4773fb10ea4SRajmohan Mani * retimers are registered as children of @port if @add is set. Does
4783fb10ea4SRajmohan Mani * not scan for cable retimers for now.
479dacb1287SKranthi Kuntala */
tb_retimer_scan(struct tb_port * port,bool add)4803fb10ea4SRajmohan Mani int tb_retimer_scan(struct tb_port *port, bool add)
481dacb1287SKranthi Kuntala {
48208fe7ae1SDan Carpenter u32 status[TB_MAX_RETIMER_INDEX + 1] = {};
483dacb1287SKranthi Kuntala int ret, i, last_idx = 0;
484dacb1287SKranthi Kuntala
485dacb1287SKranthi Kuntala /*
486dacb1287SKranthi Kuntala * Send broadcast RT to make sure retimer indices facing this
487dacb1287SKranthi Kuntala * port are set.
488dacb1287SKranthi Kuntala */
489dacb1287SKranthi Kuntala ret = usb4_port_enumerate_retimers(port);
490dacb1287SKranthi Kuntala if (ret)
49123257cfcSMika Westerberg return ret;
492dacb1287SKranthi Kuntala
493dacb1287SKranthi Kuntala /*
4941402ba08SMika Westerberg * Immediately after sending enumerate retimers read the
4951402ba08SMika Westerberg * authentication status of each retimer.
4961402ba08SMika Westerberg */
4971402ba08SMika Westerberg tb_retimer_nvm_authenticate_status(port, status);
4981402ba08SMika Westerberg
4991402ba08SMika Westerberg /*
5003fb10ea4SRajmohan Mani * Enable sideband channel for each retimer. We can do this
5013fb10ea4SRajmohan Mani * regardless whether there is device connected or not.
5023fb10ea4SRajmohan Mani */
503cd0c1e58SGil Fine tb_retimer_set_inbound_sbtx(port);
5043fb10ea4SRajmohan Mani
505dacb1287SKranthi Kuntala for (i = 1; i <= TB_MAX_RETIMER_INDEX; i++) {
506dacb1287SKranthi Kuntala /*
507dacb1287SKranthi Kuntala * Last retimer is true only for the last on-board
508dacb1287SKranthi Kuntala * retimer (the one connected directly to the Type-C
509dacb1287SKranthi Kuntala * port).
510dacb1287SKranthi Kuntala */
511dacb1287SKranthi Kuntala ret = usb4_port_retimer_is_last(port, i);
512dacb1287SKranthi Kuntala if (ret > 0)
513dacb1287SKranthi Kuntala last_idx = i;
514dacb1287SKranthi Kuntala else if (ret < 0)
515dacb1287SKranthi Kuntala break;
516dacb1287SKranthi Kuntala }
517dacb1287SKranthi Kuntala
518cd0c1e58SGil Fine tb_retimer_unset_inbound_sbtx(port);
519cd0c1e58SGil Fine
520c28f3d80SUtkarsh Patel if (!last_idx)
52123257cfcSMika Westerberg return 0;
522dacb1287SKranthi Kuntala
523dacb1287SKranthi Kuntala /* Add on-board retimers if they do not exist already */
52423257cfcSMika Westerberg ret = 0;
525dacb1287SKranthi Kuntala for (i = 1; i <= last_idx; i++) {
526dacb1287SKranthi Kuntala struct tb_retimer *rt;
527dacb1287SKranthi Kuntala
528dacb1287SKranthi Kuntala rt = tb_port_find_retimer(port, i);
529dacb1287SKranthi Kuntala if (rt) {
530dacb1287SKranthi Kuntala put_device(&rt->dev);
5313fb10ea4SRajmohan Mani } else if (add) {
532dacb1287SKranthi Kuntala ret = tb_retimer_add(port, i, status[i]);
533dacb1287SKranthi Kuntala if (ret && ret != -EOPNOTSUPP)
5343fb10ea4SRajmohan Mani break;
535dacb1287SKranthi Kuntala }
536dacb1287SKranthi Kuntala }
537dacb1287SKranthi Kuntala
5381e56c88aSMika Westerberg return ret;
539dacb1287SKranthi Kuntala }
540dacb1287SKranthi Kuntala
remove_retimer(struct device * dev,void * data)541dacb1287SKranthi Kuntala static int remove_retimer(struct device *dev, void *data)
542dacb1287SKranthi Kuntala {
543dacb1287SKranthi Kuntala struct tb_retimer *rt = tb_to_retimer(dev);
544dacb1287SKranthi Kuntala struct tb_port *port = data;
545dacb1287SKranthi Kuntala
546dacb1287SKranthi Kuntala if (rt && rt->port == port)
547dacb1287SKranthi Kuntala tb_retimer_remove(rt);
548dacb1287SKranthi Kuntala return 0;
549dacb1287SKranthi Kuntala }
550dacb1287SKranthi Kuntala
551dacb1287SKranthi Kuntala /**
552dacb1287SKranthi Kuntala * tb_retimer_remove_all() - Remove all retimers under port
553dacb1287SKranthi Kuntala * @port: USB4 port whose retimers to remove
554dacb1287SKranthi Kuntala *
555dacb1287SKranthi Kuntala * This removes all previously added retimers under @port.
556dacb1287SKranthi Kuntala */
tb_retimer_remove_all(struct tb_port * port)557dacb1287SKranthi Kuntala void tb_retimer_remove_all(struct tb_port *port)
558dacb1287SKranthi Kuntala {
559cae5f515SMika Westerberg struct usb4_port *usb4;
560cae5f515SMika Westerberg
561cae5f515SMika Westerberg usb4 = port->usb4;
562cae5f515SMika Westerberg if (usb4)
563cae5f515SMika Westerberg device_for_each_child_reverse(&usb4->dev, port,
564dacb1287SKranthi Kuntala remove_retimer);
565dacb1287SKranthi Kuntala }
566