Commit | Line | Data |
---|---|---|
2908d778 JB |
1 | /* |
2 | * Serial Attached SCSI (SAS) Port class | |
3 | * | |
4 | * Copyright (C) 2005 Adaptec, Inc. All rights reserved. | |
5 | * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com> | |
6 | * | |
7 | * This file is licensed under GPLv2. | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or | |
10 | * modify it under the terms of the GNU General Public License as | |
11 | * published by the Free Software Foundation; either version 2 of the | |
12 | * License, or (at your option) any later version. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, but | |
15 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
17 | * General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
22 | * | |
23 | */ | |
24 | ||
25 | #include "sas_internal.h" | |
26 | ||
27 | #include <scsi/scsi_transport.h> | |
28 | #include <scsi/scsi_transport_sas.h> | |
29 | #include "../scsi_sas_internal.h" | |
30 | ||
31 | /** | |
32 | * sas_form_port -- add this phy to a port | |
33 | * @phy: the phy of interest | |
34 | * | |
35 | * This function adds this phy to an existing port, thus creating a wide | |
36 | * port, or it creates a port and adds the phy to the port. | |
37 | */ | |
38 | static void sas_form_port(struct asd_sas_phy *phy) | |
39 | { | |
40 | int i; | |
41 | struct sas_ha_struct *sas_ha = phy->ha; | |
42 | struct asd_sas_port *port = phy->port; | |
43 | struct sas_internal *si = | |
44 | to_sas_internal(sas_ha->core.shost->transportt); | |
980fa2f9 | 45 | unsigned long flags; |
2908d778 JB |
46 | |
47 | if (port) { | |
48 | if (memcmp(port->attached_sas_addr, phy->attached_sas_addr, | |
49 | SAS_ADDR_SIZE) == 0) | |
50 | sas_deform_port(phy); | |
51 | else { | |
52 | SAS_DPRINTK("%s: phy%d belongs to port%d already(%d)!\n", | |
53 | __FUNCTION__, phy->id, phy->port->id, | |
54 | phy->port->num_phys); | |
55 | return; | |
56 | } | |
57 | } | |
58 | ||
59 | /* find a port */ | |
980fa2f9 | 60 | spin_lock_irqsave(&sas_ha->phy_port_lock, flags); |
2908d778 JB |
61 | for (i = 0; i < sas_ha->num_phys; i++) { |
62 | port = sas_ha->sas_port[i]; | |
63 | spin_lock(&port->phy_list_lock); | |
64 | if (*(u64 *) port->sas_addr && | |
65 | memcmp(port->attached_sas_addr, | |
66 | phy->attached_sas_addr, SAS_ADDR_SIZE) == 0 && | |
67 | port->num_phys > 0) { | |
68 | /* wide port */ | |
69 | SAS_DPRINTK("phy%d matched wide port%d\n", phy->id, | |
70 | port->id); | |
71 | break; | |
72 | } else if (*(u64 *) port->sas_addr == 0 && port->num_phys==0) { | |
73 | memcpy(port->sas_addr, phy->sas_addr, SAS_ADDR_SIZE); | |
74 | break; | |
75 | } | |
76 | spin_unlock(&port->phy_list_lock); | |
77 | } | |
78 | ||
79 | if (i >= sas_ha->num_phys) { | |
80 | printk(KERN_NOTICE "%s: couldn't find a free port, bug?\n", | |
81 | __FUNCTION__); | |
980fa2f9 | 82 | spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); |
2908d778 JB |
83 | return; |
84 | } | |
85 | ||
86 | /* add the phy to the port */ | |
87 | list_add_tail(&phy->port_phy_el, &port->phy_list); | |
88 | phy->port = port; | |
89 | port->num_phys++; | |
90 | port->phy_mask |= (1U << phy->id); | |
91 | ||
92 | if (!port->phy) | |
93 | port->phy = phy->phy; | |
94 | ||
95 | SAS_DPRINTK("phy%d added to port%d, phy_mask:0x%x\n", phy->id, | |
96 | port->id, port->phy_mask); | |
97 | ||
98 | if (*(u64 *)port->attached_sas_addr == 0) { | |
99 | port->class = phy->class; | |
100 | memcpy(port->attached_sas_addr, phy->attached_sas_addr, | |
101 | SAS_ADDR_SIZE); | |
102 | port->iproto = phy->iproto; | |
103 | port->tproto = phy->tproto; | |
104 | port->oob_mode = phy->oob_mode; | |
105 | port->linkrate = phy->linkrate; | |
106 | } else | |
107 | port->linkrate = max(port->linkrate, phy->linkrate); | |
108 | spin_unlock(&port->phy_list_lock); | |
980fa2f9 | 109 | spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); |
2908d778 JB |
110 | |
111 | if (!port->port) { | |
112 | port->port = sas_port_alloc(phy->phy->dev.parent, port->id); | |
113 | BUG_ON(!port->port); | |
114 | sas_port_add(port->port); | |
115 | } | |
116 | sas_port_add_phy(port->port, phy->phy); | |
117 | ||
118 | if (port->port_dev) | |
119 | port->port_dev->pathways = port->num_phys; | |
120 | ||
121 | /* Tell the LLDD about this port formation. */ | |
122 | if (si->dft->lldd_port_formed) | |
123 | si->dft->lldd_port_formed(phy); | |
124 | ||
125 | sas_discover_event(phy->port, DISCE_DISCOVER_DOMAIN); | |
126 | } | |
127 | ||
128 | /** | |
129 | * sas_deform_port -- remove this phy from the port it belongs to | |
130 | * @phy: the phy of interest | |
131 | * | |
132 | * This is called when the physical link to the other phy has been | |
133 | * lost (on this phy), in Event thread context. We cannot delay here. | |
134 | */ | |
135 | void sas_deform_port(struct asd_sas_phy *phy) | |
136 | { | |
137 | struct sas_ha_struct *sas_ha = phy->ha; | |
138 | struct asd_sas_port *port = phy->port; | |
139 | struct sas_internal *si = | |
140 | to_sas_internal(sas_ha->core.shost->transportt); | |
980fa2f9 | 141 | unsigned long flags; |
2908d778 JB |
142 | |
143 | if (!port) | |
144 | return; /* done by a phy event */ | |
145 | ||
146 | if (port->port_dev) | |
147 | port->port_dev->pathways--; | |
148 | ||
149 | if (port->num_phys == 1) { | |
150 | sas_unregister_domain_devices(port); | |
151 | sas_port_delete(port->port); | |
152 | port->port = NULL; | |
153 | } else | |
154 | sas_port_delete_phy(port->port, phy->phy); | |
155 | ||
156 | ||
157 | if (si->dft->lldd_port_deformed) | |
158 | si->dft->lldd_port_deformed(phy); | |
159 | ||
980fa2f9 | 160 | spin_lock_irqsave(&sas_ha->phy_port_lock, flags); |
2908d778 JB |
161 | spin_lock(&port->phy_list_lock); |
162 | ||
163 | list_del_init(&phy->port_phy_el); | |
164 | phy->port = NULL; | |
165 | port->num_phys--; | |
166 | port->phy_mask &= ~(1U << phy->id); | |
167 | ||
168 | if (port->num_phys == 0) { | |
169 | INIT_LIST_HEAD(&port->phy_list); | |
170 | memset(port->sas_addr, 0, SAS_ADDR_SIZE); | |
171 | memset(port->attached_sas_addr, 0, SAS_ADDR_SIZE); | |
172 | port->class = 0; | |
173 | port->iproto = 0; | |
174 | port->tproto = 0; | |
175 | port->oob_mode = 0; | |
176 | port->phy_mask = 0; | |
177 | } | |
178 | spin_unlock(&port->phy_list_lock); | |
980fa2f9 | 179 | spin_unlock_irqrestore(&sas_ha->phy_port_lock, flags); |
2908d778 JB |
180 | |
181 | return; | |
182 | } | |
183 | ||
184 | /* ---------- SAS port events ---------- */ | |
185 | ||
c4028958 | 186 | void sas_porte_bytes_dmaed(struct work_struct *work) |
2908d778 | 187 | { |
c4028958 DH |
188 | struct asd_sas_event *ev = |
189 | container_of(work, struct asd_sas_event, work); | |
190 | struct asd_sas_phy *phy = ev->phy; | |
2908d778 JB |
191 | |
192 | sas_begin_event(PORTE_BYTES_DMAED, &phy->ha->event_lock, | |
193 | &phy->port_events_pending); | |
194 | ||
195 | sas_form_port(phy); | |
196 | } | |
197 | ||
c4028958 | 198 | void sas_porte_broadcast_rcvd(struct work_struct *work) |
2908d778 | 199 | { |
c4028958 DH |
200 | struct asd_sas_event *ev = |
201 | container_of(work, struct asd_sas_event, work); | |
202 | struct asd_sas_phy *phy = ev->phy; | |
2908d778 JB |
203 | unsigned long flags; |
204 | u32 prim; | |
2908d778 JB |
205 | |
206 | sas_begin_event(PORTE_BROADCAST_RCVD, &phy->ha->event_lock, | |
207 | &phy->port_events_pending); | |
208 | ||
209 | spin_lock_irqsave(&phy->sas_prim_lock, flags); | |
210 | prim = phy->sas_prim; | |
211 | spin_unlock_irqrestore(&phy->sas_prim_lock, flags); | |
212 | ||
213 | SAS_DPRINTK("broadcast received: %d\n", prim); | |
214 | sas_discover_event(phy->port, DISCE_REVALIDATE_DOMAIN); | |
215 | } | |
216 | ||
c4028958 | 217 | void sas_porte_link_reset_err(struct work_struct *work) |
2908d778 | 218 | { |
c4028958 DH |
219 | struct asd_sas_event *ev = |
220 | container_of(work, struct asd_sas_event, work); | |
221 | struct asd_sas_phy *phy = ev->phy; | |
2908d778 JB |
222 | |
223 | sas_begin_event(PORTE_LINK_RESET_ERR, &phy->ha->event_lock, | |
224 | &phy->port_events_pending); | |
225 | ||
226 | sas_deform_port(phy); | |
227 | } | |
228 | ||
c4028958 | 229 | void sas_porte_timer_event(struct work_struct *work) |
2908d778 | 230 | { |
c4028958 DH |
231 | struct asd_sas_event *ev = |
232 | container_of(work, struct asd_sas_event, work); | |
233 | struct asd_sas_phy *phy = ev->phy; | |
2908d778 JB |
234 | |
235 | sas_begin_event(PORTE_TIMER_EVENT, &phy->ha->event_lock, | |
236 | &phy->port_events_pending); | |
237 | ||
238 | sas_deform_port(phy); | |
239 | } | |
240 | ||
c4028958 | 241 | void sas_porte_hard_reset(struct work_struct *work) |
2908d778 | 242 | { |
c4028958 DH |
243 | struct asd_sas_event *ev = |
244 | container_of(work, struct asd_sas_event, work); | |
245 | struct asd_sas_phy *phy = ev->phy; | |
2908d778 JB |
246 | |
247 | sas_begin_event(PORTE_HARD_RESET, &phy->ha->event_lock, | |
248 | &phy->port_events_pending); | |
249 | ||
250 | sas_deform_port(phy); | |
251 | } | |
252 | ||
253 | /* ---------- SAS port registration ---------- */ | |
254 | ||
255 | static void sas_init_port(struct asd_sas_port *port, | |
256 | struct sas_ha_struct *sas_ha, int i) | |
257 | { | |
258 | port->id = i; | |
259 | INIT_LIST_HEAD(&port->dev_list); | |
260 | spin_lock_init(&port->phy_list_lock); | |
261 | INIT_LIST_HEAD(&port->phy_list); | |
262 | port->num_phys = 0; | |
263 | port->phy_mask = 0; | |
264 | port->ha = sas_ha; | |
265 | ||
266 | spin_lock_init(&port->dev_list_lock); | |
267 | } | |
268 | ||
269 | int sas_register_ports(struct sas_ha_struct *sas_ha) | |
270 | { | |
271 | int i; | |
272 | ||
273 | /* initialize the ports and discovery */ | |
274 | for (i = 0; i < sas_ha->num_phys; i++) { | |
275 | struct asd_sas_port *port = sas_ha->sas_port[i]; | |
276 | ||
277 | sas_init_port(port, sas_ha, i); | |
278 | sas_init_disc(&port->disc, port); | |
279 | } | |
280 | return 0; | |
281 | } | |
282 | ||
283 | void sas_unregister_ports(struct sas_ha_struct *sas_ha) | |
284 | { | |
285 | int i; | |
286 | ||
287 | for (i = 0; i < sas_ha->num_phys; i++) | |
288 | if (sas_ha->sas_phy[i]->port) | |
289 | sas_deform_port(sas_ha->sas_phy[i]); | |
290 | ||
291 | } |