Lines Matching +full:port +full:-
1 // SPDX-License-Identifier: GPL-2.0
3 * Serial Attached SCSI (SAS) Port class
15 static bool phy_is_wideport_member(struct asd_sas_port *port, struct asd_sas_phy *phy) in phy_is_wideport_member() argument
17 struct sas_ha_struct *sas_ha = phy->ha; in phy_is_wideport_member()
19 if (memcmp(port->attached_sas_addr, phy->attached_sas_addr, in phy_is_wideport_member()
20 SAS_ADDR_SIZE) != 0 || (sas_ha->strict_wide_ports && in phy_is_wideport_member()
21 memcmp(port->sas_addr, phy->sas_addr, SAS_ADDR_SIZE) != 0)) in phy_is_wideport_member()
29 struct asd_sas_port *port = phy->port; in sas_resume_port() local
30 struct sas_ha_struct *sas_ha = phy->ha; in sas_resume_port()
31 struct sas_internal *si = to_sas_internal(sas_ha->shost->transportt); in sas_resume_port()
33 if (si->dft->lldd_port_formed) in sas_resume_port()
34 si->dft->lldd_port_formed(phy); in sas_resume_port()
36 if (port->suspended) in sas_resume_port()
37 port->suspended = 0; in sas_resume_port()
43 /* if the port came back: in sas_resume_port()
47 list_for_each_entry_safe(dev, n, &port->dev_list, dev_list_node) { in sas_resume_port()
52 sas_unregister_dev(port, dev); in sas_resume_port()
53 sas_destruct_devices(port); in sas_resume_port()
57 if (dev_is_expander(dev->dev_type)) { in sas_resume_port()
58 dev->ex_dev.ex_change_count = -1; in sas_resume_port()
59 for (i = 0; i < dev->ex_dev.num_phys; i++) { in sas_resume_port()
60 struct ex_phy *phy = &dev->ex_dev.ex_phy[i]; in sas_resume_port()
62 phy->phy_change_count = -1; in sas_resume_port()
67 sas_discover_event(port, DISCE_RESUME); in sas_resume_port()
70 static void sas_form_port_add_phy(struct asd_sas_port *port, in sas_form_port_add_phy() argument
73 list_add_tail(&phy->port_phy_el, &port->phy_list); in sas_form_port_add_phy()
74 sas_phy_set_target(phy, port->port_dev); in sas_form_port_add_phy()
75 phy->port = port; in sas_form_port_add_phy()
76 port->num_phys++; in sas_form_port_add_phy()
77 port->phy_mask |= (1U << phy->id); in sas_form_port_add_phy()
80 pr_debug("phy%d matched wide port%d\n", phy->id, in sas_form_port_add_phy()
81 port->id); in sas_form_port_add_phy()
83 memcpy(port->sas_addr, phy->sas_addr, SAS_ADDR_SIZE); in sas_form_port_add_phy()
85 if (*(u64 *)port->attached_sas_addr == 0) { in sas_form_port_add_phy()
86 memcpy(port->attached_sas_addr, phy->attached_sas_addr, in sas_form_port_add_phy()
88 port->iproto = phy->iproto; in sas_form_port_add_phy()
89 port->tproto = phy->tproto; in sas_form_port_add_phy()
90 port->oob_mode = phy->oob_mode; in sas_form_port_add_phy()
91 port->linkrate = phy->linkrate; in sas_form_port_add_phy()
93 port->linkrate = max(port->linkrate, phy->linkrate); in sas_form_port_add_phy()
98 * sas_form_port - add this phy to a port
101 * This function adds this phy to an existing port, thus creating a wide
102 * port, or it creates a port and adds the phy to the port.
107 struct sas_ha_struct *sas_ha = phy->ha; in sas_form_port()
108 struct asd_sas_port *port = phy->port; in sas_form_port() local
111 to_sas_internal(sas_ha->shost->transportt); in sas_form_port()
114 if (port) { in sas_form_port()
115 if (!phy_is_wideport_member(port, phy)) in sas_form_port()
117 else if (phy->suspended) { in sas_form_port()
118 phy->suspended = 0; in sas_form_port()
122 wake_up(&sas_ha->eh_wait_q); in sas_form_port()
125 pr_info("%s: phy%d belongs to port%d already(%d)!\n", in sas_form_port()
126 __func__, phy->id, phy->port->id, in sas_form_port()
127 phy->port->num_phys); in sas_form_port()
132 /* see if the phy should be part of a wide port */ in sas_form_port()
133 spin_lock_irqsave(&sas_ha->phy_port_lock, flags); in sas_form_port()
134 for (i = 0; i < sas_ha->num_phys; i++) { in sas_form_port()
135 port = sas_ha->sas_port[i]; in sas_form_port()
136 spin_lock(&port->phy_list_lock); in sas_form_port()
137 if (*(u64 *) port->sas_addr && in sas_form_port()
138 phy_is_wideport_member(port, phy) && port->num_phys > 0) { in sas_form_port()
139 /* wide port */ in sas_form_port()
140 port_dev = port->port_dev; in sas_form_port()
141 sas_form_port_add_phy(port, phy, true); in sas_form_port()
142 spin_unlock(&port->phy_list_lock); in sas_form_port()
145 spin_unlock(&port->phy_list_lock); in sas_form_port()
147 /* The phy does not match any existing port, create a new one */ in sas_form_port()
148 if (i == sas_ha->num_phys) { in sas_form_port()
149 for (i = 0; i < sas_ha->num_phys; i++) { in sas_form_port()
150 port = sas_ha->sas_port[i]; in sas_form_port()
151 spin_lock(&port->phy_list_lock); in sas_form_port()
152 if (*(u64 *)port->sas_addr == 0 in sas_form_port()
153 && port->num_phys == 0) { in sas_form_port()
154 port_dev = port->port_dev; in sas_form_port()
155 sas_form_port_add_phy(port, phy, false); in sas_form_port()
156 spin_unlock(&port->phy_list_lock); in sas_form_port()
159 spin_unlock(&port->phy_list_lock); in sas_form_port()
162 if (i >= sas_ha->num_phys) { in sas_form_port()
163 pr_err("%s: couldn't find a free port, bug?\n", in sas_form_port()
165 spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); in sas_form_port()
169 spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); in sas_form_port()
171 if (!port->port) { in sas_form_port()
172 port->port = sas_port_alloc(phy->phy->dev.parent, port->id); in sas_form_port()
173 BUG_ON(!port->port); in sas_form_port()
174 sas_port_add(port->port); in sas_form_port()
176 sas_port_add_phy(port->port, phy->phy); in sas_form_port()
179 dev_name(&phy->phy->dev), dev_name(&port->port->dev), in sas_form_port()
180 port->phy_mask, in sas_form_port()
181 SAS_ADDR(port->attached_sas_addr)); in sas_form_port()
184 port_dev->pathways = port->num_phys; in sas_form_port()
186 /* Tell the LLDD about this port formation. */ in sas_form_port()
187 if (si->dft->lldd_port_formed) in sas_form_port()
188 si->dft->lldd_port_formed(phy); in sas_form_port()
190 sas_discover_event(phy->port, DISCE_DISCOVER_DOMAIN); in sas_form_port()
192 if (port_dev && dev_is_expander(port_dev->dev_type)) { in sas_form_port()
193 struct expander_device *ex_dev = &port_dev->ex_dev; in sas_form_port()
195 ex_dev->ex_change_count = -1; in sas_form_port()
196 sas_discover_event(port, DISCE_REVALIDATE_DOMAIN); in sas_form_port()
198 flush_workqueue(sas_ha->disco_q); in sas_form_port()
202 * sas_deform_port - remove this phy from the port it belongs to
211 struct sas_ha_struct *sas_ha = phy->ha; in sas_deform_port()
212 struct asd_sas_port *port = phy->port; in sas_deform_port() local
214 to_sas_internal(sas_ha->shost->transportt); in sas_deform_port()
218 if (!port) in sas_deform_port()
221 dev = port->port_dev; in sas_deform_port()
223 dev->pathways--; in sas_deform_port()
225 if (port->num_phys == 1) { in sas_deform_port()
226 sas_unregister_domain_devices(port, gone); in sas_deform_port()
227 sas_destruct_devices(port); in sas_deform_port()
228 sas_port_delete(port->port); in sas_deform_port()
229 port->port = NULL; in sas_deform_port()
231 sas_port_delete_phy(port->port, phy->phy); in sas_deform_port()
232 sas_device_set_phy(dev, port->port); in sas_deform_port()
235 if (si->dft->lldd_port_deformed) in sas_deform_port()
236 si->dft->lldd_port_deformed(phy); in sas_deform_port()
238 spin_lock_irqsave(&sas_ha->phy_port_lock, flags); in sas_deform_port()
239 spin_lock(&port->phy_list_lock); in sas_deform_port()
241 list_del_init(&phy->port_phy_el); in sas_deform_port()
243 phy->port = NULL; in sas_deform_port()
244 port->num_phys--; in sas_deform_port()
245 port->phy_mask &= ~(1U << phy->id); in sas_deform_port()
247 if (port->num_phys == 0) { in sas_deform_port()
248 INIT_LIST_HEAD(&port->phy_list); in sas_deform_port()
249 memset(port->sas_addr, 0, SAS_ADDR_SIZE); in sas_deform_port()
250 memset(port->attached_sas_addr, 0, SAS_ADDR_SIZE); in sas_deform_port()
251 port->iproto = 0; in sas_deform_port()
252 port->tproto = 0; in sas_deform_port()
253 port->oob_mode = 0; in sas_deform_port()
254 port->phy_mask = 0; in sas_deform_port()
256 spin_unlock(&port->phy_list_lock); in sas_deform_port()
257 spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); in sas_deform_port()
259 /* Only insert revalidate event if the port still has members */ in sas_deform_port()
260 if (port->port && dev && dev_is_expander(dev->dev_type)) { in sas_deform_port()
261 struct expander_device *ex_dev = &dev->ex_dev; in sas_deform_port()
263 ex_dev->ex_change_count = -1; in sas_deform_port()
264 sas_discover_event(port, DISCE_REVALIDATE_DOMAIN); in sas_deform_port()
266 flush_workqueue(sas_ha->disco_q); in sas_deform_port()
271 /* ---------- SAS port events ---------- */
276 struct asd_sas_phy *phy = ev->phy; in sas_porte_bytes_dmaed()
284 struct asd_sas_phy *phy = ev->phy; in sas_porte_broadcast_rcvd()
288 spin_lock_irqsave(&phy->sas_prim_lock, flags); in sas_porte_broadcast_rcvd()
289 prim = phy->sas_prim; in sas_porte_broadcast_rcvd()
290 spin_unlock_irqrestore(&phy->sas_prim_lock, flags); in sas_porte_broadcast_rcvd()
293 sas_discover_event(phy->port, DISCE_REVALIDATE_DOMAIN); in sas_porte_broadcast_rcvd()
295 if (phy->port) in sas_porte_broadcast_rcvd()
296 flush_workqueue(phy->port->ha->disco_q); in sas_porte_broadcast_rcvd()
302 struct asd_sas_phy *phy = ev->phy; in sas_porte_link_reset_err()
310 struct asd_sas_phy *phy = ev->phy; in sas_porte_timer_event()
318 struct asd_sas_phy *phy = ev->phy; in sas_porte_hard_reset()
323 /* ---------- SAS port registration ---------- */
325 static void sas_init_port(struct asd_sas_port *port, in sas_init_port() argument
328 memset(port, 0, sizeof(*port)); in sas_init_port()
329 port->id = i; in sas_init_port()
330 INIT_LIST_HEAD(&port->dev_list); in sas_init_port()
331 INIT_LIST_HEAD(&port->disco_list); in sas_init_port()
332 INIT_LIST_HEAD(&port->destroy_list); in sas_init_port()
333 INIT_LIST_HEAD(&port->sas_port_del_list); in sas_init_port()
334 spin_lock_init(&port->phy_list_lock); in sas_init_port()
335 INIT_LIST_HEAD(&port->phy_list); in sas_init_port()
336 port->ha = sas_ha; in sas_init_port()
338 spin_lock_init(&port->dev_list_lock); in sas_init_port()
346 for (i = 0; i < sas_ha->num_phys; i++) { in sas_register_ports()
347 struct asd_sas_port *port = sas_ha->sas_port[i]; in sas_register_ports() local
349 sas_init_port(port, sas_ha, i); in sas_register_ports()
350 sas_init_disc(&port->disc, port); in sas_register_ports()
359 for (i = 0; i < sas_ha->num_phys; i++) in sas_unregister_ports()
360 if (sas_ha->sas_phy[i]->port) in sas_unregister_ports()
361 sas_deform_port(sas_ha->sas_phy[i], 0); in sas_unregister_ports()