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->core.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()
44 	 * 1/ presume every device came back  in sas_resume_port()
47 	list_for_each_entry(dev, &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()
71  * sas_form_port - add this phy to a port
74  * This function adds this phy to an existing port, thus creating a wide
75  * port, or it creates a port and adds the phy to the port.
80 	struct sas_ha_struct *sas_ha = phy->ha;  in sas_form_port()
81 	struct asd_sas_port *port = phy->port;  in sas_form_port()  local
84 		to_sas_internal(sas_ha->core.shost->transportt);  in sas_form_port()
87 	if (port) {  in sas_form_port()
88 		if (!phy_is_wideport_member(port, phy))  in sas_form_port()
90 		else if (phy->suspended) {  in sas_form_port()
91 			phy->suspended = 0;  in sas_form_port()
95 			wake_up(&sas_ha->eh_wait_q);  in sas_form_port()
98 			pr_info("%s: phy%d belongs to port%d already(%d)!\n",  in sas_form_port()
99 				__func__, phy->id, phy->port->id,  in sas_form_port()
100 				phy->port->num_phys);  in sas_form_port()
105 	/* see if the phy should be part of a wide port */  in sas_form_port()
106 	spin_lock_irqsave(&sas_ha->phy_port_lock, flags);  in sas_form_port()
107 	for (i = 0; i < sas_ha->num_phys; i++) {  in sas_form_port()
108 		port = sas_ha->sas_port[i];  in sas_form_port()
109 		spin_lock(&port->phy_list_lock);  in sas_form_port()
110 		if (*(u64 *) port->sas_addr &&  in sas_form_port()
111 		    phy_is_wideport_member(port, phy) && port->num_phys > 0) {  in sas_form_port()
112 			/* wide port */  in sas_form_port()
113 			pr_debug("phy%d matched wide port%d\n", phy->id,  in sas_form_port()
114 				 port->id);  in sas_form_port()
117 		spin_unlock(&port->phy_list_lock);  in sas_form_port()
119 	/* The phy does not match any existing port, create a new one */  in sas_form_port()
120 	if (i == sas_ha->num_phys) {  in sas_form_port()
121 		for (i = 0; i < sas_ha->num_phys; i++) {  in sas_form_port()
122 			port = sas_ha->sas_port[i];  in sas_form_port()
123 			spin_lock(&port->phy_list_lock);  in sas_form_port()
124 			if (*(u64 *)port->sas_addr == 0  in sas_form_port()
125 				&& port->num_phys == 0) {  in sas_form_port()
126 				memcpy(port->sas_addr, phy->sas_addr,  in sas_form_port()
130 			spin_unlock(&port->phy_list_lock);  in sas_form_port()
134 	if (i >= sas_ha->num_phys) {  in sas_form_port()
135 		pr_err("%s: couldn't find a free port, bug?\n", __func__);  in sas_form_port()
136 		spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags);  in sas_form_port()
140 	/* add the phy to the port */  in sas_form_port()
141 	port_dev = port->port_dev;  in sas_form_port()
142 	list_add_tail(&phy->port_phy_el, &port->phy_list);  in sas_form_port()
144 	phy->port = port;  in sas_form_port()
145 	port->num_phys++;  in sas_form_port()
146 	port->phy_mask |= (1U << phy->id);  in sas_form_port()
148 	if (*(u64 *)port->attached_sas_addr == 0) {  in sas_form_port()
149 		port->class = phy->class;  in sas_form_port()
150 		memcpy(port->attached_sas_addr, phy->attached_sas_addr,  in sas_form_port()
152 		port->iproto = phy->iproto;  in sas_form_port()
153 		port->tproto = phy->tproto;  in sas_form_port()
154 		port->oob_mode = phy->oob_mode;  in sas_form_port()
155 		port->linkrate = phy->linkrate;  in sas_form_port()
157 		port->linkrate = max(port->linkrate, phy->linkrate);  in sas_form_port()
158 	spin_unlock(&port->phy_list_lock);  in sas_form_port()
159 	spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags);  in sas_form_port()
161 	if (!port->port) {  in sas_form_port()
162 		port->port = sas_port_alloc(phy->phy->dev.parent, port->id);  in sas_form_port()
163 		BUG_ON(!port->port);  in sas_form_port()
164 		sas_port_add(port->port);  in sas_form_port()
166 	sas_port_add_phy(port->port, phy->phy);  in sas_form_port()
169 		 dev_name(&phy->phy->dev), dev_name(&port->port->dev),  in sas_form_port()
170 		 port->phy_mask,  in sas_form_port()
171 		 SAS_ADDR(port->attached_sas_addr));  in sas_form_port()
174 		port_dev->pathways = port->num_phys;  in sas_form_port()
176 	/* Tell the LLDD about this port formation. */  in sas_form_port()
177 	if (si->dft->lldd_port_formed)  in sas_form_port()
178 		si->dft->lldd_port_formed(phy);  in sas_form_port()
180 	sas_discover_event(phy->port, DISCE_DISCOVER_DOMAIN);  in sas_form_port()
182 	if (port_dev && dev_is_expander(port_dev->dev_type)) {  in sas_form_port()
183 		struct expander_device *ex_dev = &port_dev->ex_dev;  in sas_form_port()
185 		ex_dev->ex_change_count = -1;  in sas_form_port()
186 		sas_discover_event(port, DISCE_REVALIDATE_DOMAIN);  in sas_form_port()
188 	flush_workqueue(sas_ha->disco_q);  in sas_form_port()
192  * sas_deform_port - remove this phy from the port it belongs to
201 	struct sas_ha_struct *sas_ha = phy->ha;  in sas_deform_port()
202 	struct asd_sas_port *port = phy->port;  in sas_deform_port()  local
204 		to_sas_internal(sas_ha->core.shost->transportt);  in sas_deform_port()
208 	if (!port)  in sas_deform_port()
211 	dev = port->port_dev;  in sas_deform_port()
213 		dev->pathways--;  in sas_deform_port()
215 	if (port->num_phys == 1) {  in sas_deform_port()
216 		sas_unregister_domain_devices(port, gone);  in sas_deform_port()
217 		sas_destruct_devices(port);  in sas_deform_port()
218 		sas_port_delete(port->port);  in sas_deform_port()
219 		port->port = NULL;  in sas_deform_port()
221 		sas_port_delete_phy(port->port, phy->phy);  in sas_deform_port()
222 		sas_device_set_phy(dev, port->port);  in sas_deform_port()
225 	if (si->dft->lldd_port_deformed)  in sas_deform_port()
226 		si->dft->lldd_port_deformed(phy);  in sas_deform_port()
228 	spin_lock_irqsave(&sas_ha->phy_port_lock, flags);  in sas_deform_port()
229 	spin_lock(&port->phy_list_lock);  in sas_deform_port()
231 	list_del_init(&phy->port_phy_el);  in sas_deform_port()
233 	phy->port = NULL;  in sas_deform_port()
234 	port->num_phys--;  in sas_deform_port()
235 	port->phy_mask &= ~(1U << phy->id);  in sas_deform_port()
237 	if (port->num_phys == 0) {  in sas_deform_port()
238 		INIT_LIST_HEAD(&port->phy_list);  in sas_deform_port()
239 		memset(port->sas_addr, 0, SAS_ADDR_SIZE);  in sas_deform_port()
240 		memset(port->attached_sas_addr, 0, SAS_ADDR_SIZE);  in sas_deform_port()
241 		port->class = 0;  in sas_deform_port()
242 		port->iproto = 0;  in sas_deform_port()
243 		port->tproto = 0;  in sas_deform_port()
244 		port->oob_mode = 0;  in sas_deform_port()
245 		port->phy_mask = 0;  in sas_deform_port()
247 	spin_unlock(&port->phy_list_lock);  in sas_deform_port()
248 	spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags);  in sas_deform_port()
250 	/* Only insert revalidate event if the port still has members */  in sas_deform_port()
251 	if (port->port && dev && dev_is_expander(dev->dev_type)) {  in sas_deform_port()
252 		struct expander_device *ex_dev = &dev->ex_dev;  in sas_deform_port()
254 		ex_dev->ex_change_count = -1;  in sas_deform_port()
255 		sas_discover_event(port, DISCE_REVALIDATE_DOMAIN);  in sas_deform_port()
257 	flush_workqueue(sas_ha->disco_q);  in sas_deform_port()
262 /* ---------- SAS port events ---------- */
267 	struct asd_sas_phy *phy = ev->phy;  in sas_porte_bytes_dmaed()
275 	struct asd_sas_phy *phy = ev->phy;  in sas_porte_broadcast_rcvd()
279 	spin_lock_irqsave(&phy->sas_prim_lock, flags);  in sas_porte_broadcast_rcvd()
280 	prim = phy->sas_prim;  in sas_porte_broadcast_rcvd()
281 	spin_unlock_irqrestore(&phy->sas_prim_lock, flags);  in sas_porte_broadcast_rcvd()
284 	sas_discover_event(phy->port, DISCE_REVALIDATE_DOMAIN);  in sas_porte_broadcast_rcvd()
286 	if (phy->port)  in sas_porte_broadcast_rcvd()
287 		flush_workqueue(phy->port->ha->disco_q);  in sas_porte_broadcast_rcvd()
293 	struct asd_sas_phy *phy = ev->phy;  in sas_porte_link_reset_err()
295 	sas_deform_port(phy, 1);  in sas_porte_link_reset_err()
301 	struct asd_sas_phy *phy = ev->phy;  in sas_porte_timer_event()
303 	sas_deform_port(phy, 1);  in sas_porte_timer_event()
309 	struct asd_sas_phy *phy = ev->phy;  in sas_porte_hard_reset()
311 	sas_deform_port(phy, 1);  in sas_porte_hard_reset()
314 /* ---------- SAS port registration ---------- */
316 static void sas_init_port(struct asd_sas_port *port,  in sas_init_port()  argument
319 	memset(port, 0, sizeof(*port));  in sas_init_port()
320 	port->id = i;  in sas_init_port()
321 	INIT_LIST_HEAD(&port->dev_list);  in sas_init_port()
322 	INIT_LIST_HEAD(&port->disco_list);  in sas_init_port()
323 	INIT_LIST_HEAD(&port->destroy_list);  in sas_init_port()
324 	INIT_LIST_HEAD(&port->sas_port_del_list);  in sas_init_port()
325 	spin_lock_init(&port->phy_list_lock);  in sas_init_port()
326 	INIT_LIST_HEAD(&port->phy_list);  in sas_init_port()
327 	port->ha = sas_ha;  in sas_init_port()
329 	spin_lock_init(&port->dev_list_lock);  in sas_init_port()
337 	for (i = 0; i < sas_ha->num_phys; i++) {  in sas_register_ports()
338 		struct asd_sas_port *port = sas_ha->sas_port[i];  in sas_register_ports()  local
340 		sas_init_port(port, sas_ha, i);  in sas_register_ports()
341 		sas_init_disc(&port->disc, port);  in sas_register_ports()
350 	for (i = 0; i < sas_ha->num_phys; i++)  in sas_unregister_ports()
351 		if (sas_ha->sas_phy[i]->port)  in sas_unregister_ports()
352 			sas_deform_port(sas_ha->sas_phy[i], 0);  in sas_unregister_ports()