Commit | Line | Data |
---|---|---|
6f231dda DW |
1 | /* |
2 | * This file is provided under a dual BSD/GPLv2 license. When using or | |
3 | * redistributing this file, you may do so under either license. | |
4 | * | |
5 | * GPL LICENSE SUMMARY | |
6 | * | |
7 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of version 2 of the GNU General Public License as | |
11 | * published by the Free Software Foundation. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | |
21 | * The full GNU General Public License is included in this distribution | |
22 | * in the file called LICENSE.GPL. | |
23 | * | |
24 | * BSD LICENSE | |
25 | * | |
26 | * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved. | |
27 | * All rights reserved. | |
28 | * | |
29 | * Redistribution and use in source and binary forms, with or without | |
30 | * modification, are permitted provided that the following conditions | |
31 | * are met: | |
32 | * | |
33 | * * Redistributions of source code must retain the above copyright | |
34 | * notice, this list of conditions and the following disclaimer. | |
35 | * * Redistributions in binary form must reproduce the above copyright | |
36 | * notice, this list of conditions and the following disclaimer in | |
37 | * the documentation and/or other materials provided with the | |
38 | * distribution. | |
39 | * * Neither the name of Intel Corporation nor the names of its | |
40 | * contributors may be used to endorse or promote products derived | |
41 | * from this software without specific prior written permission. | |
42 | * | |
43 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
44 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
45 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
46 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
47 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
48 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
49 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
50 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
51 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
52 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
53 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
54 | */ | |
ac668c69 | 55 | #include <linux/circ_buf.h> |
cc9203bf DW |
56 | #include <linux/device.h> |
57 | #include <scsi/sas.h> | |
58 | #include "host.h" | |
6f231dda | 59 | #include "isci.h" |
6f231dda | 60 | #include "port.h" |
d044af17 | 61 | #include "probe_roms.h" |
cc9203bf DW |
62 | #include "remote_device.h" |
63 | #include "request.h" | |
cc9203bf DW |
64 | #include "scu_completion_codes.h" |
65 | #include "scu_event_codes.h" | |
63a3a15f | 66 | #include "registers.h" |
cc9203bf DW |
67 | #include "scu_remote_node_context.h" |
68 | #include "scu_task_context.h" | |
6f231dda | 69 | |
cc9203bf DW |
70 | #define SCU_CONTEXT_RAM_INIT_STALL_TIME 200 |
71 | ||
7c78da31 | 72 | #define smu_max_ports(dcc_value) \ |
cc9203bf DW |
73 | (\ |
74 | (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_MASK) \ | |
75 | >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_LP_SHIFT) + 1 \ | |
76 | ) | |
77 | ||
7c78da31 | 78 | #define smu_max_task_contexts(dcc_value) \ |
cc9203bf DW |
79 | (\ |
80 | (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_MASK) \ | |
81 | >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_TC_SHIFT) + 1 \ | |
82 | ) | |
83 | ||
7c78da31 | 84 | #define smu_max_rncs(dcc_value) \ |
cc9203bf DW |
85 | (\ |
86 | (((dcc_value) & SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_MASK) \ | |
87 | >> SMU_DEVICE_CONTEXT_CAPACITY_MAX_RNC_SHIFT) + 1 \ | |
88 | ) | |
89 | ||
cc9203bf DW |
90 | #define SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT 100 |
91 | ||
44b7ca96 | 92 | /* |
cc9203bf DW |
93 | * The number of milliseconds to wait while a given phy is consuming power |
94 | * before allowing another set of phys to consume power. Ultimately, this will | |
95 | * be specified by OEM parameter. | |
96 | */ | |
97 | #define SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL 500 | |
98 | ||
44b7ca96 | 99 | /* |
cc9203bf DW |
100 | * NORMALIZE_PUT_POINTER() - |
101 | * | |
102 | * This macro will normalize the completion queue put pointer so its value can | |
103 | * be used as an array inde | |
104 | */ | |
105 | #define NORMALIZE_PUT_POINTER(x) \ | |
106 | ((x) & SMU_COMPLETION_QUEUE_PUT_POINTER_MASK) | |
107 | ||
108 | ||
44b7ca96 | 109 | /* |
cc9203bf DW |
110 | * NORMALIZE_EVENT_POINTER() - |
111 | * | |
112 | * This macro will normalize the completion queue event entry so its value can | |
113 | * be used as an index. | |
114 | */ | |
115 | #define NORMALIZE_EVENT_POINTER(x) \ | |
116 | (\ | |
117 | ((x) & SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_MASK) \ | |
118 | >> SMU_COMPLETION_QUEUE_GET_EVENT_POINTER_SHIFT \ | |
119 | ) | |
120 | ||
44b7ca96 | 121 | /* |
cc9203bf DW |
122 | * NORMALIZE_GET_POINTER() - |
123 | * | |
124 | * This macro will normalize the completion queue get pointer so its value can | |
125 | * be used as an index into an array | |
126 | */ | |
127 | #define NORMALIZE_GET_POINTER(x) \ | |
128 | ((x) & SMU_COMPLETION_QUEUE_GET_POINTER_MASK) | |
129 | ||
44b7ca96 | 130 | /* |
cc9203bf DW |
131 | * NORMALIZE_GET_POINTER_CYCLE_BIT() - |
132 | * | |
133 | * This macro will normalize the completion queue cycle pointer so it matches | |
134 | * the completion queue cycle bit | |
135 | */ | |
136 | #define NORMALIZE_GET_POINTER_CYCLE_BIT(x) \ | |
137 | ((SMU_CQGR_CYCLE_BIT & (x)) << (31 - SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT)) | |
138 | ||
44b7ca96 | 139 | /* |
cc9203bf DW |
140 | * COMPLETION_QUEUE_CYCLE_BIT() - |
141 | * | |
142 | * This macro will return the cycle bit of the completion queue entry | |
143 | */ | |
144 | #define COMPLETION_QUEUE_CYCLE_BIT(x) ((x) & 0x80000000) | |
145 | ||
12ef6544 EN |
146 | /* Init the state machine and call the state entry function (if any) */ |
147 | void sci_init_sm(struct sci_base_state_machine *sm, | |
148 | const struct sci_base_state *state_table, u32 initial_state) | |
149 | { | |
150 | sci_state_transition_t handler; | |
151 | ||
152 | sm->initial_state_id = initial_state; | |
153 | sm->previous_state_id = initial_state; | |
154 | sm->current_state_id = initial_state; | |
155 | sm->state_table = state_table; | |
156 | ||
157 | handler = sm->state_table[initial_state].enter_state; | |
158 | if (handler) | |
159 | handler(sm); | |
160 | } | |
161 | ||
162 | /* Call the state exit fn, update the current state, call the state entry fn */ | |
163 | void sci_change_state(struct sci_base_state_machine *sm, u32 next_state) | |
164 | { | |
165 | sci_state_transition_t handler; | |
166 | ||
167 | handler = sm->state_table[sm->current_state_id].exit_state; | |
168 | if (handler) | |
169 | handler(sm); | |
170 | ||
171 | sm->previous_state_id = sm->current_state_id; | |
172 | sm->current_state_id = next_state; | |
173 | ||
174 | handler = sm->state_table[sm->current_state_id].enter_state; | |
175 | if (handler) | |
176 | handler(sm); | |
177 | } | |
178 | ||
89a7301f | 179 | static bool sci_controller_completion_queue_has_entries(struct isci_host *ihost) |
cc9203bf | 180 | { |
d9dcb4ba | 181 | u32 get_value = ihost->completion_queue_get; |
cc9203bf DW |
182 | u32 get_index = get_value & SMU_COMPLETION_QUEUE_GET_POINTER_MASK; |
183 | ||
184 | if (NORMALIZE_GET_POINTER_CYCLE_BIT(get_value) == | |
d9dcb4ba | 185 | COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index])) |
cc9203bf DW |
186 | return true; |
187 | ||
188 | return false; | |
189 | } | |
190 | ||
89a7301f | 191 | static bool sci_controller_isr(struct isci_host *ihost) |
cc9203bf | 192 | { |
2396a265 | 193 | if (sci_controller_completion_queue_has_entries(ihost)) |
cc9203bf | 194 | return true; |
cc9203bf | 195 | |
2396a265 DW |
196 | /* we have a spurious interrupt it could be that we have already |
197 | * emptied the completion queue from a previous interrupt | |
198 | * FIXME: really!? | |
199 | */ | |
200 | writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status); | |
201 | ||
202 | /* There is a race in the hardware that could cause us not to be | |
203 | * notified of an interrupt completion if we do not take this | |
204 | * step. We will mask then unmask the interrupts so if there is | |
205 | * another interrupt pending the clearing of the interrupt | |
206 | * source we get the next interrupt message. | |
207 | */ | |
208 | spin_lock(&ihost->scic_lock); | |
209 | if (test_bit(IHOST_IRQ_ENABLED, &ihost->flags)) { | |
d9dcb4ba DW |
210 | writel(0xFF000000, &ihost->smu_registers->interrupt_mask); |
211 | writel(0, &ihost->smu_registers->interrupt_mask); | |
cc9203bf | 212 | } |
2396a265 | 213 | spin_unlock(&ihost->scic_lock); |
cc9203bf DW |
214 | |
215 | return false; | |
216 | } | |
217 | ||
c7ef4031 | 218 | irqreturn_t isci_msix_isr(int vec, void *data) |
6f231dda | 219 | { |
c7ef4031 | 220 | struct isci_host *ihost = data; |
c7ef4031 | 221 | |
89a7301f | 222 | if (sci_controller_isr(ihost)) |
0cf89d1d | 223 | tasklet_schedule(&ihost->completion_tasklet); |
6f231dda | 224 | |
c7ef4031 | 225 | return IRQ_HANDLED; |
6f231dda DW |
226 | } |
227 | ||
89a7301f | 228 | static bool sci_controller_error_isr(struct isci_host *ihost) |
cc9203bf DW |
229 | { |
230 | u32 interrupt_status; | |
231 | ||
232 | interrupt_status = | |
d9dcb4ba | 233 | readl(&ihost->smu_registers->interrupt_status); |
cc9203bf DW |
234 | interrupt_status &= (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND); |
235 | ||
236 | if (interrupt_status != 0) { | |
237 | /* | |
238 | * There is an error interrupt pending so let it through and handle | |
239 | * in the callback */ | |
240 | return true; | |
241 | } | |
242 | ||
243 | /* | |
244 | * There is a race in the hardware that could cause us not to be notified | |
245 | * of an interrupt completion if we do not take this step. We will mask | |
246 | * then unmask the error interrupts so if there was another interrupt | |
247 | * pending we will be notified. | |
248 | * Could we write the value of (SMU_ISR_QUEUE_ERROR | SMU_ISR_QUEUE_SUSPEND)? */ | |
d9dcb4ba DW |
249 | writel(0xff, &ihost->smu_registers->interrupt_mask); |
250 | writel(0, &ihost->smu_registers->interrupt_mask); | |
cc9203bf DW |
251 | |
252 | return false; | |
253 | } | |
254 | ||
89a7301f | 255 | static void sci_controller_task_completion(struct isci_host *ihost, u32 ent) |
cc9203bf | 256 | { |
89a7301f | 257 | u32 index = SCU_GET_COMPLETION_INDEX(ent); |
db056250 | 258 | struct isci_request *ireq = ihost->reqs[index]; |
cc9203bf DW |
259 | |
260 | /* Make sure that we really want to process this IO request */ | |
db056250 | 261 | if (test_bit(IREQ_ACTIVE, &ireq->flags) && |
5076a1a9 | 262 | ireq->io_tag != SCI_CONTROLLER_INVALID_IO_TAG && |
d9dcb4ba | 263 | ISCI_TAG_SEQ(ireq->io_tag) == ihost->io_request_sequence[index]) |
89a7301f DW |
264 | /* Yep this is a valid io request pass it along to the |
265 | * io request handler | |
266 | */ | |
267 | sci_io_request_tc_completion(ireq, ent); | |
cc9203bf DW |
268 | } |
269 | ||
89a7301f | 270 | static void sci_controller_sdma_completion(struct isci_host *ihost, u32 ent) |
cc9203bf DW |
271 | { |
272 | u32 index; | |
5076a1a9 | 273 | struct isci_request *ireq; |
78a6f06e | 274 | struct isci_remote_device *idev; |
cc9203bf | 275 | |
89a7301f | 276 | index = SCU_GET_COMPLETION_INDEX(ent); |
cc9203bf | 277 | |
89a7301f | 278 | switch (scu_get_command_request_type(ent)) { |
cc9203bf DW |
279 | case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_TC: |
280 | case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_TC: | |
d9dcb4ba DW |
281 | ireq = ihost->reqs[index]; |
282 | dev_warn(&ihost->pdev->dev, "%s: %x for io request %p\n", | |
89a7301f | 283 | __func__, ent, ireq); |
cc9203bf DW |
284 | /* @todo For a post TC operation we need to fail the IO |
285 | * request | |
286 | */ | |
287 | break; | |
cc9203bf DW |
288 | case SCU_CONTEXT_COMMAND_REQUEST_TYPE_DUMP_RNC: |
289 | case SCU_CONTEXT_COMMAND_REQUEST_TYPE_OTHER_RNC: | |
290 | case SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_RNC: | |
d9dcb4ba DW |
291 | idev = ihost->device_table[index]; |
292 | dev_warn(&ihost->pdev->dev, "%s: %x for device %p\n", | |
89a7301f | 293 | __func__, ent, idev); |
cc9203bf DW |
294 | /* @todo For a port RNC operation we need to fail the |
295 | * device | |
296 | */ | |
297 | break; | |
cc9203bf | 298 | default: |
d9dcb4ba | 299 | dev_warn(&ihost->pdev->dev, "%s: unknown completion type %x\n", |
89a7301f | 300 | __func__, ent); |
cc9203bf | 301 | break; |
cc9203bf DW |
302 | } |
303 | } | |
304 | ||
89a7301f | 305 | static void sci_controller_unsolicited_frame(struct isci_host *ihost, u32 ent) |
cc9203bf DW |
306 | { |
307 | u32 index; | |
308 | u32 frame_index; | |
309 | ||
cc9203bf | 310 | struct scu_unsolicited_frame_header *frame_header; |
85280955 | 311 | struct isci_phy *iphy; |
78a6f06e | 312 | struct isci_remote_device *idev; |
cc9203bf DW |
313 | |
314 | enum sci_status result = SCI_FAILURE; | |
315 | ||
89a7301f | 316 | frame_index = SCU_GET_FRAME_INDEX(ent); |
cc9203bf | 317 | |
d9dcb4ba DW |
318 | frame_header = ihost->uf_control.buffers.array[frame_index].header; |
319 | ihost->uf_control.buffers.array[frame_index].state = UNSOLICITED_FRAME_IN_USE; | |
cc9203bf | 320 | |
89a7301f | 321 | if (SCU_GET_FRAME_ERROR(ent)) { |
cc9203bf DW |
322 | /* |
323 | * / @todo If the IAF frame or SIGNATURE FIS frame has an error will | |
324 | * / this cause a problem? We expect the phy initialization will | |
325 | * / fail if there is an error in the frame. */ | |
89a7301f | 326 | sci_controller_release_frame(ihost, frame_index); |
cc9203bf DW |
327 | return; |
328 | } | |
329 | ||
330 | if (frame_header->is_address_frame) { | |
89a7301f | 331 | index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent); |
85280955 | 332 | iphy = &ihost->phys[index]; |
89a7301f | 333 | result = sci_phy_frame_handler(iphy, frame_index); |
cc9203bf DW |
334 | } else { |
335 | ||
89a7301f | 336 | index = SCU_GET_COMPLETION_INDEX(ent); |
cc9203bf DW |
337 | |
338 | if (index == SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) { | |
339 | /* | |
340 | * This is a signature fis or a frame from a direct attached SATA | |
341 | * device that has not yet been created. In either case forwared | |
342 | * the frame to the PE and let it take care of the frame data. */ | |
89a7301f | 343 | index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent); |
85280955 | 344 | iphy = &ihost->phys[index]; |
89a7301f | 345 | result = sci_phy_frame_handler(iphy, frame_index); |
cc9203bf | 346 | } else { |
d9dcb4ba DW |
347 | if (index < ihost->remote_node_entries) |
348 | idev = ihost->device_table[index]; | |
cc9203bf | 349 | else |
78a6f06e | 350 | idev = NULL; |
cc9203bf | 351 | |
78a6f06e | 352 | if (idev != NULL) |
89a7301f | 353 | result = sci_remote_device_frame_handler(idev, frame_index); |
cc9203bf | 354 | else |
89a7301f | 355 | sci_controller_release_frame(ihost, frame_index); |
cc9203bf DW |
356 | } |
357 | } | |
358 | ||
359 | if (result != SCI_SUCCESS) { | |
360 | /* | |
361 | * / @todo Is there any reason to report some additional error message | |
362 | * / when we get this failure notifiction? */ | |
363 | } | |
364 | } | |
365 | ||
89a7301f | 366 | static void sci_controller_event_completion(struct isci_host *ihost, u32 ent) |
cc9203bf | 367 | { |
78a6f06e | 368 | struct isci_remote_device *idev; |
5076a1a9 | 369 | struct isci_request *ireq; |
85280955 | 370 | struct isci_phy *iphy; |
cc9203bf DW |
371 | u32 index; |
372 | ||
89a7301f | 373 | index = SCU_GET_COMPLETION_INDEX(ent); |
cc9203bf | 374 | |
89a7301f | 375 | switch (scu_get_event_type(ent)) { |
cc9203bf DW |
376 | case SCU_EVENT_TYPE_SMU_COMMAND_ERROR: |
377 | /* / @todo The driver did something wrong and we need to fix the condtion. */ | |
d9dcb4ba | 378 | dev_err(&ihost->pdev->dev, |
cc9203bf DW |
379 | "%s: SCIC Controller 0x%p received SMU command error " |
380 | "0x%x\n", | |
381 | __func__, | |
d9dcb4ba | 382 | ihost, |
89a7301f | 383 | ent); |
cc9203bf DW |
384 | break; |
385 | ||
386 | case SCU_EVENT_TYPE_SMU_PCQ_ERROR: | |
387 | case SCU_EVENT_TYPE_SMU_ERROR: | |
388 | case SCU_EVENT_TYPE_FATAL_MEMORY_ERROR: | |
389 | /* | |
390 | * / @todo This is a hardware failure and its likely that we want to | |
391 | * / reset the controller. */ | |
d9dcb4ba | 392 | dev_err(&ihost->pdev->dev, |
cc9203bf DW |
393 | "%s: SCIC Controller 0x%p received fatal controller " |
394 | "event 0x%x\n", | |
395 | __func__, | |
d9dcb4ba | 396 | ihost, |
89a7301f | 397 | ent); |
cc9203bf DW |
398 | break; |
399 | ||
400 | case SCU_EVENT_TYPE_TRANSPORT_ERROR: | |
5076a1a9 | 401 | ireq = ihost->reqs[index]; |
89a7301f | 402 | sci_io_request_event_handler(ireq, ent); |
cc9203bf DW |
403 | break; |
404 | ||
405 | case SCU_EVENT_TYPE_PTX_SCHEDULE_EVENT: | |
89a7301f | 406 | switch (scu_get_event_specifier(ent)) { |
cc9203bf DW |
407 | case SCU_EVENT_SPECIFIC_SMP_RESPONSE_NO_PE: |
408 | case SCU_EVENT_SPECIFIC_TASK_TIMEOUT: | |
5076a1a9 DW |
409 | ireq = ihost->reqs[index]; |
410 | if (ireq != NULL) | |
89a7301f | 411 | sci_io_request_event_handler(ireq, ent); |
cc9203bf | 412 | else |
d9dcb4ba | 413 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
414 | "%s: SCIC Controller 0x%p received " |
415 | "event 0x%x for io request object " | |
fac952bb | 416 | "that doesn't exist.\n", |
cc9203bf | 417 | __func__, |
d9dcb4ba | 418 | ihost, |
89a7301f | 419 | ent); |
cc9203bf DW |
420 | |
421 | break; | |
422 | ||
423 | case SCU_EVENT_SPECIFIC_IT_NEXUS_TIMEOUT: | |
d9dcb4ba | 424 | idev = ihost->device_table[index]; |
78a6f06e | 425 | if (idev != NULL) |
89a7301f | 426 | sci_remote_device_event_handler(idev, ent); |
cc9203bf | 427 | else |
d9dcb4ba | 428 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
429 | "%s: SCIC Controller 0x%p received " |
430 | "event 0x%x for remote device object " | |
fac952bb | 431 | "that doesn't exist.\n", |
cc9203bf | 432 | __func__, |
d9dcb4ba | 433 | ihost, |
89a7301f | 434 | ent); |
cc9203bf DW |
435 | |
436 | break; | |
437 | } | |
438 | break; | |
439 | ||
440 | case SCU_EVENT_TYPE_BROADCAST_CHANGE: | |
441 | /* | |
442 | * direct the broadcast change event to the phy first and then let | |
443 | * the phy redirect the broadcast change to the port object */ | |
444 | case SCU_EVENT_TYPE_ERR_CNT_EVENT: | |
445 | /* | |
446 | * direct error counter event to the phy object since that is where | |
447 | * we get the event notification. This is a type 4 event. */ | |
448 | case SCU_EVENT_TYPE_OSSP_EVENT: | |
89a7301f | 449 | index = SCU_GET_PROTOCOL_ENGINE_INDEX(ent); |
85280955 | 450 | iphy = &ihost->phys[index]; |
89a7301f | 451 | sci_phy_event_handler(iphy, ent); |
cc9203bf DW |
452 | break; |
453 | ||
454 | case SCU_EVENT_TYPE_RNC_SUSPEND_TX: | |
455 | case SCU_EVENT_TYPE_RNC_SUSPEND_TX_RX: | |
456 | case SCU_EVENT_TYPE_RNC_OPS_MISC: | |
d9dcb4ba DW |
457 | if (index < ihost->remote_node_entries) { |
458 | idev = ihost->device_table[index]; | |
cc9203bf | 459 | |
78a6f06e | 460 | if (idev != NULL) |
89a7301f | 461 | sci_remote_device_event_handler(idev, ent); |
cc9203bf | 462 | } else |
d9dcb4ba | 463 | dev_err(&ihost->pdev->dev, |
cc9203bf | 464 | "%s: SCIC Controller 0x%p received event 0x%x " |
fac952bb | 465 | "for remote device object 0x%0x that doesn't " |
cc9203bf DW |
466 | "exist.\n", |
467 | __func__, | |
d9dcb4ba | 468 | ihost, |
89a7301f | 469 | ent, |
cc9203bf DW |
470 | index); |
471 | ||
472 | break; | |
473 | ||
474 | default: | |
d9dcb4ba | 475 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
476 | "%s: SCIC Controller received unknown event code %x\n", |
477 | __func__, | |
89a7301f | 478 | ent); |
cc9203bf DW |
479 | break; |
480 | } | |
481 | } | |
482 | ||
89a7301f | 483 | static void sci_controller_process_completions(struct isci_host *ihost) |
cc9203bf DW |
484 | { |
485 | u32 completion_count = 0; | |
89a7301f | 486 | u32 ent; |
cc9203bf DW |
487 | u32 get_index; |
488 | u32 get_cycle; | |
994a9303 | 489 | u32 event_get; |
cc9203bf DW |
490 | u32 event_cycle; |
491 | ||
d9dcb4ba | 492 | dev_dbg(&ihost->pdev->dev, |
59e13d48 | 493 | "%s: completion queue beginning get:0x%08x\n", |
cc9203bf | 494 | __func__, |
d9dcb4ba | 495 | ihost->completion_queue_get); |
cc9203bf DW |
496 | |
497 | /* Get the component parts of the completion queue */ | |
d9dcb4ba DW |
498 | get_index = NORMALIZE_GET_POINTER(ihost->completion_queue_get); |
499 | get_cycle = SMU_CQGR_CYCLE_BIT & ihost->completion_queue_get; | |
cc9203bf | 500 | |
d9dcb4ba DW |
501 | event_get = NORMALIZE_EVENT_POINTER(ihost->completion_queue_get); |
502 | event_cycle = SMU_CQGR_EVENT_CYCLE_BIT & ihost->completion_queue_get; | |
cc9203bf DW |
503 | |
504 | while ( | |
505 | NORMALIZE_GET_POINTER_CYCLE_BIT(get_cycle) | |
d9dcb4ba | 506 | == COMPLETION_QUEUE_CYCLE_BIT(ihost->completion_queue[get_index]) |
cc9203bf DW |
507 | ) { |
508 | completion_count++; | |
509 | ||
89a7301f | 510 | ent = ihost->completion_queue[get_index]; |
994a9303 DW |
511 | |
512 | /* increment the get pointer and check for rollover to toggle the cycle bit */ | |
513 | get_cycle ^= ((get_index+1) & SCU_MAX_COMPLETION_QUEUE_ENTRIES) << | |
514 | (SMU_COMPLETION_QUEUE_GET_CYCLE_BIT_SHIFT - SCU_MAX_COMPLETION_QUEUE_SHIFT); | |
515 | get_index = (get_index+1) & (SCU_MAX_COMPLETION_QUEUE_ENTRIES-1); | |
cc9203bf | 516 | |
d9dcb4ba | 517 | dev_dbg(&ihost->pdev->dev, |
cc9203bf DW |
518 | "%s: completion queue entry:0x%08x\n", |
519 | __func__, | |
89a7301f | 520 | ent); |
cc9203bf | 521 | |
89a7301f | 522 | switch (SCU_GET_COMPLETION_TYPE(ent)) { |
cc9203bf | 523 | case SCU_COMPLETION_TYPE_TASK: |
89a7301f | 524 | sci_controller_task_completion(ihost, ent); |
cc9203bf DW |
525 | break; |
526 | ||
527 | case SCU_COMPLETION_TYPE_SDMA: | |
89a7301f | 528 | sci_controller_sdma_completion(ihost, ent); |
cc9203bf DW |
529 | break; |
530 | ||
531 | case SCU_COMPLETION_TYPE_UFI: | |
89a7301f | 532 | sci_controller_unsolicited_frame(ihost, ent); |
cc9203bf DW |
533 | break; |
534 | ||
535 | case SCU_COMPLETION_TYPE_EVENT: | |
77cd72a5 DW |
536 | sci_controller_event_completion(ihost, ent); |
537 | break; | |
538 | ||
994a9303 DW |
539 | case SCU_COMPLETION_TYPE_NOTIFY: { |
540 | event_cycle ^= ((event_get+1) & SCU_MAX_EVENTS) << | |
541 | (SMU_COMPLETION_QUEUE_GET_EVENT_CYCLE_BIT_SHIFT - SCU_MAX_EVENTS_SHIFT); | |
542 | event_get = (event_get+1) & (SCU_MAX_EVENTS-1); | |
cc9203bf | 543 | |
89a7301f | 544 | sci_controller_event_completion(ihost, ent); |
cc9203bf | 545 | break; |
994a9303 | 546 | } |
cc9203bf | 547 | default: |
d9dcb4ba | 548 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
549 | "%s: SCIC Controller received unknown " |
550 | "completion type %x\n", | |
551 | __func__, | |
89a7301f | 552 | ent); |
cc9203bf DW |
553 | break; |
554 | } | |
555 | } | |
556 | ||
557 | /* Update the get register if we completed one or more entries */ | |
558 | if (completion_count > 0) { | |
d9dcb4ba | 559 | ihost->completion_queue_get = |
cc9203bf DW |
560 | SMU_CQGR_GEN_BIT(ENABLE) | |
561 | SMU_CQGR_GEN_BIT(EVENT_ENABLE) | | |
562 | event_cycle | | |
994a9303 | 563 | SMU_CQGR_GEN_VAL(EVENT_POINTER, event_get) | |
cc9203bf DW |
564 | get_cycle | |
565 | SMU_CQGR_GEN_VAL(POINTER, get_index); | |
566 | ||
d9dcb4ba DW |
567 | writel(ihost->completion_queue_get, |
568 | &ihost->smu_registers->completion_queue_get); | |
cc9203bf DW |
569 | |
570 | } | |
571 | ||
d9dcb4ba | 572 | dev_dbg(&ihost->pdev->dev, |
cc9203bf DW |
573 | "%s: completion queue ending get:0x%08x\n", |
574 | __func__, | |
d9dcb4ba | 575 | ihost->completion_queue_get); |
cc9203bf DW |
576 | |
577 | } | |
578 | ||
89a7301f | 579 | static void sci_controller_error_handler(struct isci_host *ihost) |
cc9203bf DW |
580 | { |
581 | u32 interrupt_status; | |
582 | ||
583 | interrupt_status = | |
d9dcb4ba | 584 | readl(&ihost->smu_registers->interrupt_status); |
cc9203bf DW |
585 | |
586 | if ((interrupt_status & SMU_ISR_QUEUE_SUSPEND) && | |
89a7301f | 587 | sci_controller_completion_queue_has_entries(ihost)) { |
cc9203bf | 588 | |
89a7301f | 589 | sci_controller_process_completions(ihost); |
d9dcb4ba | 590 | writel(SMU_ISR_QUEUE_SUSPEND, &ihost->smu_registers->interrupt_status); |
cc9203bf | 591 | } else { |
d9dcb4ba | 592 | dev_err(&ihost->pdev->dev, "%s: status: %#x\n", __func__, |
cc9203bf DW |
593 | interrupt_status); |
594 | ||
d9dcb4ba | 595 | sci_change_state(&ihost->sm, SCIC_FAILED); |
cc9203bf DW |
596 | |
597 | return; | |
598 | } | |
599 | ||
600 | /* If we dont process any completions I am not sure that we want to do this. | |
601 | * We are in the middle of a hardware fault and should probably be reset. | |
602 | */ | |
d9dcb4ba | 603 | writel(0, &ihost->smu_registers->interrupt_mask); |
cc9203bf DW |
604 | } |
605 | ||
c7ef4031 | 606 | irqreturn_t isci_intx_isr(int vec, void *data) |
6f231dda | 607 | { |
6f231dda | 608 | irqreturn_t ret = IRQ_NONE; |
31e824ed | 609 | struct isci_host *ihost = data; |
c7ef4031 | 610 | |
89a7301f | 611 | if (sci_controller_isr(ihost)) { |
d9dcb4ba | 612 | writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status); |
31e824ed DW |
613 | tasklet_schedule(&ihost->completion_tasklet); |
614 | ret = IRQ_HANDLED; | |
89a7301f | 615 | } else if (sci_controller_error_isr(ihost)) { |
31e824ed | 616 | spin_lock(&ihost->scic_lock); |
89a7301f | 617 | sci_controller_error_handler(ihost); |
31e824ed DW |
618 | spin_unlock(&ihost->scic_lock); |
619 | ret = IRQ_HANDLED; | |
6f231dda | 620 | } |
92f4f0f5 | 621 | |
6f231dda DW |
622 | return ret; |
623 | } | |
624 | ||
92f4f0f5 DW |
625 | irqreturn_t isci_error_isr(int vec, void *data) |
626 | { | |
627 | struct isci_host *ihost = data; | |
92f4f0f5 | 628 | |
89a7301f DW |
629 | if (sci_controller_error_isr(ihost)) |
630 | sci_controller_error_handler(ihost); | |
92f4f0f5 DW |
631 | |
632 | return IRQ_HANDLED; | |
633 | } | |
6f231dda DW |
634 | |
635 | /** | |
636 | * isci_host_start_complete() - This function is called by the core library, | |
637 | * through the ISCI Module, to indicate controller start status. | |
44b7ca96 | 638 | * @ihost: This parameter specifies the ISCI host object |
6f231dda DW |
639 | * @completion_status: This parameter specifies the completion status from the |
640 | * core library. | |
641 | * | |
642 | */ | |
cc9203bf | 643 | static void isci_host_start_complete(struct isci_host *ihost, enum sci_status completion_status) |
6f231dda | 644 | { |
0cf89d1d DW |
645 | if (completion_status != SCI_SUCCESS) |
646 | dev_info(&ihost->pdev->dev, | |
647 | "controller start timed out, continuing...\n"); | |
0cf89d1d DW |
648 | clear_bit(IHOST_START_PENDING, &ihost->flags); |
649 | wake_up(&ihost->eventq); | |
6f231dda DW |
650 | } |
651 | ||
c7ef4031 | 652 | int isci_host_scan_finished(struct Scsi_Host *shost, unsigned long time) |
6f231dda | 653 | { |
b1124cd3 DW |
654 | struct sas_ha_struct *ha = SHOST_TO_SAS_HA(shost); |
655 | struct isci_host *ihost = ha->lldd_ha; | |
6f231dda | 656 | |
77950f51 | 657 | if (test_bit(IHOST_START_PENDING, &ihost->flags)) |
6f231dda | 658 | return 0; |
6f231dda | 659 | |
b1124cd3 | 660 | sas_drain_work(ha); |
6f231dda | 661 | |
6f231dda | 662 | return 1; |
6f231dda DW |
663 | } |
664 | ||
cc9203bf | 665 | /** |
89a7301f DW |
666 | * sci_controller_get_suggested_start_timeout() - This method returns the |
667 | * suggested sci_controller_start() timeout amount. The user is free to | |
cc9203bf DW |
668 | * use any timeout value, but this method provides the suggested minimum |
669 | * start timeout value. The returned value is based upon empirical | |
670 | * information determined as a result of interoperability testing. | |
44b7ca96 | 671 | * @ihost: the handle to the controller object for which to return the |
cc9203bf DW |
672 | * suggested start timeout. |
673 | * | |
674 | * This method returns the number of milliseconds for the suggested start | |
675 | * operation timeout. | |
676 | */ | |
89a7301f | 677 | static u32 sci_controller_get_suggested_start_timeout(struct isci_host *ihost) |
cc9203bf DW |
678 | { |
679 | /* Validate the user supplied parameters. */ | |
d9dcb4ba | 680 | if (!ihost) |
cc9203bf DW |
681 | return 0; |
682 | ||
683 | /* | |
684 | * The suggested minimum timeout value for a controller start operation: | |
685 | * | |
686 | * Signature FIS Timeout | |
687 | * + Phy Start Timeout | |
688 | * + Number of Phy Spin Up Intervals | |
689 | * --------------------------------- | |
690 | * Number of milliseconds for the controller start operation. | |
691 | * | |
692 | * NOTE: The number of phy spin up intervals will be equivalent | |
693 | * to the number of phys divided by the number phys allowed | |
694 | * per interval - 1 (once OEM parameters are supported). | |
695 | * Currently we assume only 1 phy per interval. */ | |
696 | ||
697 | return SCIC_SDS_SIGNATURE_FIS_TIMEOUT | |
698 | + SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT | |
699 | + ((SCI_MAX_PHYS - 1) * SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL); | |
700 | } | |
701 | ||
89a7301f | 702 | static void sci_controller_enable_interrupts(struct isci_host *ihost) |
cc9203bf | 703 | { |
2396a265 | 704 | set_bit(IHOST_IRQ_ENABLED, &ihost->flags); |
d9dcb4ba | 705 | writel(0, &ihost->smu_registers->interrupt_mask); |
cc9203bf DW |
706 | } |
707 | ||
89a7301f | 708 | void sci_controller_disable_interrupts(struct isci_host *ihost) |
cc9203bf | 709 | { |
2396a265 | 710 | clear_bit(IHOST_IRQ_ENABLED, &ihost->flags); |
d9dcb4ba | 711 | writel(0xffffffff, &ihost->smu_registers->interrupt_mask); |
2396a265 | 712 | readl(&ihost->smu_registers->interrupt_mask); /* flush */ |
cc9203bf DW |
713 | } |
714 | ||
89a7301f | 715 | static void sci_controller_enable_port_task_scheduler(struct isci_host *ihost) |
cc9203bf DW |
716 | { |
717 | u32 port_task_scheduler_value; | |
718 | ||
719 | port_task_scheduler_value = | |
d9dcb4ba | 720 | readl(&ihost->scu_registers->peg0.ptsg.control); |
cc9203bf DW |
721 | port_task_scheduler_value |= |
722 | (SCU_PTSGCR_GEN_BIT(ETM_ENABLE) | | |
723 | SCU_PTSGCR_GEN_BIT(PTSG_ENABLE)); | |
724 | writel(port_task_scheduler_value, | |
d9dcb4ba | 725 | &ihost->scu_registers->peg0.ptsg.control); |
cc9203bf DW |
726 | } |
727 | ||
89a7301f | 728 | static void sci_controller_assign_task_entries(struct isci_host *ihost) |
cc9203bf DW |
729 | { |
730 | u32 task_assignment; | |
731 | ||
732 | /* | |
733 | * Assign all the TCs to function 0 | |
734 | * TODO: Do we actually need to read this register to write it back? | |
735 | */ | |
736 | ||
737 | task_assignment = | |
d9dcb4ba | 738 | readl(&ihost->smu_registers->task_context_assignment[0]); |
cc9203bf DW |
739 | |
740 | task_assignment |= (SMU_TCA_GEN_VAL(STARTING, 0)) | | |
d9dcb4ba | 741 | (SMU_TCA_GEN_VAL(ENDING, ihost->task_context_entries - 1)) | |
cc9203bf DW |
742 | (SMU_TCA_GEN_BIT(RANGE_CHECK_ENABLE)); |
743 | ||
744 | writel(task_assignment, | |
d9dcb4ba | 745 | &ihost->smu_registers->task_context_assignment[0]); |
cc9203bf DW |
746 | |
747 | } | |
748 | ||
89a7301f | 749 | static void sci_controller_initialize_completion_queue(struct isci_host *ihost) |
cc9203bf DW |
750 | { |
751 | u32 index; | |
752 | u32 completion_queue_control_value; | |
753 | u32 completion_queue_get_value; | |
754 | u32 completion_queue_put_value; | |
755 | ||
d9dcb4ba | 756 | ihost->completion_queue_get = 0; |
cc9203bf | 757 | |
7c78da31 DW |
758 | completion_queue_control_value = |
759 | (SMU_CQC_QUEUE_LIMIT_SET(SCU_MAX_COMPLETION_QUEUE_ENTRIES - 1) | | |
760 | SMU_CQC_EVENT_LIMIT_SET(SCU_MAX_EVENTS - 1)); | |
cc9203bf DW |
761 | |
762 | writel(completion_queue_control_value, | |
d9dcb4ba | 763 | &ihost->smu_registers->completion_queue_control); |
cc9203bf DW |
764 | |
765 | ||
766 | /* Set the completion queue get pointer and enable the queue */ | |
767 | completion_queue_get_value = ( | |
768 | (SMU_CQGR_GEN_VAL(POINTER, 0)) | |
769 | | (SMU_CQGR_GEN_VAL(EVENT_POINTER, 0)) | |
770 | | (SMU_CQGR_GEN_BIT(ENABLE)) | |
771 | | (SMU_CQGR_GEN_BIT(EVENT_ENABLE)) | |
772 | ); | |
773 | ||
774 | writel(completion_queue_get_value, | |
d9dcb4ba | 775 | &ihost->smu_registers->completion_queue_get); |
cc9203bf DW |
776 | |
777 | /* Set the completion queue put pointer */ | |
778 | completion_queue_put_value = ( | |
779 | (SMU_CQPR_GEN_VAL(POINTER, 0)) | |
780 | | (SMU_CQPR_GEN_VAL(EVENT_POINTER, 0)) | |
781 | ); | |
782 | ||
783 | writel(completion_queue_put_value, | |
d9dcb4ba | 784 | &ihost->smu_registers->completion_queue_put); |
cc9203bf DW |
785 | |
786 | /* Initialize the cycle bit of the completion queue entries */ | |
7c78da31 | 787 | for (index = 0; index < SCU_MAX_COMPLETION_QUEUE_ENTRIES; index++) { |
cc9203bf DW |
788 | /* |
789 | * If get.cycle_bit != completion_queue.cycle_bit | |
790 | * its not a valid completion queue entry | |
791 | * so at system start all entries are invalid */ | |
d9dcb4ba | 792 | ihost->completion_queue[index] = 0x80000000; |
cc9203bf DW |
793 | } |
794 | } | |
795 | ||
89a7301f | 796 | static void sci_controller_initialize_unsolicited_frame_queue(struct isci_host *ihost) |
cc9203bf DW |
797 | { |
798 | u32 frame_queue_control_value; | |
799 | u32 frame_queue_get_value; | |
800 | u32 frame_queue_put_value; | |
801 | ||
802 | /* Write the queue size */ | |
803 | frame_queue_control_value = | |
7c78da31 | 804 | SCU_UFQC_GEN_VAL(QUEUE_SIZE, SCU_MAX_UNSOLICITED_FRAMES); |
cc9203bf DW |
805 | |
806 | writel(frame_queue_control_value, | |
d9dcb4ba | 807 | &ihost->scu_registers->sdma.unsolicited_frame_queue_control); |
cc9203bf DW |
808 | |
809 | /* Setup the get pointer for the unsolicited frame queue */ | |
810 | frame_queue_get_value = ( | |
811 | SCU_UFQGP_GEN_VAL(POINTER, 0) | |
812 | | SCU_UFQGP_GEN_BIT(ENABLE_BIT) | |
813 | ); | |
814 | ||
815 | writel(frame_queue_get_value, | |
d9dcb4ba | 816 | &ihost->scu_registers->sdma.unsolicited_frame_get_pointer); |
cc9203bf DW |
817 | /* Setup the put pointer for the unsolicited frame queue */ |
818 | frame_queue_put_value = SCU_UFQPP_GEN_VAL(POINTER, 0); | |
819 | writel(frame_queue_put_value, | |
d9dcb4ba | 820 | &ihost->scu_registers->sdma.unsolicited_frame_put_pointer); |
cc9203bf DW |
821 | } |
822 | ||
50a92d93 | 823 | void sci_controller_transition_to_ready(struct isci_host *ihost, enum sci_status status) |
cc9203bf | 824 | { |
d9dcb4ba | 825 | if (ihost->sm.current_state_id == SCIC_STARTING) { |
cc9203bf DW |
826 | /* |
827 | * We move into the ready state, because some of the phys/ports | |
828 | * may be up and operational. | |
829 | */ | |
d9dcb4ba | 830 | sci_change_state(&ihost->sm, SCIC_READY); |
cc9203bf DW |
831 | |
832 | isci_host_start_complete(ihost, status); | |
833 | } | |
834 | } | |
835 | ||
85280955 | 836 | static bool is_phy_starting(struct isci_phy *iphy) |
4a33c525 | 837 | { |
89a7301f | 838 | enum sci_phy_states state; |
4a33c525 | 839 | |
85280955 | 840 | state = iphy->sm.current_state_id; |
4a33c525 | 841 | switch (state) { |
e301370a EN |
842 | case SCI_PHY_STARTING: |
843 | case SCI_PHY_SUB_INITIAL: | |
844 | case SCI_PHY_SUB_AWAIT_SAS_SPEED_EN: | |
845 | case SCI_PHY_SUB_AWAIT_IAF_UF: | |
846 | case SCI_PHY_SUB_AWAIT_SAS_POWER: | |
847 | case SCI_PHY_SUB_AWAIT_SATA_POWER: | |
848 | case SCI_PHY_SUB_AWAIT_SATA_PHY_EN: | |
849 | case SCI_PHY_SUB_AWAIT_SATA_SPEED_EN: | |
50a92d93 | 850 | case SCI_PHY_SUB_AWAIT_OSSP_EN: |
e301370a EN |
851 | case SCI_PHY_SUB_AWAIT_SIG_FIS_UF: |
852 | case SCI_PHY_SUB_FINAL: | |
4a33c525 AG |
853 | return true; |
854 | default: | |
855 | return false; | |
856 | } | |
857 | } | |
858 | ||
50a92d93 DW |
859 | bool is_controller_start_complete(struct isci_host *ihost) |
860 | { | |
861 | int i; | |
862 | ||
863 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
864 | struct isci_phy *iphy = &ihost->phys[i]; | |
865 | u32 state = iphy->sm.current_state_id; | |
866 | ||
867 | /* in apc mode we need to check every phy, in | |
868 | * mpc mode we only need to check phys that have | |
869 | * been configured into a port | |
870 | */ | |
871 | if (is_port_config_apc(ihost)) | |
872 | /* pass */; | |
873 | else if (!phy_get_non_dummy_port(iphy)) | |
874 | continue; | |
875 | ||
876 | /* The controller start operation is complete iff: | |
877 | * - all links have been given an opportunity to start | |
878 | * - have no indication of a connected device | |
879 | * - have an indication of a connected device and it has | |
880 | * finished the link training process. | |
881 | */ | |
882 | if ((iphy->is_in_link_training == false && state == SCI_PHY_INITIAL) || | |
883 | (iphy->is_in_link_training == false && state == SCI_PHY_STOPPED) || | |
884 | (iphy->is_in_link_training == true && is_phy_starting(iphy)) || | |
885 | (ihost->port_agent.phy_ready_mask != ihost->port_agent.phy_configured_mask)) | |
886 | return false; | |
887 | } | |
888 | ||
889 | return true; | |
890 | } | |
891 | ||
cc9203bf | 892 | /** |
89a7301f | 893 | * sci_controller_start_next_phy - start phy |
44b7ca96 | 894 | * @ihost: controller |
cc9203bf DW |
895 | * |
896 | * If all the phys have been started, then attempt to transition the | |
897 | * controller to the READY state and inform the user | |
89a7301f | 898 | * (sci_cb_controller_start_complete()). |
cc9203bf | 899 | */ |
89a7301f | 900 | static enum sci_status sci_controller_start_next_phy(struct isci_host *ihost) |
cc9203bf | 901 | { |
89a7301f | 902 | struct sci_oem_params *oem = &ihost->oem_parameters; |
85280955 | 903 | struct isci_phy *iphy; |
cc9203bf DW |
904 | enum sci_status status; |
905 | ||
906 | status = SCI_SUCCESS; | |
907 | ||
d9dcb4ba | 908 | if (ihost->phy_startup_timer_pending) |
cc9203bf DW |
909 | return status; |
910 | ||
d9dcb4ba | 911 | if (ihost->next_phy_to_start >= SCI_MAX_PHYS) { |
50a92d93 | 912 | if (is_controller_start_complete(ihost)) { |
89a7301f | 913 | sci_controller_transition_to_ready(ihost, SCI_SUCCESS); |
d9dcb4ba DW |
914 | sci_del_timer(&ihost->phy_timer); |
915 | ihost->phy_startup_timer_pending = false; | |
cc9203bf DW |
916 | } |
917 | } else { | |
d9dcb4ba | 918 | iphy = &ihost->phys[ihost->next_phy_to_start]; |
cc9203bf DW |
919 | |
920 | if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) { | |
85280955 | 921 | if (phy_get_non_dummy_port(iphy) == NULL) { |
d9dcb4ba | 922 | ihost->next_phy_to_start++; |
cc9203bf DW |
923 | |
924 | /* Caution recursion ahead be forwarned | |
925 | * | |
926 | * The PHY was never added to a PORT in MPC mode | |
927 | * so start the next phy in sequence This phy | |
928 | * will never go link up and will not draw power | |
929 | * the OEM parameters either configured the phy | |
930 | * incorrectly for the PORT or it was never | |
931 | * assigned to a PORT | |
932 | */ | |
89a7301f | 933 | return sci_controller_start_next_phy(ihost); |
cc9203bf DW |
934 | } |
935 | } | |
936 | ||
89a7301f | 937 | status = sci_phy_start(iphy); |
cc9203bf DW |
938 | |
939 | if (status == SCI_SUCCESS) { | |
d9dcb4ba | 940 | sci_mod_timer(&ihost->phy_timer, |
bb3dbdf6 | 941 | SCIC_SDS_CONTROLLER_PHY_START_TIMEOUT); |
d9dcb4ba | 942 | ihost->phy_startup_timer_pending = true; |
cc9203bf | 943 | } else { |
d9dcb4ba | 944 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
945 | "%s: Controller stop operation failed " |
946 | "to stop phy %d because of status " | |
947 | "%d.\n", | |
948 | __func__, | |
d9dcb4ba | 949 | ihost->phys[ihost->next_phy_to_start].phy_index, |
cc9203bf DW |
950 | status); |
951 | } | |
952 | ||
d9dcb4ba | 953 | ihost->next_phy_to_start++; |
cc9203bf DW |
954 | } |
955 | ||
956 | return status; | |
957 | } | |
958 | ||
b0a2dc66 | 959 | static void phy_startup_timeout(struct timer_list *t) |
cc9203bf | 960 | { |
b0a2dc66 | 961 | struct sci_timer *tmr = from_timer(tmr, t, timer); |
d9dcb4ba | 962 | struct isci_host *ihost = container_of(tmr, typeof(*ihost), phy_timer); |
bb3dbdf6 | 963 | unsigned long flags; |
cc9203bf DW |
964 | enum sci_status status; |
965 | ||
bb3dbdf6 EN |
966 | spin_lock_irqsave(&ihost->scic_lock, flags); |
967 | ||
968 | if (tmr->cancel) | |
969 | goto done; | |
970 | ||
d9dcb4ba | 971 | ihost->phy_startup_timer_pending = false; |
bb3dbdf6 EN |
972 | |
973 | do { | |
89a7301f | 974 | status = sci_controller_start_next_phy(ihost); |
bb3dbdf6 EN |
975 | } while (status != SCI_SUCCESS); |
976 | ||
977 | done: | |
978 | spin_unlock_irqrestore(&ihost->scic_lock, flags); | |
cc9203bf DW |
979 | } |
980 | ||
ac668c69 DW |
981 | static u16 isci_tci_active(struct isci_host *ihost) |
982 | { | |
983 | return CIRC_CNT(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS); | |
984 | } | |
985 | ||
89a7301f | 986 | static enum sci_status sci_controller_start(struct isci_host *ihost, |
cc9203bf DW |
987 | u32 timeout) |
988 | { | |
cc9203bf DW |
989 | enum sci_status result; |
990 | u16 index; | |
991 | ||
d9dcb4ba | 992 | if (ihost->sm.current_state_id != SCIC_INITIALIZED) { |
14e99b4a DW |
993 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
994 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
995 | return SCI_FAILURE_INVALID_STATE; |
996 | } | |
997 | ||
998 | /* Build the TCi free pool */ | |
ac668c69 DW |
999 | BUILD_BUG_ON(SCI_MAX_IO_REQUESTS > 1 << sizeof(ihost->tci_pool[0]) * 8); |
1000 | ihost->tci_head = 0; | |
1001 | ihost->tci_tail = 0; | |
d9dcb4ba | 1002 | for (index = 0; index < ihost->task_context_entries; index++) |
ac668c69 | 1003 | isci_tci_free(ihost, index); |
cc9203bf DW |
1004 | |
1005 | /* Build the RNi free pool */ | |
89a7301f DW |
1006 | sci_remote_node_table_initialize(&ihost->available_remote_nodes, |
1007 | ihost->remote_node_entries); | |
cc9203bf DW |
1008 | |
1009 | /* | |
1010 | * Before anything else lets make sure we will not be | |
1011 | * interrupted by the hardware. | |
1012 | */ | |
89a7301f | 1013 | sci_controller_disable_interrupts(ihost); |
cc9203bf DW |
1014 | |
1015 | /* Enable the port task scheduler */ | |
89a7301f | 1016 | sci_controller_enable_port_task_scheduler(ihost); |
cc9203bf | 1017 | |
d9dcb4ba | 1018 | /* Assign all the task entries to ihost physical function */ |
89a7301f | 1019 | sci_controller_assign_task_entries(ihost); |
cc9203bf DW |
1020 | |
1021 | /* Now initialize the completion queue */ | |
89a7301f | 1022 | sci_controller_initialize_completion_queue(ihost); |
cc9203bf DW |
1023 | |
1024 | /* Initialize the unsolicited frame queue for use */ | |
89a7301f | 1025 | sci_controller_initialize_unsolicited_frame_queue(ihost); |
cc9203bf DW |
1026 | |
1027 | /* Start all of the ports on this controller */ | |
d9dcb4ba | 1028 | for (index = 0; index < ihost->logical_port_entries; index++) { |
ffe191c9 | 1029 | struct isci_port *iport = &ihost->ports[index]; |
cc9203bf | 1030 | |
89a7301f | 1031 | result = sci_port_start(iport); |
cc9203bf DW |
1032 | if (result) |
1033 | return result; | |
1034 | } | |
1035 | ||
89a7301f | 1036 | sci_controller_start_next_phy(ihost); |
cc9203bf | 1037 | |
d9dcb4ba | 1038 | sci_mod_timer(&ihost->timer, timeout); |
cc9203bf | 1039 | |
d9dcb4ba | 1040 | sci_change_state(&ihost->sm, SCIC_STARTING); |
cc9203bf DW |
1041 | |
1042 | return SCI_SUCCESS; | |
1043 | } | |
1044 | ||
e468dc11 | 1045 | void isci_host_start(struct Scsi_Host *shost) |
6f231dda | 1046 | { |
4393aa4e | 1047 | struct isci_host *ihost = SHOST_TO_SAS_HA(shost)->lldd_ha; |
89a7301f | 1048 | unsigned long tmo = sci_controller_get_suggested_start_timeout(ihost); |
6f231dda | 1049 | |
0cf89d1d | 1050 | set_bit(IHOST_START_PENDING, &ihost->flags); |
77950f51 EN |
1051 | |
1052 | spin_lock_irq(&ihost->scic_lock); | |
89a7301f DW |
1053 | sci_controller_start(ihost, tmo); |
1054 | sci_controller_enable_interrupts(ihost); | |
77950f51 | 1055 | spin_unlock_irq(&ihost->scic_lock); |
6f231dda DW |
1056 | } |
1057 | ||
eb608c3c | 1058 | static void isci_host_stop_complete(struct isci_host *ihost) |
6f231dda | 1059 | { |
89a7301f | 1060 | sci_controller_disable_interrupts(ihost); |
0cf89d1d DW |
1061 | clear_bit(IHOST_STOP_PENDING, &ihost->flags); |
1062 | wake_up(&ihost->eventq); | |
6f231dda DW |
1063 | } |
1064 | ||
89a7301f | 1065 | static void sci_controller_completion_handler(struct isci_host *ihost) |
cc9203bf DW |
1066 | { |
1067 | /* Empty out the completion queue */ | |
89a7301f DW |
1068 | if (sci_controller_completion_queue_has_entries(ihost)) |
1069 | sci_controller_process_completions(ihost); | |
cc9203bf DW |
1070 | |
1071 | /* Clear the interrupt and enable all interrupts again */ | |
d9dcb4ba | 1072 | writel(SMU_ISR_COMPLETION, &ihost->smu_registers->interrupt_status); |
cc9203bf | 1073 | /* Could we write the value of SMU_ISR_COMPLETION? */ |
d9dcb4ba DW |
1074 | writel(0xFF000000, &ihost->smu_registers->interrupt_mask); |
1075 | writel(0, &ihost->smu_registers->interrupt_mask); | |
cc9203bf DW |
1076 | } |
1077 | ||
f8381807 JS |
1078 | void ireq_done(struct isci_host *ihost, struct isci_request *ireq, struct sas_task *task) |
1079 | { | |
f8381807 JS |
1080 | if (!test_bit(IREQ_ABORT_PATH_ACTIVE, &ireq->flags) && |
1081 | !(task->task_state_flags & SAS_TASK_STATE_ABORTED)) { | |
1082 | if (test_bit(IREQ_COMPLETE_IN_TARGET, &ireq->flags)) { | |
1083 | /* Normal notification (task_done) */ | |
1084 | dev_dbg(&ihost->pdev->dev, | |
1085 | "%s: Normal - ireq/task = %p/%p\n", | |
1086 | __func__, ireq, task); | |
54b46677 | 1087 | task->lldd_task = NULL; |
f8381807 JS |
1088 | task->task_done(task); |
1089 | } else { | |
1090 | dev_dbg(&ihost->pdev->dev, | |
1091 | "%s: Error - ireq/task = %p/%p\n", | |
1092 | __func__, ireq, task); | |
54b46677 JS |
1093 | if (sas_protocol_ata(task->task_proto)) |
1094 | task->lldd_task = NULL; | |
f8381807 JS |
1095 | sas_task_abort(task); |
1096 | } | |
54b46677 JS |
1097 | } else |
1098 | task->lldd_task = NULL; | |
1099 | ||
f8381807 JS |
1100 | if (test_and_clear_bit(IREQ_ABORT_PATH_ACTIVE, &ireq->flags)) |
1101 | wake_up_all(&ihost->eventq); | |
1102 | ||
1103 | if (!test_bit(IREQ_NO_AUTO_FREE_TAG, &ireq->flags)) | |
1104 | isci_free_tag(ihost, ireq->io_tag); | |
1105 | } | |
6f231dda DW |
1106 | /** |
1107 | * isci_host_completion_routine() - This function is the delayed service | |
1108 | * routine that calls the sci core library's completion handler. It's | |
1109 | * scheduled as a tasklet from the interrupt service routine when interrupts | |
1110 | * in use, or set as the timeout function in polled mode. | |
1111 | * @data: This parameter specifies the ISCI host object | |
1112 | * | |
1113 | */ | |
abec912d | 1114 | void isci_host_completion_routine(unsigned long data) |
6f231dda | 1115 | { |
d9dcb4ba | 1116 | struct isci_host *ihost = (struct isci_host *)data; |
9b4be528 | 1117 | u16 active; |
6f231dda | 1118 | |
d9dcb4ba | 1119 | spin_lock_irq(&ihost->scic_lock); |
89a7301f | 1120 | sci_controller_completion_handler(ihost); |
033d19d2 | 1121 | spin_unlock_irq(&ihost->scic_lock); |
6f231dda | 1122 | |
44ef2bf7 DJ |
1123 | /* |
1124 | * we subtract SCI_MAX_PORTS to account for the number of dummy TCs | |
1125 | * issued for hardware issue workaround | |
1126 | */ | |
1127 | active = isci_tci_active(ihost) - SCI_MAX_PORTS; | |
1128 | ||
1129 | /* | |
1130 | * the coalesence timeout doubles at each encoding step, so | |
9b4be528 DW |
1131 | * update it based on the ilog2 value of the outstanding requests |
1132 | */ | |
9b4be528 DW |
1133 | writel(SMU_ICC_GEN_VAL(NUMBER, active) | |
1134 | SMU_ICC_GEN_VAL(TIMER, ISCI_COALESCE_BASE + ilog2(active)), | |
1135 | &ihost->smu_registers->interrupt_coalesce_control); | |
6f231dda DW |
1136 | } |
1137 | ||
cc9203bf | 1138 | /** |
89a7301f | 1139 | * sci_controller_stop() - This method will stop an individual controller |
cc9203bf DW |
1140 | * object.This method will invoke the associated user callback upon |
1141 | * completion. The completion callback is called when the following | |
1142 | * conditions are met: -# the method return status is SCI_SUCCESS. -# the | |
1143 | * controller has been quiesced. This method will ensure that all IO | |
1144 | * requests are quiesced, phys are stopped, and all additional operation by | |
1145 | * the hardware is halted. | |
44b7ca96 | 1146 | * @ihost: the handle to the controller object to stop. |
cc9203bf DW |
1147 | * @timeout: This parameter specifies the number of milliseconds in which the |
1148 | * stop operation should complete. | |
1149 | * | |
1150 | * The controller must be in the STARTED or STOPPED state. Indicate if the | |
1151 | * controller stop method succeeded or failed in some way. SCI_SUCCESS if the | |
1152 | * stop operation successfully began. SCI_WARNING_ALREADY_IN_STATE if the | |
1153 | * controller is already in the STOPPED state. SCI_FAILURE_INVALID_STATE if the | |
1154 | * controller is not either in the STARTED or STOPPED states. | |
1155 | */ | |
89a7301f | 1156 | static enum sci_status sci_controller_stop(struct isci_host *ihost, u32 timeout) |
6f231dda | 1157 | { |
d9dcb4ba | 1158 | if (ihost->sm.current_state_id != SCIC_READY) { |
14e99b4a DW |
1159 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
1160 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
1161 | return SCI_FAILURE_INVALID_STATE; |
1162 | } | |
6f231dda | 1163 | |
d9dcb4ba DW |
1164 | sci_mod_timer(&ihost->timer, timeout); |
1165 | sci_change_state(&ihost->sm, SCIC_STOPPING); | |
cc9203bf DW |
1166 | return SCI_SUCCESS; |
1167 | } | |
1168 | ||
1169 | /** | |
89a7301f | 1170 | * sci_controller_reset() - This method will reset the supplied core |
cc9203bf DW |
1171 | * controller regardless of the state of said controller. This operation is |
1172 | * considered destructive. In other words, all current operations are wiped | |
1173 | * out. No IO completions for outstanding devices occur. Outstanding IO | |
1174 | * requests are not aborted or completed at the actual remote device. | |
44b7ca96 | 1175 | * @ihost: the handle to the controller object to reset. |
cc9203bf DW |
1176 | * |
1177 | * Indicate if the controller reset method succeeded or failed in some way. | |
1178 | * SCI_SUCCESS if the reset operation successfully started. SCI_FATAL_ERROR if | |
1179 | * the controller reset operation is unable to complete. | |
1180 | */ | |
89a7301f | 1181 | static enum sci_status sci_controller_reset(struct isci_host *ihost) |
cc9203bf | 1182 | { |
d9dcb4ba | 1183 | switch (ihost->sm.current_state_id) { |
e301370a EN |
1184 | case SCIC_RESET: |
1185 | case SCIC_READY: | |
eb608c3c | 1186 | case SCIC_STOPPING: |
e301370a | 1187 | case SCIC_FAILED: |
cc9203bf DW |
1188 | /* |
1189 | * The reset operation is not a graceful cleanup, just | |
1190 | * perform the state transition. | |
1191 | */ | |
d9dcb4ba | 1192 | sci_change_state(&ihost->sm, SCIC_RESETTING); |
cc9203bf DW |
1193 | return SCI_SUCCESS; |
1194 | default: | |
14e99b4a DW |
1195 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
1196 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
1197 | return SCI_FAILURE_INVALID_STATE; |
1198 | } | |
1199 | } | |
1200 | ||
eb608c3c DW |
1201 | static enum sci_status sci_controller_stop_phys(struct isci_host *ihost) |
1202 | { | |
1203 | u32 index; | |
1204 | enum sci_status status; | |
1205 | enum sci_status phy_status; | |
1206 | ||
1207 | status = SCI_SUCCESS; | |
1208 | ||
1209 | for (index = 0; index < SCI_MAX_PHYS; index++) { | |
1210 | phy_status = sci_phy_stop(&ihost->phys[index]); | |
1211 | ||
1212 | if (phy_status != SCI_SUCCESS && | |
1213 | phy_status != SCI_FAILURE_INVALID_STATE) { | |
1214 | status = SCI_FAILURE; | |
1215 | ||
1216 | dev_warn(&ihost->pdev->dev, | |
1217 | "%s: Controller stop operation failed to stop " | |
1218 | "phy %d because of status %d.\n", | |
1219 | __func__, | |
1220 | ihost->phys[index].phy_index, phy_status); | |
1221 | } | |
1222 | } | |
1223 | ||
1224 | return status; | |
1225 | } | |
1226 | ||
1227 | ||
1228 | /** | |
1229 | * isci_host_deinit - shutdown frame reception and dma | |
1230 | * @ihost: host to take down | |
1231 | * | |
1232 | * This is called in either the driver shutdown or the suspend path. In | |
1233 | * the shutdown case libsas went through port teardown and normal device | |
1234 | * removal (i.e. physical links stayed up to service scsi_device removal | |
1235 | * commands). In the suspend case we disable the hardware without | |
1236 | * notifying libsas of the link down events since we want libsas to | |
1237 | * remember the domain across the suspend/resume cycle | |
1238 | */ | |
cc9203bf DW |
1239 | void isci_host_deinit(struct isci_host *ihost) |
1240 | { | |
1241 | int i; | |
1242 | ||
ad4f4c1d DW |
1243 | /* disable output data selects */ |
1244 | for (i = 0; i < isci_gpio_count(ihost); i++) | |
1245 | writel(SGPIO_HW_CONTROL, &ihost->scu_registers->peg0.sgpio.output_data_select[i]); | |
1246 | ||
0cf89d1d | 1247 | set_bit(IHOST_STOP_PENDING, &ihost->flags); |
7c40a803 DW |
1248 | |
1249 | spin_lock_irq(&ihost->scic_lock); | |
89a7301f | 1250 | sci_controller_stop(ihost, SCIC_CONTROLLER_STOP_TIMEOUT); |
7c40a803 DW |
1251 | spin_unlock_irq(&ihost->scic_lock); |
1252 | ||
0cf89d1d | 1253 | wait_for_stop(ihost); |
ad4f4c1d | 1254 | |
eb608c3c DW |
1255 | /* phy stop is after controller stop to allow port and device to |
1256 | * go idle before shutting down the phys, but the expectation is | |
1257 | * that i/o has been shut off well before we reach this | |
1258 | * function. | |
1259 | */ | |
1260 | sci_controller_stop_phys(ihost); | |
1261 | ||
ad4f4c1d DW |
1262 | /* disable sgpio: where the above wait should give time for the |
1263 | * enclosure to sample the gpios going inactive | |
1264 | */ | |
1265 | writel(0, &ihost->scu_registers->peg0.sgpio.interface_control); | |
1266 | ||
2396a265 | 1267 | spin_lock_irq(&ihost->scic_lock); |
89a7301f | 1268 | sci_controller_reset(ihost); |
2396a265 | 1269 | spin_unlock_irq(&ihost->scic_lock); |
5553ba2b EN |
1270 | |
1271 | /* Cancel any/all outstanding port timers */ | |
d9dcb4ba | 1272 | for (i = 0; i < ihost->logical_port_entries; i++) { |
ffe191c9 DW |
1273 | struct isci_port *iport = &ihost->ports[i]; |
1274 | del_timer_sync(&iport->timer.timer); | |
5553ba2b EN |
1275 | } |
1276 | ||
a628d478 EN |
1277 | /* Cancel any/all outstanding phy timers */ |
1278 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
85280955 DW |
1279 | struct isci_phy *iphy = &ihost->phys[i]; |
1280 | del_timer_sync(&iphy->sata_timer.timer); | |
a628d478 EN |
1281 | } |
1282 | ||
d9dcb4ba | 1283 | del_timer_sync(&ihost->port_agent.timer.timer); |
ac0eeb4f | 1284 | |
d9dcb4ba | 1285 | del_timer_sync(&ihost->power_control.timer.timer); |
0473661a | 1286 | |
d9dcb4ba | 1287 | del_timer_sync(&ihost->timer.timer); |
6cb5853d | 1288 | |
d9dcb4ba | 1289 | del_timer_sync(&ihost->phy_timer.timer); |
6f231dda DW |
1290 | } |
1291 | ||
6f231dda DW |
1292 | static void __iomem *scu_base(struct isci_host *isci_host) |
1293 | { | |
1294 | struct pci_dev *pdev = isci_host->pdev; | |
1295 | int id = isci_host->id; | |
1296 | ||
1297 | return pcim_iomap_table(pdev)[SCI_SCU_BAR * 2] + SCI_SCU_BAR_SIZE * id; | |
1298 | } | |
1299 | ||
1300 | static void __iomem *smu_base(struct isci_host *isci_host) | |
1301 | { | |
1302 | struct pci_dev *pdev = isci_host->pdev; | |
1303 | int id = isci_host->id; | |
1304 | ||
1305 | return pcim_iomap_table(pdev)[SCI_SMU_BAR * 2] + SCI_SMU_BAR_SIZE * id; | |
1306 | } | |
1307 | ||
89a7301f | 1308 | static void sci_controller_initial_state_enter(struct sci_base_state_machine *sm) |
cc9203bf | 1309 | { |
d9dcb4ba | 1310 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf | 1311 | |
d9dcb4ba | 1312 | sci_change_state(&ihost->sm, SCIC_RESET); |
cc9203bf DW |
1313 | } |
1314 | ||
89a7301f | 1315 | static inline void sci_controller_starting_state_exit(struct sci_base_state_machine *sm) |
cc9203bf | 1316 | { |
d9dcb4ba | 1317 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf | 1318 | |
d9dcb4ba | 1319 | sci_del_timer(&ihost->timer); |
cc9203bf DW |
1320 | } |
1321 | ||
1322 | #define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS 853 | |
1323 | #define INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS 1280 | |
1324 | #define INTERRUPT_COALESCE_TIMEOUT_MAX_US 2700000 | |
1325 | #define INTERRUPT_COALESCE_NUMBER_MAX 256 | |
1326 | #define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN 7 | |
1327 | #define INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX 28 | |
1328 | ||
1329 | /** | |
89a7301f | 1330 | * sci_controller_set_interrupt_coalescence() - This method allows the user to |
cc9203bf | 1331 | * configure the interrupt coalescence. |
44b7ca96 | 1332 | * @ihost: This parameter represents the handle to the controller object |
cc9203bf DW |
1333 | * for which its interrupt coalesce register is overridden. |
1334 | * @coalesce_number: Used to control the number of entries in the Completion | |
1335 | * Queue before an interrupt is generated. If the number of entries exceed | |
1336 | * this number, an interrupt will be generated. The valid range of the input | |
1337 | * is [0, 256]. A setting of 0 results in coalescing being disabled. | |
1338 | * @coalesce_timeout: Timeout value in microseconds. The valid range of the | |
1339 | * input is [0, 2700000] . A setting of 0 is allowed and results in no | |
1340 | * interrupt coalescing timeout. | |
1341 | * | |
1342 | * Indicate if the user successfully set the interrupt coalesce parameters. | |
1343 | * SCI_SUCCESS The user successfully updated the interrutp coalescence. | |
1344 | * SCI_FAILURE_INVALID_PARAMETER_VALUE The user input value is out of range. | |
1345 | */ | |
d9dcb4ba | 1346 | static enum sci_status |
89a7301f DW |
1347 | sci_controller_set_interrupt_coalescence(struct isci_host *ihost, |
1348 | u32 coalesce_number, | |
1349 | u32 coalesce_timeout) | |
cc9203bf DW |
1350 | { |
1351 | u8 timeout_encode = 0; | |
1352 | u32 min = 0; | |
1353 | u32 max = 0; | |
1354 | ||
1355 | /* Check if the input parameters fall in the range. */ | |
1356 | if (coalesce_number > INTERRUPT_COALESCE_NUMBER_MAX) | |
1357 | return SCI_FAILURE_INVALID_PARAMETER_VALUE; | |
1358 | ||
1359 | /* | |
1360 | * Defined encoding for interrupt coalescing timeout: | |
1361 | * Value Min Max Units | |
1362 | * ----- --- --- ----- | |
1363 | * 0 - - Disabled | |
1364 | * 1 13.3 20.0 ns | |
1365 | * 2 26.7 40.0 | |
1366 | * 3 53.3 80.0 | |
1367 | * 4 106.7 160.0 | |
1368 | * 5 213.3 320.0 | |
1369 | * 6 426.7 640.0 | |
1370 | * 7 853.3 1280.0 | |
1371 | * 8 1.7 2.6 us | |
1372 | * 9 3.4 5.1 | |
1373 | * 10 6.8 10.2 | |
1374 | * 11 13.7 20.5 | |
1375 | * 12 27.3 41.0 | |
1376 | * 13 54.6 81.9 | |
1377 | * 14 109.2 163.8 | |
1378 | * 15 218.5 327.7 | |
1379 | * 16 436.9 655.4 | |
1380 | * 17 873.8 1310.7 | |
1381 | * 18 1.7 2.6 ms | |
1382 | * 19 3.5 5.2 | |
1383 | * 20 7.0 10.5 | |
1384 | * 21 14.0 21.0 | |
1385 | * 22 28.0 41.9 | |
1386 | * 23 55.9 83.9 | |
1387 | * 24 111.8 167.8 | |
1388 | * 25 223.7 335.5 | |
1389 | * 26 447.4 671.1 | |
1390 | * 27 894.8 1342.2 | |
1391 | * 28 1.8 2.7 s | |
1392 | * Others Undefined */ | |
1393 | ||
1394 | /* | |
1395 | * Use the table above to decide the encode of interrupt coalescing timeout | |
1396 | * value for register writing. */ | |
1397 | if (coalesce_timeout == 0) | |
1398 | timeout_encode = 0; | |
1399 | else{ | |
1400 | /* make the timeout value in unit of (10 ns). */ | |
1401 | coalesce_timeout = coalesce_timeout * 100; | |
1402 | min = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_LOWER_BOUND_NS / 10; | |
1403 | max = INTERRUPT_COALESCE_TIMEOUT_BASE_RANGE_UPPER_BOUND_NS / 10; | |
1404 | ||
1405 | /* get the encode of timeout for register writing. */ | |
1406 | for (timeout_encode = INTERRUPT_COALESCE_TIMEOUT_ENCODE_MIN; | |
1407 | timeout_encode <= INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX; | |
1408 | timeout_encode++) { | |
1409 | if (min <= coalesce_timeout && max > coalesce_timeout) | |
1410 | break; | |
1411 | else if (coalesce_timeout >= max && coalesce_timeout < min * 2 | |
1412 | && coalesce_timeout <= INTERRUPT_COALESCE_TIMEOUT_MAX_US * 100) { | |
1413 | if ((coalesce_timeout - max) < (2 * min - coalesce_timeout)) | |
1414 | break; | |
1415 | else{ | |
1416 | timeout_encode++; | |
1417 | break; | |
1418 | } | |
1419 | } else { | |
1420 | max = max * 2; | |
1421 | min = min * 2; | |
1422 | } | |
1423 | } | |
1424 | ||
1425 | if (timeout_encode == INTERRUPT_COALESCE_TIMEOUT_ENCODE_MAX + 1) | |
1426 | /* the value is out of range. */ | |
1427 | return SCI_FAILURE_INVALID_PARAMETER_VALUE; | |
1428 | } | |
1429 | ||
1430 | writel(SMU_ICC_GEN_VAL(NUMBER, coalesce_number) | | |
1431 | SMU_ICC_GEN_VAL(TIMER, timeout_encode), | |
d9dcb4ba | 1432 | &ihost->smu_registers->interrupt_coalesce_control); |
cc9203bf DW |
1433 | |
1434 | ||
d9dcb4ba DW |
1435 | ihost->interrupt_coalesce_number = (u16)coalesce_number; |
1436 | ihost->interrupt_coalesce_timeout = coalesce_timeout / 100; | |
cc9203bf DW |
1437 | |
1438 | return SCI_SUCCESS; | |
1439 | } | |
1440 | ||
1441 | ||
89a7301f | 1442 | static void sci_controller_ready_state_enter(struct sci_base_state_machine *sm) |
cc9203bf | 1443 | { |
d9dcb4ba | 1444 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
e5cc6aa4 MT |
1445 | u32 val; |
1446 | ||
1447 | /* enable clock gating for power control of the scu unit */ | |
1448 | val = readl(&ihost->smu_registers->clock_gating_control); | |
1449 | val &= ~(SMU_CGUCR_GEN_BIT(REGCLK_ENABLE) | | |
1450 | SMU_CGUCR_GEN_BIT(TXCLK_ENABLE) | | |
1451 | SMU_CGUCR_GEN_BIT(XCLK_ENABLE)); | |
1452 | val |= SMU_CGUCR_GEN_BIT(IDLE_ENABLE); | |
1453 | writel(val, &ihost->smu_registers->clock_gating_control); | |
cc9203bf DW |
1454 | |
1455 | /* set the default interrupt coalescence number and timeout value. */ | |
9b4be528 | 1456 | sci_controller_set_interrupt_coalescence(ihost, 0, 0); |
cc9203bf DW |
1457 | } |
1458 | ||
89a7301f | 1459 | static void sci_controller_ready_state_exit(struct sci_base_state_machine *sm) |
cc9203bf | 1460 | { |
d9dcb4ba | 1461 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf DW |
1462 | |
1463 | /* disable interrupt coalescence. */ | |
89a7301f | 1464 | sci_controller_set_interrupt_coalescence(ihost, 0, 0); |
cc9203bf DW |
1465 | } |
1466 | ||
89a7301f | 1467 | static enum sci_status sci_controller_stop_ports(struct isci_host *ihost) |
cc9203bf DW |
1468 | { |
1469 | u32 index; | |
1470 | enum sci_status port_status; | |
1471 | enum sci_status status = SCI_SUCCESS; | |
cc9203bf | 1472 | |
d9dcb4ba | 1473 | for (index = 0; index < ihost->logical_port_entries; index++) { |
ffe191c9 | 1474 | struct isci_port *iport = &ihost->ports[index]; |
cc9203bf | 1475 | |
89a7301f | 1476 | port_status = sci_port_stop(iport); |
cc9203bf DW |
1477 | |
1478 | if ((port_status != SCI_SUCCESS) && | |
1479 | (port_status != SCI_FAILURE_INVALID_STATE)) { | |
1480 | status = SCI_FAILURE; | |
1481 | ||
d9dcb4ba | 1482 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
1483 | "%s: Controller stop operation failed to " |
1484 | "stop port %d because of status %d.\n", | |
1485 | __func__, | |
ffe191c9 | 1486 | iport->logical_port_index, |
cc9203bf DW |
1487 | port_status); |
1488 | } | |
1489 | } | |
1490 | ||
1491 | return status; | |
1492 | } | |
1493 | ||
89a7301f | 1494 | static enum sci_status sci_controller_stop_devices(struct isci_host *ihost) |
cc9203bf DW |
1495 | { |
1496 | u32 index; | |
1497 | enum sci_status status; | |
1498 | enum sci_status device_status; | |
1499 | ||
1500 | status = SCI_SUCCESS; | |
1501 | ||
d9dcb4ba DW |
1502 | for (index = 0; index < ihost->remote_node_entries; index++) { |
1503 | if (ihost->device_table[index] != NULL) { | |
cc9203bf | 1504 | /* / @todo What timeout value do we want to provide to this request? */ |
89a7301f | 1505 | device_status = sci_remote_device_stop(ihost->device_table[index], 0); |
cc9203bf DW |
1506 | |
1507 | if ((device_status != SCI_SUCCESS) && | |
1508 | (device_status != SCI_FAILURE_INVALID_STATE)) { | |
d9dcb4ba | 1509 | dev_warn(&ihost->pdev->dev, |
cc9203bf DW |
1510 | "%s: Controller stop operation failed " |
1511 | "to stop device 0x%p because of " | |
1512 | "status %d.\n", | |
1513 | __func__, | |
d9dcb4ba | 1514 | ihost->device_table[index], device_status); |
cc9203bf DW |
1515 | } |
1516 | } | |
1517 | } | |
1518 | ||
1519 | return status; | |
1520 | } | |
1521 | ||
89a7301f | 1522 | static void sci_controller_stopping_state_enter(struct sci_base_state_machine *sm) |
cc9203bf | 1523 | { |
d9dcb4ba | 1524 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf | 1525 | |
89a7301f | 1526 | sci_controller_stop_devices(ihost); |
eb608c3c DW |
1527 | sci_controller_stop_ports(ihost); |
1528 | ||
1529 | if (!sci_controller_has_remote_devices_stopping(ihost)) | |
1530 | isci_host_stop_complete(ihost); | |
cc9203bf DW |
1531 | } |
1532 | ||
89a7301f | 1533 | static void sci_controller_stopping_state_exit(struct sci_base_state_machine *sm) |
cc9203bf | 1534 | { |
d9dcb4ba | 1535 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf | 1536 | |
d9dcb4ba | 1537 | sci_del_timer(&ihost->timer); |
cc9203bf DW |
1538 | } |
1539 | ||
89a7301f | 1540 | static void sci_controller_reset_hardware(struct isci_host *ihost) |
cc9203bf DW |
1541 | { |
1542 | /* Disable interrupts so we dont take any spurious interrupts */ | |
89a7301f | 1543 | sci_controller_disable_interrupts(ihost); |
cc9203bf DW |
1544 | |
1545 | /* Reset the SCU */ | |
d9dcb4ba | 1546 | writel(0xFFFFFFFF, &ihost->smu_registers->soft_reset_control); |
cc9203bf DW |
1547 | |
1548 | /* Delay for 1ms to before clearing the CQP and UFQPR. */ | |
1549 | udelay(1000); | |
1550 | ||
1551 | /* The write to the CQGR clears the CQP */ | |
d9dcb4ba | 1552 | writel(0x00000000, &ihost->smu_registers->completion_queue_get); |
cc9203bf DW |
1553 | |
1554 | /* The write to the UFQGP clears the UFQPR */ | |
d9dcb4ba | 1555 | writel(0, &ihost->scu_registers->sdma.unsolicited_frame_get_pointer); |
2396a265 DW |
1556 | |
1557 | /* clear all interrupts */ | |
1558 | writel(~SMU_INTERRUPT_STATUS_RESERVED_MASK, &ihost->smu_registers->interrupt_status); | |
cc9203bf DW |
1559 | } |
1560 | ||
89a7301f | 1561 | static void sci_controller_resetting_state_enter(struct sci_base_state_machine *sm) |
cc9203bf | 1562 | { |
d9dcb4ba | 1563 | struct isci_host *ihost = container_of(sm, typeof(*ihost), sm); |
cc9203bf | 1564 | |
89a7301f | 1565 | sci_controller_reset_hardware(ihost); |
d9dcb4ba | 1566 | sci_change_state(&ihost->sm, SCIC_RESET); |
cc9203bf DW |
1567 | } |
1568 | ||
89a7301f | 1569 | static const struct sci_base_state sci_controller_state_table[] = { |
e301370a | 1570 | [SCIC_INITIAL] = { |
89a7301f | 1571 | .enter_state = sci_controller_initial_state_enter, |
cc9203bf | 1572 | }, |
e301370a EN |
1573 | [SCIC_RESET] = {}, |
1574 | [SCIC_INITIALIZING] = {}, | |
1575 | [SCIC_INITIALIZED] = {}, | |
1576 | [SCIC_STARTING] = { | |
89a7301f | 1577 | .exit_state = sci_controller_starting_state_exit, |
cc9203bf | 1578 | }, |
e301370a | 1579 | [SCIC_READY] = { |
89a7301f DW |
1580 | .enter_state = sci_controller_ready_state_enter, |
1581 | .exit_state = sci_controller_ready_state_exit, | |
cc9203bf | 1582 | }, |
e301370a | 1583 | [SCIC_RESETTING] = { |
89a7301f | 1584 | .enter_state = sci_controller_resetting_state_enter, |
cc9203bf | 1585 | }, |
e301370a | 1586 | [SCIC_STOPPING] = { |
89a7301f DW |
1587 | .enter_state = sci_controller_stopping_state_enter, |
1588 | .exit_state = sci_controller_stopping_state_exit, | |
cc9203bf | 1589 | }, |
e301370a | 1590 | [SCIC_FAILED] = {} |
cc9203bf DW |
1591 | }; |
1592 | ||
b0a2dc66 | 1593 | static void controller_timeout(struct timer_list *t) |
6cb5853d | 1594 | { |
b0a2dc66 | 1595 | struct sci_timer *tmr = from_timer(tmr, t, timer); |
d9dcb4ba DW |
1596 | struct isci_host *ihost = container_of(tmr, typeof(*ihost), timer); |
1597 | struct sci_base_state_machine *sm = &ihost->sm; | |
6cb5853d EN |
1598 | unsigned long flags; |
1599 | ||
1600 | spin_lock_irqsave(&ihost->scic_lock, flags); | |
1601 | ||
1602 | if (tmr->cancel) | |
1603 | goto done; | |
1604 | ||
e301370a | 1605 | if (sm->current_state_id == SCIC_STARTING) |
89a7301f | 1606 | sci_controller_transition_to_ready(ihost, SCI_FAILURE_TIMEOUT); |
e301370a EN |
1607 | else if (sm->current_state_id == SCIC_STOPPING) { |
1608 | sci_change_state(sm, SCIC_FAILED); | |
eb608c3c | 1609 | isci_host_stop_complete(ihost); |
6cb5853d | 1610 | } else /* / @todo Now what do we want to do in this case? */ |
d9dcb4ba | 1611 | dev_err(&ihost->pdev->dev, |
6cb5853d EN |
1612 | "%s: Controller timer fired when controller was not " |
1613 | "in a state being timed.\n", | |
1614 | __func__); | |
cc9203bf | 1615 | |
6cb5853d EN |
1616 | done: |
1617 | spin_unlock_irqrestore(&ihost->scic_lock, flags); | |
1618 | } | |
cc9203bf | 1619 | |
89a7301f DW |
1620 | static enum sci_status sci_controller_construct(struct isci_host *ihost, |
1621 | void __iomem *scu_base, | |
1622 | void __iomem *smu_base) | |
cc9203bf | 1623 | { |
cc9203bf DW |
1624 | u8 i; |
1625 | ||
89a7301f | 1626 | sci_init_sm(&ihost->sm, sci_controller_state_table, SCIC_INITIAL); |
cc9203bf | 1627 | |
d9dcb4ba DW |
1628 | ihost->scu_registers = scu_base; |
1629 | ihost->smu_registers = smu_base; | |
cc9203bf | 1630 | |
89a7301f | 1631 | sci_port_configuration_agent_construct(&ihost->port_agent); |
cc9203bf DW |
1632 | |
1633 | /* Construct the ports for this controller */ | |
1634 | for (i = 0; i < SCI_MAX_PORTS; i++) | |
89a7301f DW |
1635 | sci_port_construct(&ihost->ports[i], i, ihost); |
1636 | sci_port_construct(&ihost->ports[i], SCIC_SDS_DUMMY_PORT, ihost); | |
cc9203bf DW |
1637 | |
1638 | /* Construct the phys for this controller */ | |
1639 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
1640 | /* Add all the PHYs to the dummy port */ | |
89a7301f DW |
1641 | sci_phy_construct(&ihost->phys[i], |
1642 | &ihost->ports[SCI_MAX_PORTS], i); | |
cc9203bf DW |
1643 | } |
1644 | ||
d9dcb4ba | 1645 | ihost->invalid_phy_mask = 0; |
cc9203bf | 1646 | |
d9dcb4ba | 1647 | sci_init_timer(&ihost->timer, controller_timeout); |
6cb5853d | 1648 | |
89a7301f | 1649 | return sci_controller_reset(ihost); |
cc9203bf DW |
1650 | } |
1651 | ||
594e566a | 1652 | int sci_oem_parameters_validate(struct sci_oem_params *oem, u8 version) |
cc9203bf DW |
1653 | { |
1654 | int i; | |
1655 | ||
1656 | for (i = 0; i < SCI_MAX_PORTS; i++) | |
1657 | if (oem->ports[i].phy_mask > SCIC_SDS_PARM_PHY_MASK_MAX) | |
1658 | return -EINVAL; | |
1659 | ||
1660 | for (i = 0; i < SCI_MAX_PHYS; i++) | |
1661 | if (oem->phys[i].sas_address.high == 0 && | |
1662 | oem->phys[i].sas_address.low == 0) | |
1663 | return -EINVAL; | |
1664 | ||
1665 | if (oem->controller.mode_type == SCIC_PORT_AUTOMATIC_CONFIGURATION_MODE) { | |
1666 | for (i = 0; i < SCI_MAX_PHYS; i++) | |
1667 | if (oem->ports[i].phy_mask != 0) | |
1668 | return -EINVAL; | |
1669 | } else if (oem->controller.mode_type == SCIC_PORT_MANUAL_CONFIGURATION_MODE) { | |
1670 | u8 phy_mask = 0; | |
1671 | ||
1672 | for (i = 0; i < SCI_MAX_PHYS; i++) | |
1673 | phy_mask |= oem->ports[i].phy_mask; | |
1674 | ||
1675 | if (phy_mask == 0) | |
1676 | return -EINVAL; | |
1677 | } else | |
1678 | return -EINVAL; | |
1679 | ||
7000f7c7 AJ |
1680 | if (oem->controller.max_concurr_spin_up > MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT || |
1681 | oem->controller.max_concurr_spin_up < 1) | |
cc9203bf DW |
1682 | return -EINVAL; |
1683 | ||
594e566a DJ |
1684 | if (oem->controller.do_enable_ssc) { |
1685 | if (version < ISCI_ROM_VER_1_1 && oem->controller.do_enable_ssc != 1) | |
1686 | return -EINVAL; | |
1687 | ||
1688 | if (version >= ISCI_ROM_VER_1_1) { | |
1689 | u8 test = oem->controller.ssc_sata_tx_spread_level; | |
1690 | ||
1691 | switch (test) { | |
1692 | case 0: | |
1693 | case 2: | |
1694 | case 3: | |
1695 | case 6: | |
1696 | case 7: | |
1697 | break; | |
1698 | default: | |
1699 | return -EINVAL; | |
1700 | } | |
1701 | ||
1702 | test = oem->controller.ssc_sas_tx_spread_level; | |
1703 | if (oem->controller.ssc_sas_tx_type == 0) { | |
1704 | switch (test) { | |
1705 | case 0: | |
1706 | case 2: | |
1707 | case 3: | |
1708 | break; | |
1709 | default: | |
1710 | return -EINVAL; | |
1711 | } | |
1712 | } else if (oem->controller.ssc_sas_tx_type == 1) { | |
1713 | switch (test) { | |
1714 | case 0: | |
1715 | case 3: | |
1716 | case 6: | |
1717 | break; | |
1718 | default: | |
1719 | return -EINVAL; | |
1720 | } | |
1721 | } | |
1722 | } | |
1723 | } | |
1724 | ||
cc9203bf DW |
1725 | return 0; |
1726 | } | |
1727 | ||
7000f7c7 AJ |
1728 | static u8 max_spin_up(struct isci_host *ihost) |
1729 | { | |
1730 | if (ihost->user_parameters.max_concurr_spinup) | |
1731 | return min_t(u8, ihost->user_parameters.max_concurr_spinup, | |
1732 | MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT); | |
1733 | else | |
1734 | return min_t(u8, ihost->oem_parameters.controller.max_concurr_spin_up, | |
1735 | MAX_CONCURRENT_DEVICE_SPIN_UP_COUNT); | |
1736 | } | |
1737 | ||
b0a2dc66 | 1738 | static void power_control_timeout(struct timer_list *t) |
cc9203bf | 1739 | { |
b0a2dc66 | 1740 | struct sci_timer *tmr = from_timer(tmr, t, timer); |
d9dcb4ba | 1741 | struct isci_host *ihost = container_of(tmr, typeof(*ihost), power_control.timer); |
85280955 | 1742 | struct isci_phy *iphy; |
0473661a EN |
1743 | unsigned long flags; |
1744 | u8 i; | |
cc9203bf | 1745 | |
0473661a | 1746 | spin_lock_irqsave(&ihost->scic_lock, flags); |
cc9203bf | 1747 | |
0473661a EN |
1748 | if (tmr->cancel) |
1749 | goto done; | |
1750 | ||
d9dcb4ba | 1751 | ihost->power_control.phys_granted_power = 0; |
0473661a | 1752 | |
d9dcb4ba DW |
1753 | if (ihost->power_control.phys_waiting == 0) { |
1754 | ihost->power_control.timer_started = false; | |
0473661a | 1755 | goto done; |
cc9203bf | 1756 | } |
cc9203bf | 1757 | |
0473661a | 1758 | for (i = 0; i < SCI_MAX_PHYS; i++) { |
cc9203bf | 1759 | |
d9dcb4ba | 1760 | if (ihost->power_control.phys_waiting == 0) |
0473661a | 1761 | break; |
cc9203bf | 1762 | |
d9dcb4ba | 1763 | iphy = ihost->power_control.requesters[i]; |
85280955 | 1764 | if (iphy == NULL) |
0473661a | 1765 | continue; |
cc9203bf | 1766 | |
7000f7c7 | 1767 | if (ihost->power_control.phys_granted_power >= max_spin_up(ihost)) |
0473661a | 1768 | break; |
cc9203bf | 1769 | |
d9dcb4ba DW |
1770 | ihost->power_control.requesters[i] = NULL; |
1771 | ihost->power_control.phys_waiting--; | |
1772 | ihost->power_control.phys_granted_power++; | |
89a7301f | 1773 | sci_phy_consume_power_handler(iphy); |
be778341 | 1774 | |
c79dd80d | 1775 | if (iphy->protocol == SAS_PROTOCOL_SSP) { |
be778341 MT |
1776 | u8 j; |
1777 | ||
1778 | for (j = 0; j < SCI_MAX_PHYS; j++) { | |
1779 | struct isci_phy *requester = ihost->power_control.requesters[j]; | |
1780 | ||
1781 | /* | |
1782 | * Search the power_control queue to see if there are other phys | |
1783 | * attached to the same remote device. If found, take all of | |
1784 | * them out of await_sas_power state. | |
1785 | */ | |
1786 | if (requester != NULL && requester != iphy) { | |
1787 | u8 other = memcmp(requester->frame_rcvd.iaf.sas_addr, | |
1788 | iphy->frame_rcvd.iaf.sas_addr, | |
1789 | sizeof(requester->frame_rcvd.iaf.sas_addr)); | |
1790 | ||
1791 | if (other == 0) { | |
1792 | ihost->power_control.requesters[j] = NULL; | |
1793 | ihost->power_control.phys_waiting--; | |
1794 | sci_phy_consume_power_handler(requester); | |
1795 | } | |
1796 | } | |
1797 | } | |
1798 | } | |
cc9203bf | 1799 | } |
0473661a EN |
1800 | |
1801 | /* | |
1802 | * It doesn't matter if the power list is empty, we need to start the | |
1803 | * timer in case another phy becomes ready. | |
1804 | */ | |
1805 | sci_mod_timer(tmr, SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL); | |
d9dcb4ba | 1806 | ihost->power_control.timer_started = true; |
0473661a EN |
1807 | |
1808 | done: | |
1809 | spin_unlock_irqrestore(&ihost->scic_lock, flags); | |
cc9203bf DW |
1810 | } |
1811 | ||
89a7301f DW |
1812 | void sci_controller_power_control_queue_insert(struct isci_host *ihost, |
1813 | struct isci_phy *iphy) | |
cc9203bf | 1814 | { |
85280955 | 1815 | BUG_ON(iphy == NULL); |
cc9203bf | 1816 | |
7000f7c7 | 1817 | if (ihost->power_control.phys_granted_power < max_spin_up(ihost)) { |
d9dcb4ba | 1818 | ihost->power_control.phys_granted_power++; |
89a7301f | 1819 | sci_phy_consume_power_handler(iphy); |
cc9203bf DW |
1820 | |
1821 | /* | |
1822 | * stop and start the power_control timer. When the timer fires, the | |
1823 | * no_of_phys_granted_power will be set to 0 | |
1824 | */ | |
d9dcb4ba DW |
1825 | if (ihost->power_control.timer_started) |
1826 | sci_del_timer(&ihost->power_control.timer); | |
0473661a | 1827 | |
d9dcb4ba | 1828 | sci_mod_timer(&ihost->power_control.timer, |
0473661a | 1829 | SCIC_SDS_CONTROLLER_POWER_CONTROL_INTERVAL); |
d9dcb4ba | 1830 | ihost->power_control.timer_started = true; |
0473661a | 1831 | |
cc9203bf | 1832 | } else { |
be778341 MT |
1833 | /* |
1834 | * There are phys, attached to the same sas address as this phy, are | |
1835 | * already in READY state, this phy don't need wait. | |
1836 | */ | |
1837 | u8 i; | |
1838 | struct isci_phy *current_phy; | |
1839 | ||
1840 | for (i = 0; i < SCI_MAX_PHYS; i++) { | |
1841 | u8 other; | |
1842 | current_phy = &ihost->phys[i]; | |
1843 | ||
1844 | other = memcmp(current_phy->frame_rcvd.iaf.sas_addr, | |
1845 | iphy->frame_rcvd.iaf.sas_addr, | |
1846 | sizeof(current_phy->frame_rcvd.iaf.sas_addr)); | |
1847 | ||
1848 | if (current_phy->sm.current_state_id == SCI_PHY_READY && | |
c79dd80d | 1849 | current_phy->protocol == SAS_PROTOCOL_SSP && |
be778341 MT |
1850 | other == 0) { |
1851 | sci_phy_consume_power_handler(iphy); | |
1852 | break; | |
1853 | } | |
1854 | } | |
1855 | ||
1856 | if (i == SCI_MAX_PHYS) { | |
1857 | /* Add the phy in the waiting list */ | |
1858 | ihost->power_control.requesters[iphy->phy_index] = iphy; | |
1859 | ihost->power_control.phys_waiting++; | |
1860 | } | |
cc9203bf DW |
1861 | } |
1862 | } | |
1863 | ||
89a7301f DW |
1864 | void sci_controller_power_control_queue_remove(struct isci_host *ihost, |
1865 | struct isci_phy *iphy) | |
cc9203bf | 1866 | { |
85280955 | 1867 | BUG_ON(iphy == NULL); |
cc9203bf | 1868 | |
89a7301f | 1869 | if (ihost->power_control.requesters[iphy->phy_index]) |
d9dcb4ba | 1870 | ihost->power_control.phys_waiting--; |
cc9203bf | 1871 | |
d9dcb4ba | 1872 | ihost->power_control.requesters[iphy->phy_index] = NULL; |
cc9203bf DW |
1873 | } |
1874 | ||
afd13a1f JS |
1875 | static int is_long_cable(int phy, unsigned char selection_byte) |
1876 | { | |
9fee607f | 1877 | return !!(selection_byte & (1 << phy)); |
afd13a1f JS |
1878 | } |
1879 | ||
1880 | static int is_medium_cable(int phy, unsigned char selection_byte) | |
1881 | { | |
9fee607f JS |
1882 | return !!(selection_byte & (1 << (phy + 4))); |
1883 | } | |
1884 | ||
1885 | static enum cable_selections decode_selection_byte( | |
1886 | int phy, | |
1887 | unsigned char selection_byte) | |
1888 | { | |
1889 | return ((selection_byte & (1 << phy)) ? 1 : 0) | |
1890 | + (selection_byte & (1 << (phy + 4)) ? 2 : 0); | |
1891 | } | |
1892 | ||
1893 | static unsigned char *to_cable_select(struct isci_host *ihost) | |
1894 | { | |
1895 | if (is_cable_select_overridden()) | |
1896 | return ((unsigned char *)&cable_selection_override) | |
1897 | + ihost->id; | |
1898 | else | |
1899 | return &ihost->oem_parameters.controller.cable_selection_mask; | |
1900 | } | |
1901 | ||
1902 | enum cable_selections decode_cable_selection(struct isci_host *ihost, int phy) | |
1903 | { | |
1904 | return decode_selection_byte(phy, *to_cable_select(ihost)); | |
1905 | } | |
1906 | ||
1907 | char *lookup_cable_names(enum cable_selections selection) | |
1908 | { | |
1909 | static char *cable_names[] = { | |
1910 | [short_cable] = "short", | |
1911 | [long_cable] = "long", | |
1912 | [medium_cable] = "medium", | |
1913 | [undefined_cable] = "<undefined, assumed long>" /* bit 0==1 */ | |
1914 | }; | |
1915 | return (selection <= undefined_cable) ? cable_names[selection] | |
1916 | : cable_names[undefined_cable]; | |
afd13a1f JS |
1917 | } |
1918 | ||
cc9203bf DW |
1919 | #define AFE_REGISTER_WRITE_DELAY 10 |
1920 | ||
89a7301f | 1921 | static void sci_controller_afe_initialization(struct isci_host *ihost) |
cc9203bf | 1922 | { |
2e5da889 | 1923 | struct scu_afe_registers __iomem *afe = &ihost->scu_registers->afe; |
89a7301f | 1924 | const struct sci_oem_params *oem = &ihost->oem_parameters; |
dc00c8b6 | 1925 | struct pci_dev *pdev = ihost->pdev; |
cc9203bf DW |
1926 | u32 afe_status; |
1927 | u32 phy_id; | |
9fee607f | 1928 | unsigned char cable_selection_mask = *to_cable_select(ihost); |
cc9203bf DW |
1929 | |
1930 | /* Clear DFX Status registers */ | |
2e5da889 | 1931 | writel(0x0081000f, &afe->afe_dfx_master_control0); |
cc9203bf DW |
1932 | udelay(AFE_REGISTER_WRITE_DELAY); |
1933 | ||
afd13a1f | 1934 | if (is_b0(pdev) || is_c0(pdev) || is_c1(pdev)) { |
cc9203bf | 1935 | /* PM Rx Equalization Save, PM SPhy Rx Acknowledgement |
2e5da889 DW |
1936 | * Timer, PM Stagger Timer |
1937 | */ | |
afd13a1f | 1938 | writel(0x0007FFFF, &afe->afe_pmsn_master_control2); |
cc9203bf DW |
1939 | udelay(AFE_REGISTER_WRITE_DELAY); |
1940 | } | |
1941 | ||
1942 | /* Configure bias currents to normal */ | |
dc00c8b6 | 1943 | if (is_a2(pdev)) |
2e5da889 | 1944 | writel(0x00005A00, &afe->afe_bias_control); |
dc00c8b6 | 1945 | else if (is_b0(pdev) || is_c0(pdev)) |
2e5da889 | 1946 | writel(0x00005F00, &afe->afe_bias_control); |
afd13a1f JS |
1947 | else if (is_c1(pdev)) |
1948 | writel(0x00005500, &afe->afe_bias_control); | |
cc9203bf DW |
1949 | |
1950 | udelay(AFE_REGISTER_WRITE_DELAY); | |
1951 | ||
1952 | /* Enable PLL */ | |
afd13a1f | 1953 | if (is_a2(pdev)) |
2e5da889 | 1954 | writel(0x80040908, &afe->afe_pll_control0); |
afd13a1f JS |
1955 | else if (is_b0(pdev) || is_c0(pdev)) |
1956 | writel(0x80040A08, &afe->afe_pll_control0); | |
1957 | else if (is_c1(pdev)) { | |
1958 | writel(0x80000B08, &afe->afe_pll_control0); | |
1959 | udelay(AFE_REGISTER_WRITE_DELAY); | |
1960 | writel(0x00000B08, &afe->afe_pll_control0); | |
1961 | udelay(AFE_REGISTER_WRITE_DELAY); | |
1962 | writel(0x80000B08, &afe->afe_pll_control0); | |
1963 | } | |
cc9203bf DW |
1964 | |
1965 | udelay(AFE_REGISTER_WRITE_DELAY); | |
1966 | ||
1967 | /* Wait for the PLL to lock */ | |
1968 | do { | |
2e5da889 | 1969 | afe_status = readl(&afe->afe_common_block_status); |
cc9203bf DW |
1970 | udelay(AFE_REGISTER_WRITE_DELAY); |
1971 | } while ((afe_status & 0x00001000) == 0); | |
1972 | ||
dc00c8b6 | 1973 | if (is_a2(pdev)) { |
2e5da889 DW |
1974 | /* Shorten SAS SNW lock time (RxLock timer value from 76 |
1975 | * us to 50 us) | |
1976 | */ | |
1977 | writel(0x7bcc96ad, &afe->afe_pmsn_master_control0); | |
cc9203bf DW |
1978 | udelay(AFE_REGISTER_WRITE_DELAY); |
1979 | } | |
1980 | ||
1981 | for (phy_id = 0; phy_id < SCI_MAX_PHYS; phy_id++) { | |
6734092e | 1982 | struct scu_afe_transceiver __iomem *xcvr = &afe->scu_afe_xcvr[phy_id]; |
cc9203bf | 1983 | const struct sci_phy_oem_params *oem_phy = &oem->phys[phy_id]; |
afd13a1f JS |
1984 | int cable_length_long = |
1985 | is_long_cable(phy_id, cable_selection_mask); | |
1986 | int cable_length_medium = | |
1987 | is_medium_cable(phy_id, cable_selection_mask); | |
1988 | ||
1989 | if (is_a2(pdev)) { | |
1990 | /* All defaults, except the Receive Word | |
1991 | * Alignament/Comma Detect Enable....(0xe800) | |
1992 | */ | |
1993 | writel(0x00004512, &xcvr->afe_xcvr_control0); | |
1994 | udelay(AFE_REGISTER_WRITE_DELAY); | |
cc9203bf | 1995 | |
afd13a1f JS |
1996 | writel(0x0050100F, &xcvr->afe_xcvr_control1); |
1997 | udelay(AFE_REGISTER_WRITE_DELAY); | |
1998 | } else if (is_b0(pdev)) { | |
1999 | /* Configure transmitter SSC parameters */ | |
2e5da889 | 2000 | writel(0x00030000, &xcvr->afe_tx_ssc_control); |
cc9203bf | 2001 | udelay(AFE_REGISTER_WRITE_DELAY); |
dc00c8b6 | 2002 | } else if (is_c0(pdev)) { |
afd13a1f JS |
2003 | /* Configure transmitter SSC parameters */ |
2004 | writel(0x00010202, &xcvr->afe_tx_ssc_control); | |
dbb0743a AG |
2005 | udelay(AFE_REGISTER_WRITE_DELAY); |
2006 | ||
2e5da889 DW |
2007 | /* All defaults, except the Receive Word |
2008 | * Alignament/Comma Detect Enable....(0xe800) | |
2009 | */ | |
afd13a1f | 2010 | writel(0x00014500, &xcvr->afe_xcvr_control0); |
dbb0743a | 2011 | udelay(AFE_REGISTER_WRITE_DELAY); |
afd13a1f JS |
2012 | } else if (is_c1(pdev)) { |
2013 | /* Configure transmitter SSC parameters */ | |
2014 | writel(0x00010202, &xcvr->afe_tx_ssc_control); | |
2015 | udelay(AFE_REGISTER_WRITE_DELAY); | |
2016 | ||
2e5da889 DW |
2017 | /* All defaults, except the Receive Word |
2018 | * Alignament/Comma Detect Enable....(0xe800) | |
2019 | */ | |
afd13a1f | 2020 | writel(0x0001C500, &xcvr->afe_xcvr_control0); |
cc9203bf DW |
2021 | udelay(AFE_REGISTER_WRITE_DELAY); |
2022 | } | |
2023 | ||
afd13a1f JS |
2024 | /* Power up TX and RX out from power down (PWRDNTX and |
2025 | * PWRDNRX) & increase TX int & ext bias 20%....(0xe85c) | |
2e5da889 | 2026 | */ |
dc00c8b6 | 2027 | if (is_a2(pdev)) |
2e5da889 | 2028 | writel(0x000003F0, &xcvr->afe_channel_control); |
dc00c8b6 | 2029 | else if (is_b0(pdev)) { |
2e5da889 | 2030 | writel(0x000003D7, &xcvr->afe_channel_control); |
dbb0743a | 2031 | udelay(AFE_REGISTER_WRITE_DELAY); |
afd13a1f | 2032 | |
2e5da889 | 2033 | writel(0x000003D4, &xcvr->afe_channel_control); |
afd13a1f | 2034 | } else if (is_c0(pdev)) { |
2e5da889 | 2035 | writel(0x000001E7, &xcvr->afe_channel_control); |
cc9203bf | 2036 | udelay(AFE_REGISTER_WRITE_DELAY); |
afd13a1f | 2037 | |
2e5da889 | 2038 | writel(0x000001E4, &xcvr->afe_channel_control); |
afd13a1f JS |
2039 | } else if (is_c1(pdev)) { |
2040 | writel(cable_length_long ? 0x000002F7 : 0x000001F7, | |
2041 | &xcvr->afe_channel_control); | |
2042 | udelay(AFE_REGISTER_WRITE_DELAY); | |
2043 | ||
2044 | writel(cable_length_long ? 0x000002F4 : 0x000001F4, | |
2045 | &xcvr->afe_channel_control); | |
cc9203bf DW |
2046 | } |
2047 | udelay(AFE_REGISTER_WRITE_DELAY); | |
2048 | ||
dc00c8b6 | 2049 | if (is_a2(pdev)) { |
cc9203bf | 2050 | /* Enable TX equalization (0xe824) */ |
2e5da889 | 2051 | writel(0x00040000, &xcvr->afe_tx_control); |
cc9203bf DW |
2052 | udelay(AFE_REGISTER_WRITE_DELAY); |
2053 | } | |
2054 | ||
afd13a1f JS |
2055 | if (is_a2(pdev) || is_b0(pdev)) |
2056 | /* RDPI=0x0(RX Power On), RXOOBDETPDNC=0x0, | |
2057 | * TPD=0x0(TX Power On), RDD=0x0(RX Detect | |
2058 | * Enabled) ....(0xe800) | |
2059 | */ | |
2060 | writel(0x00004100, &xcvr->afe_xcvr_control0); | |
2061 | else if (is_c0(pdev)) | |
2062 | writel(0x00014100, &xcvr->afe_xcvr_control0); | |
2063 | else if (is_c1(pdev)) | |
2064 | writel(0x0001C100, &xcvr->afe_xcvr_control0); | |
cc9203bf DW |
2065 | udelay(AFE_REGISTER_WRITE_DELAY); |
2066 | ||
2067 | /* Leave DFE/FFE on */ | |
dc00c8b6 | 2068 | if (is_a2(pdev)) |
2e5da889 | 2069 | writel(0x3F11103F, &xcvr->afe_rx_ssc_control0); |
dc00c8b6 | 2070 | else if (is_b0(pdev)) { |
2e5da889 | 2071 | writel(0x3F11103F, &xcvr->afe_rx_ssc_control0); |
cc9203bf | 2072 | udelay(AFE_REGISTER_WRITE_DELAY); |
dbb0743a | 2073 | /* Enable TX equalization (0xe824) */ |
2e5da889 | 2074 | writel(0x00040000, &xcvr->afe_tx_control); |
afd13a1f JS |
2075 | } else if (is_c0(pdev)) { |
2076 | writel(0x01400C0F, &xcvr->afe_rx_ssc_control1); | |
dbb0743a AG |
2077 | udelay(AFE_REGISTER_WRITE_DELAY); |
2078 | ||
2e5da889 | 2079 | writel(0x3F6F103F, &xcvr->afe_rx_ssc_control0); |
dbb0743a | 2080 | udelay(AFE_REGISTER_WRITE_DELAY); |
afd13a1f JS |
2081 | |
2082 | /* Enable TX equalization (0xe824) */ | |
2083 | writel(0x00040000, &xcvr->afe_tx_control); | |
2084 | } else if (is_c1(pdev)) { | |
2085 | writel(cable_length_long ? 0x01500C0C : | |
2086 | cable_length_medium ? 0x01400C0D : 0x02400C0D, | |
2087 | &xcvr->afe_xcvr_control1); | |
2088 | udelay(AFE_REGISTER_WRITE_DELAY); | |
2089 | ||
2090 | writel(0x000003E0, &xcvr->afe_dfx_rx_control1); | |
2091 | udelay(AFE_REGISTER_WRITE_DELAY); | |
2092 | ||
2093 | writel(cable_length_long ? 0x33091C1F : | |
2094 | cable_length_medium ? 0x3315181F : 0x2B17161F, | |
2095 | &xcvr->afe_rx_ssc_control0); | |
2096 | udelay(AFE_REGISTER_WRITE_DELAY); | |
dbb0743a | 2097 | |
cc9203bf | 2098 | /* Enable TX equalization (0xe824) */ |
2e5da889 | 2099 | writel(0x00040000, &xcvr->afe_tx_control); |
cc9203bf | 2100 | } |
dbb0743a | 2101 | |
cc9203bf DW |
2102 | udelay(AFE_REGISTER_WRITE_DELAY); |
2103 | ||
2e5da889 | 2104 | writel(oem_phy->afe_tx_amp_control0, &xcvr->afe_tx_amp_control0); |
cc9203bf DW |
2105 | udelay(AFE_REGISTER_WRITE_DELAY); |
2106 | ||
2e5da889 | 2107 | writel(oem_phy->afe_tx_amp_control1, &xcvr->afe_tx_amp_control1); |
cc9203bf DW |
2108 | udelay(AFE_REGISTER_WRITE_DELAY); |
2109 | ||
2e5da889 | 2110 | writel(oem_phy->afe_tx_amp_control2, &xcvr->afe_tx_amp_control2); |
cc9203bf DW |
2111 | udelay(AFE_REGISTER_WRITE_DELAY); |
2112 | ||
2e5da889 | 2113 | writel(oem_phy->afe_tx_amp_control3, &xcvr->afe_tx_amp_control3); |
cc9203bf DW |
2114 | udelay(AFE_REGISTER_WRITE_DELAY); |
2115 | } | |
2116 | ||
2117 | /* Transfer control to the PEs */ | |
2e5da889 | 2118 | writel(0x00010f00, &afe->afe_dfx_master_control0); |
cc9203bf DW |
2119 | udelay(AFE_REGISTER_WRITE_DELAY); |
2120 | } | |
2121 | ||
89a7301f | 2122 | static void sci_controller_initialize_power_control(struct isci_host *ihost) |
cc9203bf | 2123 | { |
d9dcb4ba | 2124 | sci_init_timer(&ihost->power_control.timer, power_control_timeout); |
cc9203bf | 2125 | |
d9dcb4ba DW |
2126 | memset(ihost->power_control.requesters, 0, |
2127 | sizeof(ihost->power_control.requesters)); | |
cc9203bf | 2128 | |
d9dcb4ba DW |
2129 | ihost->power_control.phys_waiting = 0; |
2130 | ihost->power_control.phys_granted_power = 0; | |
cc9203bf DW |
2131 | } |
2132 | ||
89a7301f | 2133 | static enum sci_status sci_controller_initialize(struct isci_host *ihost) |
cc9203bf | 2134 | { |
d9dcb4ba | 2135 | struct sci_base_state_machine *sm = &ihost->sm; |
7c78da31 DW |
2136 | enum sci_status result = SCI_FAILURE; |
2137 | unsigned long i, state, val; | |
cc9203bf | 2138 | |
d9dcb4ba | 2139 | if (ihost->sm.current_state_id != SCIC_RESET) { |
14e99b4a DW |
2140 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
2141 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
2142 | return SCI_FAILURE_INVALID_STATE; |
2143 | } | |
2144 | ||
e301370a | 2145 | sci_change_state(sm, SCIC_INITIALIZING); |
cc9203bf | 2146 | |
d9dcb4ba | 2147 | sci_init_timer(&ihost->phy_timer, phy_startup_timeout); |
bb3dbdf6 | 2148 | |
d9dcb4ba DW |
2149 | ihost->next_phy_to_start = 0; |
2150 | ihost->phy_startup_timer_pending = false; | |
cc9203bf | 2151 | |
89a7301f | 2152 | sci_controller_initialize_power_control(ihost); |
cc9203bf DW |
2153 | |
2154 | /* | |
2155 | * There is nothing to do here for B0 since we do not have to | |
2156 | * program the AFE registers. | |
2157 | * / @todo The AFE settings are supposed to be correct for the B0 but | |
2158 | * / presently they seem to be wrong. */ | |
89a7301f | 2159 | sci_controller_afe_initialization(ihost); |
cc9203bf | 2160 | |
cc9203bf | 2161 | |
7c78da31 | 2162 | /* Take the hardware out of reset */ |
d9dcb4ba | 2163 | writel(0, &ihost->smu_registers->soft_reset_control); |
cc9203bf | 2164 | |
7c78da31 DW |
2165 | /* |
2166 | * / @todo Provide meaningfull error code for hardware failure | |
2167 | * result = SCI_FAILURE_CONTROLLER_HARDWARE; */ | |
2168 | for (i = 100; i >= 1; i--) { | |
2169 | u32 status; | |
cc9203bf | 2170 | |
7c78da31 DW |
2171 | /* Loop until the hardware reports success */ |
2172 | udelay(SCU_CONTEXT_RAM_INIT_STALL_TIME); | |
d9dcb4ba | 2173 | status = readl(&ihost->smu_registers->control_status); |
cc9203bf | 2174 | |
7c78da31 DW |
2175 | if ((status & SCU_RAM_INIT_COMPLETED) == SCU_RAM_INIT_COMPLETED) |
2176 | break; | |
2177 | } | |
2178 | if (i == 0) | |
2179 | goto out; | |
cc9203bf | 2180 | |
7c78da31 DW |
2181 | /* |
2182 | * Determine what are the actaul device capacities that the | |
2183 | * hardware will support */ | |
d9dcb4ba | 2184 | val = readl(&ihost->smu_registers->device_context_capacity); |
cc9203bf | 2185 | |
7c78da31 | 2186 | /* Record the smaller of the two capacity values */ |
d9dcb4ba DW |
2187 | ihost->logical_port_entries = min(smu_max_ports(val), SCI_MAX_PORTS); |
2188 | ihost->task_context_entries = min(smu_max_task_contexts(val), SCI_MAX_IO_REQUESTS); | |
2189 | ihost->remote_node_entries = min(smu_max_rncs(val), SCI_MAX_REMOTE_DEVICES); | |
cc9203bf | 2190 | |
7c78da31 DW |
2191 | /* |
2192 | * Make all PEs that are unassigned match up with the | |
2193 | * logical ports | |
2194 | */ | |
d9dcb4ba | 2195 | for (i = 0; i < ihost->logical_port_entries; i++) { |
7c78da31 | 2196 | struct scu_port_task_scheduler_group_registers __iomem |
d9dcb4ba | 2197 | *ptsg = &ihost->scu_registers->peg0.ptsg; |
cc9203bf | 2198 | |
7c78da31 | 2199 | writel(i, &ptsg->protocol_engine[i]); |
cc9203bf DW |
2200 | } |
2201 | ||
2202 | /* Initialize hardware PCI Relaxed ordering in DMA engines */ | |
d9dcb4ba | 2203 | val = readl(&ihost->scu_registers->sdma.pdma_configuration); |
7c78da31 | 2204 | val |= SCU_PDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE); |
d9dcb4ba | 2205 | writel(val, &ihost->scu_registers->sdma.pdma_configuration); |
7c78da31 | 2206 | |
d9dcb4ba | 2207 | val = readl(&ihost->scu_registers->sdma.cdma_configuration); |
7c78da31 | 2208 | val |= SCU_CDMACR_GEN_BIT(PCI_RELAXED_ORDERING_ENABLE); |
d9dcb4ba | 2209 | writel(val, &ihost->scu_registers->sdma.cdma_configuration); |
cc9203bf DW |
2210 | |
2211 | /* | |
2212 | * Initialize the PHYs before the PORTs because the PHY registers | |
2213 | * are accessed during the port initialization. | |
2214 | */ | |
7c78da31 | 2215 | for (i = 0; i < SCI_MAX_PHYS; i++) { |
89a7301f DW |
2216 | result = sci_phy_initialize(&ihost->phys[i], |
2217 | &ihost->scu_registers->peg0.pe[i].tl, | |
2218 | &ihost->scu_registers->peg0.pe[i].ll); | |
7c78da31 DW |
2219 | if (result != SCI_SUCCESS) |
2220 | goto out; | |
cc9203bf DW |
2221 | } |
2222 | ||
d9dcb4ba | 2223 | for (i = 0; i < ihost->logical_port_entries; i++) { |
89a7301f | 2224 | struct isci_port *iport = &ihost->ports[i]; |
7c78da31 | 2225 | |
89a7301f DW |
2226 | iport->port_task_scheduler_registers = &ihost->scu_registers->peg0.ptsg.port[i]; |
2227 | iport->port_pe_configuration_register = &ihost->scu_registers->peg0.ptsg.protocol_engine[0]; | |
2228 | iport->viit_registers = &ihost->scu_registers->peg0.viit[i]; | |
cc9203bf DW |
2229 | } |
2230 | ||
89a7301f | 2231 | result = sci_port_configuration_agent_initialize(ihost, &ihost->port_agent); |
cc9203bf | 2232 | |
7c78da31 | 2233 | out: |
cc9203bf DW |
2234 | /* Advance the controller state machine */ |
2235 | if (result == SCI_SUCCESS) | |
e301370a | 2236 | state = SCIC_INITIALIZED; |
cc9203bf | 2237 | else |
e301370a EN |
2238 | state = SCIC_FAILED; |
2239 | sci_change_state(sm, state); | |
cc9203bf DW |
2240 | |
2241 | return result; | |
2242 | } | |
2243 | ||
abec912d | 2244 | static int sci_controller_dma_alloc(struct isci_host *ihost) |
cc9203bf | 2245 | { |
d9dcb4ba | 2246 | struct device *dev = &ihost->pdev->dev; |
7c78da31 | 2247 | size_t size; |
abec912d DW |
2248 | int i; |
2249 | ||
2250 | /* detect re-initialization */ | |
2251 | if (ihost->completion_queue) | |
2252 | return 0; | |
cc9203bf | 2253 | |
7c78da31 | 2254 | size = SCU_MAX_COMPLETION_QUEUE_ENTRIES * sizeof(u32); |
abec912d DW |
2255 | ihost->completion_queue = dmam_alloc_coherent(dev, size, &ihost->cq_dma, |
2256 | GFP_KERNEL); | |
d9dcb4ba | 2257 | if (!ihost->completion_queue) |
cc9203bf DW |
2258 | return -ENOMEM; |
2259 | ||
d9dcb4ba | 2260 | size = ihost->remote_node_entries * sizeof(union scu_remote_node_context); |
abec912d | 2261 | ihost->remote_node_context_table = dmam_alloc_coherent(dev, size, &ihost->rnc_dma, |
89a7301f | 2262 | GFP_KERNEL); |
abec912d | 2263 | |
d9dcb4ba | 2264 | if (!ihost->remote_node_context_table) |
cc9203bf DW |
2265 | return -ENOMEM; |
2266 | ||
d9dcb4ba | 2267 | size = ihost->task_context_entries * sizeof(struct scu_task_context), |
abec912d DW |
2268 | ihost->task_context_table = dmam_alloc_coherent(dev, size, &ihost->tc_dma, |
2269 | GFP_KERNEL); | |
d9dcb4ba | 2270 | if (!ihost->task_context_table) |
cc9203bf DW |
2271 | return -ENOMEM; |
2272 | ||
abec912d DW |
2273 | size = SCI_UFI_TOTAL_SIZE; |
2274 | ihost->ufi_buf = dmam_alloc_coherent(dev, size, &ihost->ufi_dma, GFP_KERNEL); | |
2275 | if (!ihost->ufi_buf) | |
2276 | return -ENOMEM; | |
2277 | ||
2278 | for (i = 0; i < SCI_MAX_IO_REQUESTS; i++) { | |
2279 | struct isci_request *ireq; | |
2280 | dma_addr_t dma; | |
2281 | ||
2282 | ireq = dmam_alloc_coherent(dev, sizeof(*ireq), &dma, GFP_KERNEL); | |
2283 | if (!ireq) | |
2284 | return -ENOMEM; | |
2285 | ||
2286 | ireq->tc = &ihost->task_context_table[i]; | |
2287 | ireq->owning_controller = ihost; | |
abec912d DW |
2288 | ireq->request_daddr = dma; |
2289 | ireq->isci_host = ihost; | |
2290 | ihost->reqs[i] = ireq; | |
2291 | } | |
2292 | ||
2293 | return 0; | |
2294 | } | |
2295 | ||
2296 | static int sci_controller_mem_init(struct isci_host *ihost) | |
2297 | { | |
2298 | int err = sci_controller_dma_alloc(ihost); | |
cc9203bf | 2299 | |
7c78da31 DW |
2300 | if (err) |
2301 | return err; | |
cc9203bf | 2302 | |
abec912d DW |
2303 | writel(lower_32_bits(ihost->cq_dma), &ihost->smu_registers->completion_queue_lower); |
2304 | writel(upper_32_bits(ihost->cq_dma), &ihost->smu_registers->completion_queue_upper); | |
2305 | ||
2306 | writel(lower_32_bits(ihost->rnc_dma), &ihost->smu_registers->remote_node_context_lower); | |
2307 | writel(upper_32_bits(ihost->rnc_dma), &ihost->smu_registers->remote_node_context_upper); | |
2308 | ||
2309 | writel(lower_32_bits(ihost->tc_dma), &ihost->smu_registers->host_task_table_lower); | |
2310 | writel(upper_32_bits(ihost->tc_dma), &ihost->smu_registers->host_task_table_upper); | |
2311 | ||
2312 | sci_unsolicited_frame_control_construct(ihost); | |
2313 | ||
cc9203bf DW |
2314 | /* |
2315 | * Inform the silicon as to the location of the UF headers and | |
2316 | * address table. | |
2317 | */ | |
d9dcb4ba DW |
2318 | writel(lower_32_bits(ihost->uf_control.headers.physical_address), |
2319 | &ihost->scu_registers->sdma.uf_header_base_address_lower); | |
2320 | writel(upper_32_bits(ihost->uf_control.headers.physical_address), | |
2321 | &ihost->scu_registers->sdma.uf_header_base_address_upper); | |
cc9203bf | 2322 | |
d9dcb4ba DW |
2323 | writel(lower_32_bits(ihost->uf_control.address_table.physical_address), |
2324 | &ihost->scu_registers->sdma.uf_address_table_lower); | |
2325 | writel(upper_32_bits(ihost->uf_control.address_table.physical_address), | |
2326 | &ihost->scu_registers->sdma.uf_address_table_upper); | |
cc9203bf DW |
2327 | |
2328 | return 0; | |
2329 | } | |
2330 | ||
abec912d DW |
2331 | /** |
2332 | * isci_host_init - (re-)initialize hardware and internal (private) state | |
2333 | * @ihost: host to init | |
2334 | * | |
2335 | * Any public facing objects (like asd_sas_port, and asd_sas_phys), or | |
2336 | * one-time initialization objects like locks and waitqueues, are | |
2337 | * not touched (they are initialized in isci_host_alloc) | |
2338 | */ | |
d9dcb4ba | 2339 | int isci_host_init(struct isci_host *ihost) |
6f231dda | 2340 | { |
abec912d | 2341 | int i, err; |
6f231dda | 2342 | enum sci_status status; |
6f231dda | 2343 | |
2396a265 | 2344 | spin_lock_irq(&ihost->scic_lock); |
abec912d | 2345 | status = sci_controller_construct(ihost, scu_base(ihost), smu_base(ihost)); |
2396a265 | 2346 | spin_unlock_irq(&ihost->scic_lock); |
6f231dda | 2347 | if (status != SCI_SUCCESS) { |
d9dcb4ba | 2348 | dev_err(&ihost->pdev->dev, |
89a7301f | 2349 | "%s: sci_controller_construct failed - status = %x\n", |
6f231dda DW |
2350 | __func__, |
2351 | status); | |
858d4aa7 | 2352 | return -ENODEV; |
6f231dda DW |
2353 | } |
2354 | ||
d9dcb4ba | 2355 | spin_lock_irq(&ihost->scic_lock); |
89a7301f | 2356 | status = sci_controller_initialize(ihost); |
d9dcb4ba | 2357 | spin_unlock_irq(&ihost->scic_lock); |
6f231dda | 2358 | if (status != SCI_SUCCESS) { |
d9dcb4ba | 2359 | dev_warn(&ihost->pdev->dev, |
89a7301f | 2360 | "%s: sci_controller_initialize failed -" |
6f231dda DW |
2361 | " status = 0x%x\n", |
2362 | __func__, status); | |
858d4aa7 | 2363 | return -ENODEV; |
6f231dda DW |
2364 | } |
2365 | ||
89a7301f | 2366 | err = sci_controller_mem_init(ihost); |
6f231dda | 2367 | if (err) |
858d4aa7 | 2368 | return err; |
6f231dda | 2369 | |
ad4f4c1d DW |
2370 | /* enable sgpio */ |
2371 | writel(1, &ihost->scu_registers->peg0.sgpio.interface_control); | |
2372 | for (i = 0; i < isci_gpio_count(ihost); i++) | |
2373 | writel(SGPIO_HW_CONTROL, &ihost->scu_registers->peg0.sgpio.output_data_select[i]); | |
2374 | writel(0, &ihost->scu_registers->peg0.sgpio.vendor_specific_code); | |
2375 | ||
858d4aa7 | 2376 | return 0; |
6f231dda | 2377 | } |
cc9203bf | 2378 | |
89a7301f DW |
2379 | void sci_controller_link_up(struct isci_host *ihost, struct isci_port *iport, |
2380 | struct isci_phy *iphy) | |
cc9203bf | 2381 | { |
d9dcb4ba | 2382 | switch (ihost->sm.current_state_id) { |
e301370a | 2383 | case SCIC_STARTING: |
d9dcb4ba DW |
2384 | sci_del_timer(&ihost->phy_timer); |
2385 | ihost->phy_startup_timer_pending = false; | |
2386 | ihost->port_agent.link_up_handler(ihost, &ihost->port_agent, | |
89a7301f DW |
2387 | iport, iphy); |
2388 | sci_controller_start_next_phy(ihost); | |
cc9203bf | 2389 | break; |
e301370a | 2390 | case SCIC_READY: |
d9dcb4ba | 2391 | ihost->port_agent.link_up_handler(ihost, &ihost->port_agent, |
89a7301f | 2392 | iport, iphy); |
cc9203bf DW |
2393 | break; |
2394 | default: | |
d9dcb4ba | 2395 | dev_dbg(&ihost->pdev->dev, |
cc9203bf | 2396 | "%s: SCIC Controller linkup event from phy %d in " |
85280955 | 2397 | "unexpected state %d\n", __func__, iphy->phy_index, |
d9dcb4ba | 2398 | ihost->sm.current_state_id); |
cc9203bf DW |
2399 | } |
2400 | } | |
2401 | ||
89a7301f DW |
2402 | void sci_controller_link_down(struct isci_host *ihost, struct isci_port *iport, |
2403 | struct isci_phy *iphy) | |
cc9203bf | 2404 | { |
d9dcb4ba | 2405 | switch (ihost->sm.current_state_id) { |
e301370a EN |
2406 | case SCIC_STARTING: |
2407 | case SCIC_READY: | |
d9dcb4ba | 2408 | ihost->port_agent.link_down_handler(ihost, &ihost->port_agent, |
ffe191c9 | 2409 | iport, iphy); |
cc9203bf DW |
2410 | break; |
2411 | default: | |
d9dcb4ba | 2412 | dev_dbg(&ihost->pdev->dev, |
cc9203bf DW |
2413 | "%s: SCIC Controller linkdown event from phy %d in " |
2414 | "unexpected state %d\n", | |
2415 | __func__, | |
85280955 | 2416 | iphy->phy_index, |
d9dcb4ba | 2417 | ihost->sm.current_state_id); |
cc9203bf DW |
2418 | } |
2419 | } | |
2420 | ||
eb608c3c | 2421 | bool sci_controller_has_remote_devices_stopping(struct isci_host *ihost) |
cc9203bf DW |
2422 | { |
2423 | u32 index; | |
2424 | ||
d9dcb4ba DW |
2425 | for (index = 0; index < ihost->remote_node_entries; index++) { |
2426 | if ((ihost->device_table[index] != NULL) && | |
2427 | (ihost->device_table[index]->sm.current_state_id == SCI_DEV_STOPPING)) | |
cc9203bf DW |
2428 | return true; |
2429 | } | |
2430 | ||
2431 | return false; | |
2432 | } | |
2433 | ||
89a7301f DW |
2434 | void sci_controller_remote_device_stopped(struct isci_host *ihost, |
2435 | struct isci_remote_device *idev) | |
cc9203bf | 2436 | { |
d9dcb4ba DW |
2437 | if (ihost->sm.current_state_id != SCIC_STOPPING) { |
2438 | dev_dbg(&ihost->pdev->dev, | |
cc9203bf DW |
2439 | "SCIC Controller 0x%p remote device stopped event " |
2440 | "from device 0x%p in unexpected state %d\n", | |
d9dcb4ba DW |
2441 | ihost, idev, |
2442 | ihost->sm.current_state_id); | |
cc9203bf DW |
2443 | return; |
2444 | } | |
2445 | ||
89a7301f | 2446 | if (!sci_controller_has_remote_devices_stopping(ihost)) |
eb608c3c | 2447 | isci_host_stop_complete(ihost); |
cc9203bf DW |
2448 | } |
2449 | ||
89a7301f | 2450 | void sci_controller_post_request(struct isci_host *ihost, u32 request) |
cc9203bf | 2451 | { |
89a7301f DW |
2452 | dev_dbg(&ihost->pdev->dev, "%s[%d]: %#x\n", |
2453 | __func__, ihost->id, request); | |
cc9203bf | 2454 | |
d9dcb4ba | 2455 | writel(request, &ihost->smu_registers->post_context_port); |
cc9203bf DW |
2456 | } |
2457 | ||
89a7301f | 2458 | struct isci_request *sci_request_by_tag(struct isci_host *ihost, u16 io_tag) |
cc9203bf DW |
2459 | { |
2460 | u16 task_index; | |
2461 | u16 task_sequence; | |
2462 | ||
dd047c8e | 2463 | task_index = ISCI_TAG_TCI(io_tag); |
cc9203bf | 2464 | |
d9dcb4ba DW |
2465 | if (task_index < ihost->task_context_entries) { |
2466 | struct isci_request *ireq = ihost->reqs[task_index]; | |
db056250 DW |
2467 | |
2468 | if (test_bit(IREQ_ACTIVE, &ireq->flags)) { | |
dd047c8e | 2469 | task_sequence = ISCI_TAG_SEQ(io_tag); |
cc9203bf | 2470 | |
d9dcb4ba | 2471 | if (task_sequence == ihost->io_request_sequence[task_index]) |
5076a1a9 | 2472 | return ireq; |
cc9203bf DW |
2473 | } |
2474 | } | |
2475 | ||
2476 | return NULL; | |
2477 | } | |
2478 | ||
2479 | /** | |
44b7ca96 | 2480 | * sci_controller_allocate_remote_node_context() |
cc9203bf DW |
2481 | * This method allocates remote node index and the reserves the remote node |
2482 | * context space for use. This method can fail if there are no more remote | |
2483 | * node index available. | |
44b7ca96 | 2484 | * @ihost: This is the controller object which contains the set of |
cc9203bf | 2485 | * free remote node ids |
44b7ca96 | 2486 | * @idev: This is the device object which is requesting the a remote node |
cc9203bf DW |
2487 | * id |
2488 | * @node_id: This is the remote node id that is assinged to the device if one | |
2489 | * is available | |
2490 | * | |
2491 | * enum sci_status SCI_FAILURE_OUT_OF_RESOURCES if there are no available remote | |
2492 | * node index available. | |
2493 | */ | |
89a7301f DW |
2494 | enum sci_status sci_controller_allocate_remote_node_context(struct isci_host *ihost, |
2495 | struct isci_remote_device *idev, | |
2496 | u16 *node_id) | |
cc9203bf DW |
2497 | { |
2498 | u16 node_index; | |
89a7301f | 2499 | u32 remote_node_count = sci_remote_device_node_count(idev); |
cc9203bf | 2500 | |
89a7301f | 2501 | node_index = sci_remote_node_table_allocate_remote_node( |
d9dcb4ba | 2502 | &ihost->available_remote_nodes, remote_node_count |
cc9203bf DW |
2503 | ); |
2504 | ||
2505 | if (node_index != SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX) { | |
d9dcb4ba | 2506 | ihost->device_table[node_index] = idev; |
cc9203bf DW |
2507 | |
2508 | *node_id = node_index; | |
2509 | ||
2510 | return SCI_SUCCESS; | |
2511 | } | |
2512 | ||
2513 | return SCI_FAILURE_INSUFFICIENT_RESOURCES; | |
2514 | } | |
2515 | ||
89a7301f DW |
2516 | void sci_controller_free_remote_node_context(struct isci_host *ihost, |
2517 | struct isci_remote_device *idev, | |
2518 | u16 node_id) | |
cc9203bf | 2519 | { |
89a7301f | 2520 | u32 remote_node_count = sci_remote_device_node_count(idev); |
cc9203bf | 2521 | |
d9dcb4ba DW |
2522 | if (ihost->device_table[node_id] == idev) { |
2523 | ihost->device_table[node_id] = NULL; | |
cc9203bf | 2524 | |
89a7301f | 2525 | sci_remote_node_table_release_remote_node_index( |
d9dcb4ba | 2526 | &ihost->available_remote_nodes, remote_node_count, node_id |
cc9203bf DW |
2527 | ); |
2528 | } | |
2529 | } | |
2530 | ||
89a7301f DW |
2531 | void sci_controller_copy_sata_response(void *response_buffer, |
2532 | void *frame_header, | |
2533 | void *frame_buffer) | |
cc9203bf | 2534 | { |
89a7301f | 2535 | /* XXX type safety? */ |
cc9203bf DW |
2536 | memcpy(response_buffer, frame_header, sizeof(u32)); |
2537 | ||
2538 | memcpy(response_buffer + sizeof(u32), | |
2539 | frame_buffer, | |
2540 | sizeof(struct dev_to_host_fis) - sizeof(u32)); | |
2541 | } | |
2542 | ||
89a7301f | 2543 | void sci_controller_release_frame(struct isci_host *ihost, u32 frame_index) |
cc9203bf | 2544 | { |
89a7301f | 2545 | if (sci_unsolicited_frame_control_release_frame(&ihost->uf_control, frame_index)) |
d9dcb4ba DW |
2546 | writel(ihost->uf_control.get, |
2547 | &ihost->scu_registers->sdma.unsolicited_frame_get_pointer); | |
cc9203bf DW |
2548 | } |
2549 | ||
312e0c24 DW |
2550 | void isci_tci_free(struct isci_host *ihost, u16 tci) |
2551 | { | |
2552 | u16 tail = ihost->tci_tail & (SCI_MAX_IO_REQUESTS-1); | |
2553 | ||
2554 | ihost->tci_pool[tail] = tci; | |
2555 | ihost->tci_tail = tail + 1; | |
2556 | } | |
2557 | ||
2558 | static u16 isci_tci_alloc(struct isci_host *ihost) | |
2559 | { | |
2560 | u16 head = ihost->tci_head & (SCI_MAX_IO_REQUESTS-1); | |
2561 | u16 tci = ihost->tci_pool[head]; | |
2562 | ||
2563 | ihost->tci_head = head + 1; | |
2564 | return tci; | |
2565 | } | |
2566 | ||
2567 | static u16 isci_tci_space(struct isci_host *ihost) | |
2568 | { | |
2569 | return CIRC_SPACE(ihost->tci_head, ihost->tci_tail, SCI_MAX_IO_REQUESTS); | |
2570 | } | |
2571 | ||
2572 | u16 isci_alloc_tag(struct isci_host *ihost) | |
2573 | { | |
2574 | if (isci_tci_space(ihost)) { | |
2575 | u16 tci = isci_tci_alloc(ihost); | |
d9dcb4ba | 2576 | u8 seq = ihost->io_request_sequence[tci]; |
312e0c24 DW |
2577 | |
2578 | return ISCI_TAG(seq, tci); | |
2579 | } | |
2580 | ||
2581 | return SCI_CONTROLLER_INVALID_IO_TAG; | |
2582 | } | |
2583 | ||
2584 | enum sci_status isci_free_tag(struct isci_host *ihost, u16 io_tag) | |
2585 | { | |
312e0c24 DW |
2586 | u16 tci = ISCI_TAG_TCI(io_tag); |
2587 | u16 seq = ISCI_TAG_SEQ(io_tag); | |
2588 | ||
2589 | /* prevent tail from passing head */ | |
2590 | if (isci_tci_active(ihost) == 0) | |
2591 | return SCI_FAILURE_INVALID_IO_TAG; | |
2592 | ||
d9dcb4ba DW |
2593 | if (seq == ihost->io_request_sequence[tci]) { |
2594 | ihost->io_request_sequence[tci] = (seq+1) & (SCI_MAX_SEQ-1); | |
312e0c24 DW |
2595 | |
2596 | isci_tci_free(ihost, tci); | |
2597 | ||
2598 | return SCI_SUCCESS; | |
2599 | } | |
2600 | return SCI_FAILURE_INVALID_IO_TAG; | |
2601 | } | |
2602 | ||
89a7301f DW |
2603 | enum sci_status sci_controller_start_io(struct isci_host *ihost, |
2604 | struct isci_remote_device *idev, | |
2605 | struct isci_request *ireq) | |
cc9203bf DW |
2606 | { |
2607 | enum sci_status status; | |
2608 | ||
d9dcb4ba | 2609 | if (ihost->sm.current_state_id != SCIC_READY) { |
14e99b4a DW |
2610 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
2611 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
2612 | return SCI_FAILURE_INVALID_STATE; |
2613 | } | |
2614 | ||
89a7301f | 2615 | status = sci_remote_device_start_io(ihost, idev, ireq); |
cc9203bf DW |
2616 | if (status != SCI_SUCCESS) |
2617 | return status; | |
2618 | ||
5076a1a9 | 2619 | set_bit(IREQ_ACTIVE, &ireq->flags); |
34a99158 | 2620 | sci_controller_post_request(ihost, ireq->post_context); |
cc9203bf DW |
2621 | return SCI_SUCCESS; |
2622 | } | |
2623 | ||
89a7301f DW |
2624 | enum sci_status sci_controller_terminate_request(struct isci_host *ihost, |
2625 | struct isci_remote_device *idev, | |
2626 | struct isci_request *ireq) | |
cc9203bf | 2627 | { |
89a7301f DW |
2628 | /* terminate an ongoing (i.e. started) core IO request. This does not |
2629 | * abort the IO request at the target, but rather removes the IO | |
2630 | * request from the host controller. | |
2631 | */ | |
cc9203bf DW |
2632 | enum sci_status status; |
2633 | ||
d9dcb4ba | 2634 | if (ihost->sm.current_state_id != SCIC_READY) { |
14e99b4a DW |
2635 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
2636 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
2637 | return SCI_FAILURE_INVALID_STATE; |
2638 | } | |
89a7301f | 2639 | status = sci_io_request_terminate(ireq); |
14aaa9f0 JS |
2640 | |
2641 | dev_dbg(&ihost->pdev->dev, "%s: status=%d; ireq=%p; flags=%lx\n", | |
2642 | __func__, status, ireq, ireq->flags); | |
2643 | ||
726980d5 JS |
2644 | if ((status == SCI_SUCCESS) && |
2645 | !test_bit(IREQ_PENDING_ABORT, &ireq->flags) && | |
2646 | !test_and_set_bit(IREQ_TC_ABORT_POSTED, &ireq->flags)) { | |
2647 | /* Utilize the original post context command and or in the | |
2648 | * POST_TC_ABORT request sub-type. | |
2649 | */ | |
2650 | sci_controller_post_request( | |
2651 | ihost, ireq->post_context | | |
2652 | SCU_CONTEXT_COMMAND_REQUEST_POST_TC_ABORT); | |
2653 | } | |
2654 | return status; | |
cc9203bf DW |
2655 | } |
2656 | ||
2657 | /** | |
89a7301f | 2658 | * sci_controller_complete_io() - This method will perform core specific |
cc9203bf DW |
2659 | * completion operations for an IO request. After this method is invoked, |
2660 | * the user should consider the IO request as invalid until it is properly | |
2661 | * reused (i.e. re-constructed). | |
89a7301f | 2662 | * @ihost: The handle to the controller object for which to complete the |
cc9203bf | 2663 | * IO request. |
89a7301f | 2664 | * @idev: The handle to the remote device object for which to complete |
cc9203bf | 2665 | * the IO request. |
89a7301f | 2666 | * @ireq: the handle to the io request object to complete. |
cc9203bf | 2667 | */ |
89a7301f DW |
2668 | enum sci_status sci_controller_complete_io(struct isci_host *ihost, |
2669 | struct isci_remote_device *idev, | |
2670 | struct isci_request *ireq) | |
cc9203bf DW |
2671 | { |
2672 | enum sci_status status; | |
cc9203bf | 2673 | |
d9dcb4ba | 2674 | switch (ihost->sm.current_state_id) { |
e301370a | 2675 | case SCIC_STOPPING: |
cc9203bf DW |
2676 | /* XXX: Implement this function */ |
2677 | return SCI_FAILURE; | |
e301370a | 2678 | case SCIC_READY: |
89a7301f | 2679 | status = sci_remote_device_complete_io(ihost, idev, ireq); |
cc9203bf DW |
2680 | if (status != SCI_SUCCESS) |
2681 | return status; | |
2682 | ||
5076a1a9 | 2683 | clear_bit(IREQ_ACTIVE, &ireq->flags); |
cc9203bf DW |
2684 | return SCI_SUCCESS; |
2685 | default: | |
14e99b4a DW |
2686 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
2687 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
2688 | return SCI_FAILURE_INVALID_STATE; |
2689 | } | |
2690 | ||
2691 | } | |
2692 | ||
89a7301f | 2693 | enum sci_status sci_controller_continue_io(struct isci_request *ireq) |
cc9203bf | 2694 | { |
d9dcb4ba | 2695 | struct isci_host *ihost = ireq->owning_controller; |
cc9203bf | 2696 | |
d9dcb4ba | 2697 | if (ihost->sm.current_state_id != SCIC_READY) { |
14e99b4a DW |
2698 | dev_warn(&ihost->pdev->dev, "%s invalid state: %d\n", |
2699 | __func__, ihost->sm.current_state_id); | |
cc9203bf DW |
2700 | return SCI_FAILURE_INVALID_STATE; |
2701 | } | |
2702 | ||
5076a1a9 | 2703 | set_bit(IREQ_ACTIVE, &ireq->flags); |
34a99158 | 2704 | sci_controller_post_request(ihost, ireq->post_context); |
cc9203bf DW |
2705 | return SCI_SUCCESS; |
2706 | } | |
2707 | ||
2708 | /** | |
89a7301f | 2709 | * sci_controller_start_task() - This method is called by the SCIC user to |
cc9203bf | 2710 | * send/start a framework task management request. |
44b7ca96 | 2711 | * @ihost: the handle to the controller object for which to start the task |
cc9203bf | 2712 | * management request. |
44b7ca96 | 2713 | * @idev: the handle to the remote device object for which to start |
cc9203bf | 2714 | * the task management request. |
44b7ca96 | 2715 | * @ireq: the handle to the task request object to start. |
cc9203bf | 2716 | */ |
362b5da3 NC |
2717 | enum sci_status sci_controller_start_task(struct isci_host *ihost, |
2718 | struct isci_remote_device *idev, | |
2719 | struct isci_request *ireq) | |
cc9203bf DW |
2720 | { |
2721 | enum sci_status status; | |
2722 | ||
d9dcb4ba DW |
2723 | if (ihost->sm.current_state_id != SCIC_READY) { |
2724 | dev_warn(&ihost->pdev->dev, | |
cc9203bf DW |
2725 | "%s: SCIC Controller starting task from invalid " |
2726 | "state\n", | |
2727 | __func__); | |
362b5da3 | 2728 | return SCI_FAILURE_INVALID_STATE; |
cc9203bf DW |
2729 | } |
2730 | ||
89a7301f | 2731 | status = sci_remote_device_start_task(ihost, idev, ireq); |
cc9203bf DW |
2732 | switch (status) { |
2733 | case SCI_FAILURE_RESET_DEVICE_PARTIAL_SUCCESS: | |
db056250 | 2734 | set_bit(IREQ_ACTIVE, &ireq->flags); |
cc9203bf DW |
2735 | |
2736 | /* | |
2737 | * We will let framework know this task request started successfully, | |
2738 | * although core is still woring on starting the request (to post tc when | |
2739 | * RNC is resumed.) | |
2740 | */ | |
2741 | return SCI_SUCCESS; | |
2742 | case SCI_SUCCESS: | |
db056250 | 2743 | set_bit(IREQ_ACTIVE, &ireq->flags); |
34a99158 | 2744 | sci_controller_post_request(ihost, ireq->post_context); |
cc9203bf DW |
2745 | break; |
2746 | default: | |
2747 | break; | |
2748 | } | |
2749 | ||
2750 | return status; | |
2751 | } | |
ad4f4c1d DW |
2752 | |
2753 | static int sci_write_gpio_tx_gp(struct isci_host *ihost, u8 reg_index, u8 reg_count, u8 *write_data) | |
2754 | { | |
2755 | int d; | |
2756 | ||
2757 | /* no support for TX_GP_CFG */ | |
2758 | if (reg_index == 0) | |
2759 | return -EINVAL; | |
2760 | ||
2761 | for (d = 0; d < isci_gpio_count(ihost); d++) { | |
2762 | u32 val = 0x444; /* all ODx.n clear */ | |
2763 | int i; | |
2764 | ||
2765 | for (i = 0; i < 3; i++) { | |
2976fbb6 | 2766 | int bit; |
ad4f4c1d DW |
2767 | |
2768 | bit = try_test_sas_gpio_gp_bit(to_sas_gpio_od(d, i), | |
2769 | write_data, reg_index, | |
2770 | reg_count); | |
2771 | if (bit < 0) | |
2772 | break; | |
2773 | ||
2774 | /* if od is set, clear the 'invert' bit */ | |
2775 | val &= ~(bit << ((i << 2) + 2)); | |
2776 | } | |
2777 | ||
2778 | if (i < 3) | |
2779 | break; | |
2780 | writel(val, &ihost->scu_registers->peg0.sgpio.output_data_select[d]); | |
2781 | } | |
2782 | ||
2783 | /* unless reg_index is > 1, we should always be able to write at | |
2784 | * least one register | |
2785 | */ | |
2786 | return d > 0; | |
2787 | } | |
2788 | ||
2789 | int isci_gpio_write(struct sas_ha_struct *sas_ha, u8 reg_type, u8 reg_index, | |
2790 | u8 reg_count, u8 *write_data) | |
2791 | { | |
2792 | struct isci_host *ihost = sas_ha->lldd_ha; | |
2793 | int written; | |
2794 | ||
2795 | switch (reg_type) { | |
2796 | case SAS_GPIO_REG_TX_GP: | |
2797 | written = sci_write_gpio_tx_gp(ihost, reg_index, reg_count, write_data); | |
2798 | break; | |
2799 | default: | |
2800 | written = -EINVAL; | |
2801 | } | |
2802 | ||
2803 | return written; | |
2804 | } |