1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40 #include <linux/slab.h>
41 #include "pm8001_sas.h"
42 #include "pm80xx_hwi.h"
43 #include "pm8001_chips.h"
44 #include "pm8001_ctl.h"
45
46#define SMP_DIRECT 1
47#define SMP_INDIRECT 2
48
49
50
51
52static void read_main_config_table(struct pm8001_hba_info *pm8001_ha)
53{
54 void __iomem *address = pm8001_ha->main_cfg_tbl_addr;
55
56 pm8001_ha->main_cfg_tbl.pm80xx_tbl.signature =
57 pm8001_mr32(address, MAIN_SIGNATURE_OFFSET);
58 pm8001_ha->main_cfg_tbl.pm80xx_tbl.interface_rev =
59 pm8001_mr32(address, MAIN_INTERFACE_REVISION);
60 pm8001_ha->main_cfg_tbl.pm80xx_tbl.firmware_rev =
61 pm8001_mr32(address, MAIN_FW_REVISION);
62 pm8001_ha->main_cfg_tbl.pm80xx_tbl.max_out_io =
63 pm8001_mr32(address, MAIN_MAX_OUTSTANDING_IO_OFFSET);
64 pm8001_ha->main_cfg_tbl.pm80xx_tbl.max_sgl =
65 pm8001_mr32(address, MAIN_MAX_SGL_OFFSET);
66 pm8001_ha->main_cfg_tbl.pm80xx_tbl.ctrl_cap_flag =
67 pm8001_mr32(address, MAIN_CNTRL_CAP_OFFSET);
68 pm8001_ha->main_cfg_tbl.pm80xx_tbl.gst_offset =
69 pm8001_mr32(address, MAIN_GST_OFFSET);
70 pm8001_ha->main_cfg_tbl.pm80xx_tbl.inbound_queue_offset =
71 pm8001_mr32(address, MAIN_IBQ_OFFSET);
72 pm8001_ha->main_cfg_tbl.pm80xx_tbl.outbound_queue_offset =
73 pm8001_mr32(address, MAIN_OBQ_OFFSET);
74
75
76 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_dump_offset0 =
77 pm8001_mr32(address, MAIN_FATAL_ERROR_RDUMP0_OFFSET);
78 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_dump_length0 =
79 pm8001_mr32(address, MAIN_FATAL_ERROR_RDUMP0_LENGTH);
80 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_dump_offset1 =
81 pm8001_mr32(address, MAIN_FATAL_ERROR_RDUMP1_OFFSET);
82 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_dump_length1 =
83 pm8001_mr32(address, MAIN_FATAL_ERROR_RDUMP1_LENGTH);
84
85
86 pm8001_ha->main_cfg_tbl.pm80xx_tbl.gpio_led_mapping =
87 pm8001_mr32(address, MAIN_GPIO_LED_FLAGS_OFFSET);
88
89
90 pm8001_ha->main_cfg_tbl.pm80xx_tbl.analog_setup_table_offset =
91 pm8001_mr32(address, MAIN_ANALOG_SETUP_OFFSET);
92
93 pm8001_ha->main_cfg_tbl.pm80xx_tbl.int_vec_table_offset =
94 pm8001_mr32(address, MAIN_INT_VECTOR_TABLE_OFFSET);
95 pm8001_ha->main_cfg_tbl.pm80xx_tbl.phy_attr_table_offset =
96 pm8001_mr32(address, MAIN_SAS_PHY_ATTR_TABLE_OFFSET);
97}
98
99
100
101
102
103static void read_general_status_table(struct pm8001_hba_info *pm8001_ha)
104{
105 void __iomem *address = pm8001_ha->general_stat_tbl_addr;
106 pm8001_ha->gs_tbl.pm80xx_tbl.gst_len_mpistate =
107 pm8001_mr32(address, GST_GSTLEN_MPIS_OFFSET);
108 pm8001_ha->gs_tbl.pm80xx_tbl.iq_freeze_state0 =
109 pm8001_mr32(address, GST_IQ_FREEZE_STATE0_OFFSET);
110 pm8001_ha->gs_tbl.pm80xx_tbl.iq_freeze_state1 =
111 pm8001_mr32(address, GST_IQ_FREEZE_STATE1_OFFSET);
112 pm8001_ha->gs_tbl.pm80xx_tbl.msgu_tcnt =
113 pm8001_mr32(address, GST_MSGUTCNT_OFFSET);
114 pm8001_ha->gs_tbl.pm80xx_tbl.iop_tcnt =
115 pm8001_mr32(address, GST_IOPTCNT_OFFSET);
116 pm8001_ha->gs_tbl.pm80xx_tbl.gpio_input_val =
117 pm8001_mr32(address, GST_GPIO_INPUT_VAL);
118 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[0] =
119 pm8001_mr32(address, GST_RERRINFO_OFFSET0);
120 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[1] =
121 pm8001_mr32(address, GST_RERRINFO_OFFSET1);
122 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[2] =
123 pm8001_mr32(address, GST_RERRINFO_OFFSET2);
124 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[3] =
125 pm8001_mr32(address, GST_RERRINFO_OFFSET3);
126 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[4] =
127 pm8001_mr32(address, GST_RERRINFO_OFFSET4);
128 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[5] =
129 pm8001_mr32(address, GST_RERRINFO_OFFSET5);
130 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[6] =
131 pm8001_mr32(address, GST_RERRINFO_OFFSET6);
132 pm8001_ha->gs_tbl.pm80xx_tbl.recover_err_info[7] =
133 pm8001_mr32(address, GST_RERRINFO_OFFSET7);
134}
135
136
137
138
139static void read_phy_attr_table(struct pm8001_hba_info *pm8001_ha)
140{
141 void __iomem *address = pm8001_ha->pspa_q_tbl_addr;
142 pm8001_ha->phy_attr_table.phystart1_16[0] =
143 pm8001_mr32(address, PSPA_PHYSTATE0_OFFSET);
144 pm8001_ha->phy_attr_table.phystart1_16[1] =
145 pm8001_mr32(address, PSPA_PHYSTATE1_OFFSET);
146 pm8001_ha->phy_attr_table.phystart1_16[2] =
147 pm8001_mr32(address, PSPA_PHYSTATE2_OFFSET);
148 pm8001_ha->phy_attr_table.phystart1_16[3] =
149 pm8001_mr32(address, PSPA_PHYSTATE3_OFFSET);
150 pm8001_ha->phy_attr_table.phystart1_16[4] =
151 pm8001_mr32(address, PSPA_PHYSTATE4_OFFSET);
152 pm8001_ha->phy_attr_table.phystart1_16[5] =
153 pm8001_mr32(address, PSPA_PHYSTATE5_OFFSET);
154 pm8001_ha->phy_attr_table.phystart1_16[6] =
155 pm8001_mr32(address, PSPA_PHYSTATE6_OFFSET);
156 pm8001_ha->phy_attr_table.phystart1_16[7] =
157 pm8001_mr32(address, PSPA_PHYSTATE7_OFFSET);
158 pm8001_ha->phy_attr_table.phystart1_16[8] =
159 pm8001_mr32(address, PSPA_PHYSTATE8_OFFSET);
160 pm8001_ha->phy_attr_table.phystart1_16[9] =
161 pm8001_mr32(address, PSPA_PHYSTATE9_OFFSET);
162 pm8001_ha->phy_attr_table.phystart1_16[10] =
163 pm8001_mr32(address, PSPA_PHYSTATE10_OFFSET);
164 pm8001_ha->phy_attr_table.phystart1_16[11] =
165 pm8001_mr32(address, PSPA_PHYSTATE11_OFFSET);
166 pm8001_ha->phy_attr_table.phystart1_16[12] =
167 pm8001_mr32(address, PSPA_PHYSTATE12_OFFSET);
168 pm8001_ha->phy_attr_table.phystart1_16[13] =
169 pm8001_mr32(address, PSPA_PHYSTATE13_OFFSET);
170 pm8001_ha->phy_attr_table.phystart1_16[14] =
171 pm8001_mr32(address, PSPA_PHYSTATE14_OFFSET);
172 pm8001_ha->phy_attr_table.phystart1_16[15] =
173 pm8001_mr32(address, PSPA_PHYSTATE15_OFFSET);
174
175 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[0] =
176 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID0_OFFSET);
177 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[1] =
178 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID1_OFFSET);
179 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[2] =
180 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID2_OFFSET);
181 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[3] =
182 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID3_OFFSET);
183 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[4] =
184 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID4_OFFSET);
185 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[5] =
186 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID5_OFFSET);
187 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[6] =
188 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID6_OFFSET);
189 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[7] =
190 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID7_OFFSET);
191 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[8] =
192 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID8_OFFSET);
193 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[9] =
194 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID9_OFFSET);
195 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[10] =
196 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID10_OFFSET);
197 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[11] =
198 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID11_OFFSET);
199 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[12] =
200 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID12_OFFSET);
201 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[13] =
202 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID13_OFFSET);
203 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[14] =
204 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID14_OFFSET);
205 pm8001_ha->phy_attr_table.outbound_hw_event_pid1_16[15] =
206 pm8001_mr32(address, PSPA_OB_HW_EVENT_PID15_OFFSET);
207
208}
209
210
211
212
213
214static void read_inbnd_queue_table(struct pm8001_hba_info *pm8001_ha)
215{
216 int i;
217 void __iomem *address = pm8001_ha->inbnd_q_tbl_addr;
218 for (i = 0; i < PM8001_MAX_SPCV_INB_NUM; i++) {
219 u32 offset = i * 0x20;
220 pm8001_ha->inbnd_q_tbl[i].pi_pci_bar =
221 get_pci_bar_index(pm8001_mr32(address,
222 (offset + IB_PIPCI_BAR)));
223 pm8001_ha->inbnd_q_tbl[i].pi_offset =
224 pm8001_mr32(address, (offset + IB_PIPCI_BAR_OFFSET));
225 }
226}
227
228
229
230
231
232static void read_outbnd_queue_table(struct pm8001_hba_info *pm8001_ha)
233{
234 int i;
235 void __iomem *address = pm8001_ha->outbnd_q_tbl_addr;
236 for (i = 0; i < PM8001_MAX_SPCV_OUTB_NUM; i++) {
237 u32 offset = i * 0x24;
238 pm8001_ha->outbnd_q_tbl[i].ci_pci_bar =
239 get_pci_bar_index(pm8001_mr32(address,
240 (offset + OB_CIPCI_BAR)));
241 pm8001_ha->outbnd_q_tbl[i].ci_offset =
242 pm8001_mr32(address, (offset + OB_CIPCI_BAR_OFFSET));
243 }
244}
245
246
247
248
249
250static void init_default_table_values(struct pm8001_hba_info *pm8001_ha)
251{
252 int i;
253 u32 offsetib, offsetob;
254 void __iomem *addressib = pm8001_ha->inbnd_q_tbl_addr;
255 void __iomem *addressob = pm8001_ha->outbnd_q_tbl_addr;
256
257 pm8001_ha->main_cfg_tbl.pm80xx_tbl.upper_event_log_addr =
258 pm8001_ha->memoryMap.region[AAP1].phys_addr_hi;
259 pm8001_ha->main_cfg_tbl.pm80xx_tbl.lower_event_log_addr =
260 pm8001_ha->memoryMap.region[AAP1].phys_addr_lo;
261 pm8001_ha->main_cfg_tbl.pm80xx_tbl.event_log_size =
262 PM8001_EVENT_LOG_SIZE;
263 pm8001_ha->main_cfg_tbl.pm80xx_tbl.event_log_severity = 0x01;
264 pm8001_ha->main_cfg_tbl.pm80xx_tbl.upper_pcs_event_log_addr =
265 pm8001_ha->memoryMap.region[IOP].phys_addr_hi;
266 pm8001_ha->main_cfg_tbl.pm80xx_tbl.lower_pcs_event_log_addr =
267 pm8001_ha->memoryMap.region[IOP].phys_addr_lo;
268 pm8001_ha->main_cfg_tbl.pm80xx_tbl.pcs_event_log_size =
269 PM8001_EVENT_LOG_SIZE;
270 pm8001_ha->main_cfg_tbl.pm80xx_tbl.pcs_event_log_severity = 0x01;
271 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_interrupt = 0x01;
272
273
274 pm8001_ha->main_cfg_tbl.pm80xx_tbl.crc_core_dump = (0x1 << 16);
275
276 for (i = 0; i < PM8001_MAX_SPCV_INB_NUM; i++) {
277 pm8001_ha->inbnd_q_tbl[i].element_pri_size_cnt =
278 PM8001_MPI_QUEUE | (64 << 16) | (0x00<<30);
279 pm8001_ha->inbnd_q_tbl[i].upper_base_addr =
280 pm8001_ha->memoryMap.region[IB + i].phys_addr_hi;
281 pm8001_ha->inbnd_q_tbl[i].lower_base_addr =
282 pm8001_ha->memoryMap.region[IB + i].phys_addr_lo;
283 pm8001_ha->inbnd_q_tbl[i].base_virt =
284 (u8 *)pm8001_ha->memoryMap.region[IB + i].virt_ptr;
285 pm8001_ha->inbnd_q_tbl[i].total_length =
286 pm8001_ha->memoryMap.region[IB + i].total_len;
287 pm8001_ha->inbnd_q_tbl[i].ci_upper_base_addr =
288 pm8001_ha->memoryMap.region[CI + i].phys_addr_hi;
289 pm8001_ha->inbnd_q_tbl[i].ci_lower_base_addr =
290 pm8001_ha->memoryMap.region[CI + i].phys_addr_lo;
291 pm8001_ha->inbnd_q_tbl[i].ci_virt =
292 pm8001_ha->memoryMap.region[CI + i].virt_ptr;
293 offsetib = i * 0x20;
294 pm8001_ha->inbnd_q_tbl[i].pi_pci_bar =
295 get_pci_bar_index(pm8001_mr32(addressib,
296 (offsetib + 0x14)));
297 pm8001_ha->inbnd_q_tbl[i].pi_offset =
298 pm8001_mr32(addressib, (offsetib + 0x18));
299 pm8001_ha->inbnd_q_tbl[i].producer_idx = 0;
300 pm8001_ha->inbnd_q_tbl[i].consumer_index = 0;
301 }
302 for (i = 0; i < PM8001_MAX_SPCV_OUTB_NUM; i++) {
303 pm8001_ha->outbnd_q_tbl[i].element_size_cnt =
304 PM8001_MPI_QUEUE | (64 << 16) | (0x01<<30);
305 pm8001_ha->outbnd_q_tbl[i].upper_base_addr =
306 pm8001_ha->memoryMap.region[OB + i].phys_addr_hi;
307 pm8001_ha->outbnd_q_tbl[i].lower_base_addr =
308 pm8001_ha->memoryMap.region[OB + i].phys_addr_lo;
309 pm8001_ha->outbnd_q_tbl[i].base_virt =
310 (u8 *)pm8001_ha->memoryMap.region[OB + i].virt_ptr;
311 pm8001_ha->outbnd_q_tbl[i].total_length =
312 pm8001_ha->memoryMap.region[OB + i].total_len;
313 pm8001_ha->outbnd_q_tbl[i].pi_upper_base_addr =
314 pm8001_ha->memoryMap.region[PI + i].phys_addr_hi;
315 pm8001_ha->outbnd_q_tbl[i].pi_lower_base_addr =
316 pm8001_ha->memoryMap.region[PI + i].phys_addr_lo;
317
318 pm8001_ha->outbnd_q_tbl[i].interrup_vec_cnt_delay = (i << 24);
319 pm8001_ha->outbnd_q_tbl[i].pi_virt =
320 pm8001_ha->memoryMap.region[PI + i].virt_ptr;
321 offsetob = i * 0x24;
322 pm8001_ha->outbnd_q_tbl[i].ci_pci_bar =
323 get_pci_bar_index(pm8001_mr32(addressob,
324 offsetob + 0x14));
325 pm8001_ha->outbnd_q_tbl[i].ci_offset =
326 pm8001_mr32(addressob, (offsetob + 0x18));
327 pm8001_ha->outbnd_q_tbl[i].consumer_idx = 0;
328 pm8001_ha->outbnd_q_tbl[i].producer_index = 0;
329 }
330}
331
332
333
334
335
336static void update_main_config_table(struct pm8001_hba_info *pm8001_ha)
337{
338 void __iomem *address = pm8001_ha->main_cfg_tbl_addr;
339 pm8001_mw32(address, MAIN_IQNPPD_HPPD_OFFSET,
340 pm8001_ha->main_cfg_tbl.pm80xx_tbl.inbound_q_nppd_hppd);
341 pm8001_mw32(address, MAIN_EVENT_LOG_ADDR_HI,
342 pm8001_ha->main_cfg_tbl.pm80xx_tbl.upper_event_log_addr);
343 pm8001_mw32(address, MAIN_EVENT_LOG_ADDR_LO,
344 pm8001_ha->main_cfg_tbl.pm80xx_tbl.lower_event_log_addr);
345 pm8001_mw32(address, MAIN_EVENT_LOG_BUFF_SIZE,
346 pm8001_ha->main_cfg_tbl.pm80xx_tbl.event_log_size);
347 pm8001_mw32(address, MAIN_EVENT_LOG_OPTION,
348 pm8001_ha->main_cfg_tbl.pm80xx_tbl.event_log_severity);
349 pm8001_mw32(address, MAIN_PCS_EVENT_LOG_ADDR_HI,
350 pm8001_ha->main_cfg_tbl.pm80xx_tbl.upper_pcs_event_log_addr);
351 pm8001_mw32(address, MAIN_PCS_EVENT_LOG_ADDR_LO,
352 pm8001_ha->main_cfg_tbl.pm80xx_tbl.lower_pcs_event_log_addr);
353 pm8001_mw32(address, MAIN_PCS_EVENT_LOG_BUFF_SIZE,
354 pm8001_ha->main_cfg_tbl.pm80xx_tbl.pcs_event_log_size);
355 pm8001_mw32(address, MAIN_PCS_EVENT_LOG_OPTION,
356 pm8001_ha->main_cfg_tbl.pm80xx_tbl.pcs_event_log_severity);
357 pm8001_mw32(address, MAIN_FATAL_ERROR_INTERRUPT,
358 pm8001_ha->main_cfg_tbl.pm80xx_tbl.fatal_err_interrupt);
359 pm8001_mw32(address, MAIN_EVENT_CRC_CHECK,
360 pm8001_ha->main_cfg_tbl.pm80xx_tbl.crc_core_dump);
361
362
363 pm8001_ha->main_cfg_tbl.pm80xx_tbl.gpio_led_mapping &= 0xCFFFFFFF;
364
365 pm8001_ha->main_cfg_tbl.pm80xx_tbl.gpio_led_mapping |= 0x20000000;
366 pm8001_mw32(address, MAIN_GPIO_LED_FLAGS_OFFSET,
367 pm8001_ha->main_cfg_tbl.pm80xx_tbl.gpio_led_mapping);
368
369 pm8001_mw32(address, MAIN_PORT_RECOVERY_TIMER,
370 pm8001_ha->main_cfg_tbl.pm80xx_tbl.port_recovery_timer);
371 pm8001_mw32(address, MAIN_INT_REASSERTION_DELAY,
372 pm8001_ha->main_cfg_tbl.pm80xx_tbl.interrupt_reassertion_delay);
373}
374
375
376
377
378
379static void update_inbnd_queue_table(struct pm8001_hba_info *pm8001_ha,
380 int number)
381{
382 void __iomem *address = pm8001_ha->inbnd_q_tbl_addr;
383 u16 offset = number * 0x20;
384 pm8001_mw32(address, offset + IB_PROPERITY_OFFSET,
385 pm8001_ha->inbnd_q_tbl[number].element_pri_size_cnt);
386 pm8001_mw32(address, offset + IB_BASE_ADDR_HI_OFFSET,
387 pm8001_ha->inbnd_q_tbl[number].upper_base_addr);
388 pm8001_mw32(address, offset + IB_BASE_ADDR_LO_OFFSET,
389 pm8001_ha->inbnd_q_tbl[number].lower_base_addr);
390 pm8001_mw32(address, offset + IB_CI_BASE_ADDR_HI_OFFSET,
391 pm8001_ha->inbnd_q_tbl[number].ci_upper_base_addr);
392 pm8001_mw32(address, offset + IB_CI_BASE_ADDR_LO_OFFSET,
393 pm8001_ha->inbnd_q_tbl[number].ci_lower_base_addr);
394}
395
396
397
398
399
400static void update_outbnd_queue_table(struct pm8001_hba_info *pm8001_ha,
401 int number)
402{
403 void __iomem *address = pm8001_ha->outbnd_q_tbl_addr;
404 u16 offset = number * 0x24;
405 pm8001_mw32(address, offset + OB_PROPERITY_OFFSET,
406 pm8001_ha->outbnd_q_tbl[number].element_size_cnt);
407 pm8001_mw32(address, offset + OB_BASE_ADDR_HI_OFFSET,
408 pm8001_ha->outbnd_q_tbl[number].upper_base_addr);
409 pm8001_mw32(address, offset + OB_BASE_ADDR_LO_OFFSET,
410 pm8001_ha->outbnd_q_tbl[number].lower_base_addr);
411 pm8001_mw32(address, offset + OB_PI_BASE_ADDR_HI_OFFSET,
412 pm8001_ha->outbnd_q_tbl[number].pi_upper_base_addr);
413 pm8001_mw32(address, offset + OB_PI_BASE_ADDR_LO_OFFSET,
414 pm8001_ha->outbnd_q_tbl[number].pi_lower_base_addr);
415 pm8001_mw32(address, offset + OB_INTERRUPT_COALES_OFFSET,
416 pm8001_ha->outbnd_q_tbl[number].interrup_vec_cnt_delay);
417}
418
419
420
421
422
423static int mpi_init_check(struct pm8001_hba_info *pm8001_ha)
424{
425 u32 max_wait_count;
426 u32 value;
427 u32 gst_len_mpistate;
428
429
430
431 pm8001_cw32(pm8001_ha, 0, MSGU_IBDB_SET, SPCv_MSGU_CFG_TABLE_UPDATE);
432
433 max_wait_count = 2 * 1000 * 1000;
434 do {
435 udelay(1);
436 value = pm8001_cr32(pm8001_ha, 0, MSGU_IBDB_SET);
437 value &= SPCv_MSGU_CFG_TABLE_UPDATE;
438 } while ((value != 0) && (--max_wait_count));
439
440 if (!max_wait_count)
441 return -1;
442
443 max_wait_count = 100 * 1000;
444 do {
445 udelay(1);
446 gst_len_mpistate =
447 pm8001_mr32(pm8001_ha->general_stat_tbl_addr,
448 GST_GSTLEN_MPIS_OFFSET);
449 } while ((GST_MPI_STATE_INIT !=
450 (gst_len_mpistate & GST_MPI_STATE_MASK)) && (--max_wait_count));
451 if (!max_wait_count)
452 return -1;
453
454
455 gst_len_mpistate = gst_len_mpistate >> 16;
456 if (0x0000 != gst_len_mpistate)
457 return -1;
458
459 return 0;
460}
461
462
463
464
465
466static int check_fw_ready(struct pm8001_hba_info *pm8001_ha)
467{
468 u32 value;
469 u32 max_wait_count;
470 u32 max_wait_time;
471 int ret = 0;
472
473
474 max_wait_time = max_wait_count = 100 * 1000;
475 do {
476 udelay(1);
477 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1);
478 } while ((value == 0xFFFFFFFF) && (--max_wait_count));
479
480
481 max_wait_time = max_wait_count = 1000 * 1000;
482 do {
483 udelay(1);
484 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1);
485 } while (((value & SCRATCH_PAD_ILA_READY) !=
486 SCRATCH_PAD_ILA_READY) && (--max_wait_count));
487 if (!max_wait_count)
488 ret = -1;
489 else {
490 PM8001_MSG_DBG(pm8001_ha,
491 pm8001_printk(" ila ready status in %d millisec\n",
492 (max_wait_time - max_wait_count)));
493 }
494
495
496 max_wait_time = max_wait_count = 1800 * 1000;
497 do {
498 udelay(1);
499 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1);
500 } while (((value & SCRATCH_PAD_RAAE_READY) !=
501 SCRATCH_PAD_RAAE_READY) && (--max_wait_count));
502 if (!max_wait_count)
503 ret = -1;
504 else {
505 PM8001_MSG_DBG(pm8001_ha,
506 pm8001_printk(" raae ready status in %d millisec\n",
507 (max_wait_time - max_wait_count)));
508 }
509
510
511 max_wait_time = max_wait_count = 600 * 1000;
512 do {
513 udelay(1);
514 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1);
515 } while (((value & SCRATCH_PAD_IOP0_READY) != SCRATCH_PAD_IOP0_READY) &&
516 (--max_wait_count));
517 if (!max_wait_count)
518 ret = -1;
519 else {
520 PM8001_MSG_DBG(pm8001_ha,
521 pm8001_printk(" iop0 ready status in %d millisec\n",
522 (max_wait_time - max_wait_count)));
523 }
524
525
526 if ((pm8001_ha->chip_id != chip_8008) &&
527 (pm8001_ha->chip_id != chip_8009)) {
528
529 max_wait_time = max_wait_count = 200 * 1000;
530 do {
531 udelay(1);
532 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1);
533 } while (((value & SCRATCH_PAD_IOP1_READY) !=
534 SCRATCH_PAD_IOP1_READY) && (--max_wait_count));
535 if (!max_wait_count)
536 ret = -1;
537 else {
538 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
539 "iop1 ready status in %d millisec\n",
540 (max_wait_time - max_wait_count)));
541 }
542 }
543
544 return ret;
545}
546
547static void init_pci_device_addresses(struct pm8001_hba_info *pm8001_ha)
548{
549 void __iomem *base_addr;
550 u32 value;
551 u32 offset;
552 u32 pcibar;
553 u32 pcilogic;
554
555 value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_0);
556 offset = value & 0x03FFFFFF;
557
558 PM8001_INIT_DBG(pm8001_ha,
559 pm8001_printk("Scratchpad 0 Offset: 0x%x value 0x%x\n",
560 offset, value));
561 pcilogic = (value & 0xFC000000) >> 26;
562 pcibar = get_pci_bar_index(pcilogic);
563 PM8001_INIT_DBG(pm8001_ha,
564 pm8001_printk("Scratchpad 0 PCI BAR: %d\n", pcibar));
565 pm8001_ha->main_cfg_tbl_addr = base_addr =
566 pm8001_ha->io_mem[pcibar].memvirtaddr + offset;
567 pm8001_ha->general_stat_tbl_addr =
568 base_addr + (pm8001_cr32(pm8001_ha, pcibar, offset + 0x18) &
569 0xFFFFFF);
570 pm8001_ha->inbnd_q_tbl_addr =
571 base_addr + (pm8001_cr32(pm8001_ha, pcibar, offset + 0x1C) &
572 0xFFFFFF);
573 pm8001_ha->outbnd_q_tbl_addr =
574 base_addr + (pm8001_cr32(pm8001_ha, pcibar, offset + 0x20) &
575 0xFFFFFF);
576 pm8001_ha->ivt_tbl_addr =
577 base_addr + (pm8001_cr32(pm8001_ha, pcibar, offset + 0x8C) &
578 0xFFFFFF);
579 pm8001_ha->pspa_q_tbl_addr =
580 base_addr + (pm8001_cr32(pm8001_ha, pcibar, offset + 0x90) &
581 0xFFFFFF);
582
583 PM8001_INIT_DBG(pm8001_ha,
584 pm8001_printk("GST OFFSET 0x%x\n",
585 pm8001_cr32(pm8001_ha, pcibar, offset + 0x18)));
586 PM8001_INIT_DBG(pm8001_ha,
587 pm8001_printk("INBND OFFSET 0x%x\n",
588 pm8001_cr32(pm8001_ha, pcibar, offset + 0x1C)));
589 PM8001_INIT_DBG(pm8001_ha,
590 pm8001_printk("OBND OFFSET 0x%x\n",
591 pm8001_cr32(pm8001_ha, pcibar, offset + 0x20)));
592 PM8001_INIT_DBG(pm8001_ha,
593 pm8001_printk("IVT OFFSET 0x%x\n",
594 pm8001_cr32(pm8001_ha, pcibar, offset + 0x8C)));
595 PM8001_INIT_DBG(pm8001_ha,
596 pm8001_printk("PSPA OFFSET 0x%x\n",
597 pm8001_cr32(pm8001_ha, pcibar, offset + 0x90)));
598 PM8001_INIT_DBG(pm8001_ha,
599 pm8001_printk("addr - main cfg %p general status %p\n",
600 pm8001_ha->main_cfg_tbl_addr,
601 pm8001_ha->general_stat_tbl_addr));
602 PM8001_INIT_DBG(pm8001_ha,
603 pm8001_printk("addr - inbnd %p obnd %p\n",
604 pm8001_ha->inbnd_q_tbl_addr,
605 pm8001_ha->outbnd_q_tbl_addr));
606 PM8001_INIT_DBG(pm8001_ha,
607 pm8001_printk("addr - pspa %p ivt %p\n",
608 pm8001_ha->pspa_q_tbl_addr,
609 pm8001_ha->ivt_tbl_addr));
610}
611
612
613
614
615
616int
617pm80xx_set_thermal_config(struct pm8001_hba_info *pm8001_ha)
618{
619 struct set_ctrl_cfg_req payload;
620 struct inbound_queue_table *circularQ;
621 int rc;
622 u32 tag;
623 u32 opc = OPC_INB_SET_CONTROLLER_CONFIG;
624
625 memset(&payload, 0, sizeof(struct set_ctrl_cfg_req));
626 rc = pm8001_tag_alloc(pm8001_ha, &tag);
627 if (rc)
628 return -1;
629
630 circularQ = &pm8001_ha->inbnd_q_tbl[0];
631 payload.tag = cpu_to_le32(tag);
632 payload.cfg_pg[0] = (THERMAL_LOG_ENABLE << 9) |
633 (THERMAL_ENABLE << 8) | THERMAL_OP_CODE;
634 payload.cfg_pg[1] = (LTEMPHIL << 24) | (RTEMPHIL << 8);
635
636 rc = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
637 return rc;
638
639}
640
641
642
643
644
645
646static int
647pm80xx_set_sas_protocol_timer_config(struct pm8001_hba_info *pm8001_ha)
648{
649 struct set_ctrl_cfg_req payload;
650 struct inbound_queue_table *circularQ;
651 SASProtocolTimerConfig_t SASConfigPage;
652 int rc;
653 u32 tag;
654 u32 opc = OPC_INB_SET_CONTROLLER_CONFIG;
655
656 memset(&payload, 0, sizeof(struct set_ctrl_cfg_req));
657 memset(&SASConfigPage, 0, sizeof(SASProtocolTimerConfig_t));
658
659 rc = pm8001_tag_alloc(pm8001_ha, &tag);
660
661 if (rc)
662 return -1;
663
664 circularQ = &pm8001_ha->inbnd_q_tbl[0];
665 payload.tag = cpu_to_le32(tag);
666
667 SASConfigPage.pageCode = SAS_PROTOCOL_TIMER_CONFIG_PAGE;
668 SASConfigPage.MST_MSI = 3 << 15;
669 SASConfigPage.STP_SSP_MCT_TMO = (STP_MCT_TMO << 16) | SSP_MCT_TMO;
670 SASConfigPage.STP_FRM_TMO = (SAS_MAX_OPEN_TIME << 24) |
671 (SMP_MAX_CONN_TIMER << 16) | STP_FRM_TIMER;
672 SASConfigPage.STP_IDLE_TMO = STP_IDLE_TIME;
673
674 if (SASConfigPage.STP_IDLE_TMO > 0x3FFFFFF)
675 SASConfigPage.STP_IDLE_TMO = 0x3FFFFFF;
676
677
678 SASConfigPage.OPNRJT_RTRY_INTVL = (SAS_MFD << 16) |
679 SAS_OPNRJT_RTRY_INTVL;
680 SASConfigPage.Data_Cmd_OPNRJT_RTRY_TMO = (SAS_DOPNRJT_RTRY_TMO << 16)
681 | SAS_COPNRJT_RTRY_TMO;
682 SASConfigPage.Data_Cmd_OPNRJT_RTRY_THR = (SAS_DOPNRJT_RTRY_THR << 16)
683 | SAS_COPNRJT_RTRY_THR;
684 SASConfigPage.MAX_AIP = SAS_MAX_AIP;
685
686 PM8001_INIT_DBG(pm8001_ha,
687 pm8001_printk("SASConfigPage.pageCode "
688 "0x%08x\n", SASConfigPage.pageCode));
689 PM8001_INIT_DBG(pm8001_ha,
690 pm8001_printk("SASConfigPage.MST_MSI "
691 " 0x%08x\n", SASConfigPage.MST_MSI));
692 PM8001_INIT_DBG(pm8001_ha,
693 pm8001_printk("SASConfigPage.STP_SSP_MCT_TMO "
694 " 0x%08x\n", SASConfigPage.STP_SSP_MCT_TMO));
695 PM8001_INIT_DBG(pm8001_ha,
696 pm8001_printk("SASConfigPage.STP_FRM_TMO "
697 " 0x%08x\n", SASConfigPage.STP_FRM_TMO));
698 PM8001_INIT_DBG(pm8001_ha,
699 pm8001_printk("SASConfigPage.STP_IDLE_TMO "
700 " 0x%08x\n", SASConfigPage.STP_IDLE_TMO));
701 PM8001_INIT_DBG(pm8001_ha,
702 pm8001_printk("SASConfigPage.OPNRJT_RTRY_INTVL "
703 " 0x%08x\n", SASConfigPage.OPNRJT_RTRY_INTVL));
704 PM8001_INIT_DBG(pm8001_ha,
705 pm8001_printk("SASConfigPage.Data_Cmd_OPNRJT_RTRY_TMO "
706 " 0x%08x\n", SASConfigPage.Data_Cmd_OPNRJT_RTRY_TMO));
707 PM8001_INIT_DBG(pm8001_ha,
708 pm8001_printk("SASConfigPage.Data_Cmd_OPNRJT_RTRY_THR "
709 " 0x%08x\n", SASConfigPage.Data_Cmd_OPNRJT_RTRY_THR));
710 PM8001_INIT_DBG(pm8001_ha, pm8001_printk("SASConfigPage.MAX_AIP "
711 " 0x%08x\n", SASConfigPage.MAX_AIP));
712
713 memcpy(&payload.cfg_pg, &SASConfigPage,
714 sizeof(SASProtocolTimerConfig_t));
715
716 rc = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
717
718 return rc;
719}
720
721
722
723
724
725static int
726pm80xx_get_encrypt_info(struct pm8001_hba_info *pm8001_ha)
727{
728 u32 scratch3_value;
729 int ret;
730
731
732 scratch3_value = pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_3);
733
734 if ((scratch3_value & SCRATCH_PAD3_ENC_MASK) ==
735 SCRATCH_PAD3_ENC_READY) {
736 if (scratch3_value & SCRATCH_PAD3_XTS_ENABLED)
737 pm8001_ha->encrypt_info.cipher_mode = CIPHER_MODE_XTS;
738 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
739 SCRATCH_PAD3_SMF_ENABLED)
740 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMF;
741 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
742 SCRATCH_PAD3_SMA_ENABLED)
743 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMA;
744 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
745 SCRATCH_PAD3_SMB_ENABLED)
746 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMB;
747 pm8001_ha->encrypt_info.status = 0;
748 PM8001_INIT_DBG(pm8001_ha, pm8001_printk(
749 "Encryption: SCRATCH_PAD3_ENC_READY 0x%08X."
750 "Cipher mode 0x%x Sec mode 0x%x status 0x%x\n",
751 scratch3_value, pm8001_ha->encrypt_info.cipher_mode,
752 pm8001_ha->encrypt_info.sec_mode,
753 pm8001_ha->encrypt_info.status));
754 ret = 0;
755 } else if ((scratch3_value & SCRATCH_PAD3_ENC_READY) ==
756 SCRATCH_PAD3_ENC_DISABLED) {
757 PM8001_INIT_DBG(pm8001_ha, pm8001_printk(
758 "Encryption: SCRATCH_PAD3_ENC_DISABLED 0x%08X\n",
759 scratch3_value));
760 pm8001_ha->encrypt_info.status = 0xFFFFFFFF;
761 pm8001_ha->encrypt_info.cipher_mode = 0;
762 pm8001_ha->encrypt_info.sec_mode = 0;
763 return 0;
764 } else if ((scratch3_value & SCRATCH_PAD3_ENC_MASK) ==
765 SCRATCH_PAD3_ENC_DIS_ERR) {
766 pm8001_ha->encrypt_info.status =
767 (scratch3_value & SCRATCH_PAD3_ERR_CODE) >> 16;
768 if (scratch3_value & SCRATCH_PAD3_XTS_ENABLED)
769 pm8001_ha->encrypt_info.cipher_mode = CIPHER_MODE_XTS;
770 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
771 SCRATCH_PAD3_SMF_ENABLED)
772 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMF;
773 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
774 SCRATCH_PAD3_SMA_ENABLED)
775 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMA;
776 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
777 SCRATCH_PAD3_SMB_ENABLED)
778 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMB;
779 PM8001_INIT_DBG(pm8001_ha, pm8001_printk(
780 "Encryption: SCRATCH_PAD3_DIS_ERR 0x%08X."
781 "Cipher mode 0x%x sec mode 0x%x status 0x%x\n",
782 scratch3_value, pm8001_ha->encrypt_info.cipher_mode,
783 pm8001_ha->encrypt_info.sec_mode,
784 pm8001_ha->encrypt_info.status));
785 ret = -1;
786 } else if ((scratch3_value & SCRATCH_PAD3_ENC_MASK) ==
787 SCRATCH_PAD3_ENC_ENA_ERR) {
788
789 pm8001_ha->encrypt_info.status =
790 (scratch3_value & SCRATCH_PAD3_ERR_CODE) >> 16;
791 if (scratch3_value & SCRATCH_PAD3_XTS_ENABLED)
792 pm8001_ha->encrypt_info.cipher_mode = CIPHER_MODE_XTS;
793 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
794 SCRATCH_PAD3_SMF_ENABLED)
795 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMF;
796 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
797 SCRATCH_PAD3_SMA_ENABLED)
798 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMA;
799 if ((scratch3_value & SCRATCH_PAD3_SM_MASK) ==
800 SCRATCH_PAD3_SMB_ENABLED)
801 pm8001_ha->encrypt_info.sec_mode = SEC_MODE_SMB;
802
803 PM8001_INIT_DBG(pm8001_ha, pm8001_printk(
804 "Encryption: SCRATCH_PAD3_ENA_ERR 0x%08X."
805 "Cipher mode 0x%x sec mode 0x%x status 0x%x\n",
806 scratch3_value, pm8001_ha->encrypt_info.cipher_mode,
807 pm8001_ha->encrypt_info.sec_mode,
808 pm8001_ha->encrypt_info.status));
809 ret = -1;
810 }
811 return ret;
812}
813
814
815
816
817
818static int pm80xx_encrypt_update(struct pm8001_hba_info *pm8001_ha)
819{
820 struct kek_mgmt_req payload;
821 struct inbound_queue_table *circularQ;
822 int rc;
823 u32 tag;
824 u32 opc = OPC_INB_KEK_MANAGEMENT;
825
826 memset(&payload, 0, sizeof(struct kek_mgmt_req));
827 rc = pm8001_tag_alloc(pm8001_ha, &tag);
828 if (rc)
829 return -1;
830
831 circularQ = &pm8001_ha->inbnd_q_tbl[0];
832 payload.tag = cpu_to_le32(tag);
833
834
835
836 payload.new_curidx_ksop = ((1 << 24) | (1 << 16) | (1 << 8) |
837 KEK_MGMT_SUBOP_KEYCARDUPDATE);
838
839 rc = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
840
841 return rc;
842}
843
844
845
846
847
848static int pm80xx_chip_init(struct pm8001_hba_info *pm8001_ha)
849{
850 int ret;
851 u8 i = 0;
852
853
854 if (-1 == check_fw_ready(pm8001_ha)) {
855 PM8001_FAIL_DBG(pm8001_ha,
856 pm8001_printk("Firmware is not ready!\n"));
857 return -EBUSY;
858 }
859
860
861 init_pci_device_addresses(pm8001_ha);
862 init_default_table_values(pm8001_ha);
863 read_main_config_table(pm8001_ha);
864 read_general_status_table(pm8001_ha);
865 read_inbnd_queue_table(pm8001_ha);
866 read_outbnd_queue_table(pm8001_ha);
867 read_phy_attr_table(pm8001_ha);
868
869
870 update_main_config_table(pm8001_ha);
871 for (i = 0; i < PM8001_MAX_SPCV_INB_NUM; i++)
872 update_inbnd_queue_table(pm8001_ha, i);
873 for (i = 0; i < PM8001_MAX_SPCV_OUTB_NUM; i++)
874 update_outbnd_queue_table(pm8001_ha, i);
875
876
877 if (0 == mpi_init_check(pm8001_ha)) {
878 PM8001_INIT_DBG(pm8001_ha,
879 pm8001_printk("MPI initialize successful!\n"));
880 } else
881 return -EBUSY;
882
883
884 ret = pm80xx_set_sas_protocol_timer_config(pm8001_ha);
885
886
887 if (pm8001_ha->chip->encrypt) {
888 PM8001_INIT_DBG(pm8001_ha,
889 pm8001_printk("Checking for encryption\n"));
890 ret = pm80xx_get_encrypt_info(pm8001_ha);
891 if (ret == -1) {
892 PM8001_INIT_DBG(pm8001_ha,
893 pm8001_printk("Encryption error !!\n"));
894 if (pm8001_ha->encrypt_info.status == 0x81) {
895 PM8001_INIT_DBG(pm8001_ha, pm8001_printk(
896 "Encryption enabled with error."
897 "Saving encryption key to flash\n"));
898 pm80xx_encrypt_update(pm8001_ha);
899 }
900 }
901 }
902 return 0;
903}
904
905static int mpi_uninit_check(struct pm8001_hba_info *pm8001_ha)
906{
907 u32 max_wait_count;
908 u32 value;
909 u32 gst_len_mpistate;
910 init_pci_device_addresses(pm8001_ha);
911
912
913 pm8001_cw32(pm8001_ha, 0, MSGU_IBDB_SET, SPCv_MSGU_CFG_TABLE_RESET);
914
915
916 max_wait_count = 2 * 1000 * 1000;
917 do {
918 udelay(1);
919 value = pm8001_cr32(pm8001_ha, 0, MSGU_IBDB_SET);
920 value &= SPCv_MSGU_CFG_TABLE_RESET;
921 } while ((value != 0) && (--max_wait_count));
922
923 if (!max_wait_count) {
924 PM8001_FAIL_DBG(pm8001_ha,
925 pm8001_printk("TIMEOUT:IBDB value/=%x\n", value));
926 return -1;
927 }
928
929
930
931 max_wait_count = 2 * 1000 * 1000;
932 do {
933 udelay(1);
934 gst_len_mpistate =
935 pm8001_mr32(pm8001_ha->general_stat_tbl_addr,
936 GST_GSTLEN_MPIS_OFFSET);
937 if (GST_MPI_STATE_UNINIT ==
938 (gst_len_mpistate & GST_MPI_STATE_MASK))
939 break;
940 } while (--max_wait_count);
941 if (!max_wait_count) {
942 PM8001_FAIL_DBG(pm8001_ha,
943 pm8001_printk(" TIME OUT MPI State = 0x%x\n",
944 gst_len_mpistate & GST_MPI_STATE_MASK));
945 return -1;
946 }
947
948 return 0;
949}
950
951
952
953
954
955
956
957static int
958pm80xx_chip_soft_rst(struct pm8001_hba_info *pm8001_ha)
959{
960 u32 regval;
961 u32 bootloader_state;
962
963
964 if (mpi_uninit_check(pm8001_ha) != 0) {
965 PM8001_FAIL_DBG(pm8001_ha,
966 pm8001_printk("MPI state is not ready\n"));
967 return -1;
968 }
969
970
971 regval = pm8001_cr32(pm8001_ha, 0, SPC_REG_SOFT_RESET);
972 PM8001_INIT_DBG(pm8001_ha,
973 pm8001_printk("reset register before write : 0x%x\n", regval));
974
975 pm8001_cw32(pm8001_ha, 0, SPC_REG_SOFT_RESET, SPCv_NORMAL_RESET_VALUE);
976 mdelay(500);
977
978 regval = pm8001_cr32(pm8001_ha, 0, SPC_REG_SOFT_RESET);
979 PM8001_INIT_DBG(pm8001_ha,
980 pm8001_printk("reset register after write 0x%x\n", regval));
981
982 if ((regval & SPCv_SOFT_RESET_READ_MASK) ==
983 SPCv_SOFT_RESET_NORMAL_RESET_OCCURED) {
984 PM8001_MSG_DBG(pm8001_ha,
985 pm8001_printk(" soft reset successful [regval: 0x%x]\n",
986 regval));
987 } else {
988 PM8001_MSG_DBG(pm8001_ha,
989 pm8001_printk(" soft reset failed [regval: 0x%x]\n",
990 regval));
991
992
993 bootloader_state =
994 pm8001_cr32(pm8001_ha, 0, MSGU_SCRATCH_PAD_1) &
995 SCRATCH_PAD1_BOOTSTATE_MASK;
996
997 if (bootloader_state == SCRATCH_PAD1_BOOTSTATE_HDA_SEEPROM) {
998 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
999 "Bootloader state - HDA mode SEEPROM\n"));
1000 } else if (bootloader_state ==
1001 SCRATCH_PAD1_BOOTSTATE_HDA_BOOTSTRAP) {
1002 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
1003 "Bootloader state - HDA mode Bootstrap Pin\n"));
1004 } else if (bootloader_state ==
1005 SCRATCH_PAD1_BOOTSTATE_HDA_SOFTRESET) {
1006 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
1007 "Bootloader state - HDA mode soft reset\n"));
1008 } else if (bootloader_state ==
1009 SCRATCH_PAD1_BOOTSTATE_CRIT_ERROR) {
1010 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
1011 "Bootloader state-HDA mode critical error\n"));
1012 }
1013 return -EBUSY;
1014 }
1015
1016
1017 if (-1 == check_fw_ready(pm8001_ha)) {
1018 PM8001_FAIL_DBG(pm8001_ha,
1019 pm8001_printk("Firmware is not ready!\n"));
1020 return -EBUSY;
1021 }
1022 PM8001_INIT_DBG(pm8001_ha,
1023 pm8001_printk("SPCv soft reset Complete\n"));
1024 return 0;
1025}
1026
1027static void pm80xx_hw_chip_rst(struct pm8001_hba_info *pm8001_ha)
1028{
1029 u32 i;
1030
1031 PM8001_INIT_DBG(pm8001_ha,
1032 pm8001_printk("chip reset start\n"));
1033
1034
1035 pm8001_cw32(pm8001_ha, 0, SPC_REG_SOFT_RESET, 0x11);
1036 PM8001_INIT_DBG(pm8001_ha,
1037 pm8001_printk("SPC soft reset Complete\n"));
1038
1039
1040
1041 udelay(10);
1042
1043
1044 i = 20;
1045 do {
1046 mdelay(1);
1047 } while ((--i) != 0);
1048
1049 PM8001_INIT_DBG(pm8001_ha,
1050 pm8001_printk("chip reset finished\n"));
1051}
1052
1053
1054
1055
1056
1057static void
1058pm80xx_chip_intx_interrupt_enable(struct pm8001_hba_info *pm8001_ha)
1059{
1060 pm8001_cw32(pm8001_ha, 0, MSGU_ODMR, ODMR_CLEAR_ALL);
1061 pm8001_cw32(pm8001_ha, 0, MSGU_ODCR, ODCR_CLEAR_ALL);
1062}
1063
1064
1065
1066
1067
1068static void
1069pm80xx_chip_intx_interrupt_disable(struct pm8001_hba_info *pm8001_ha)
1070{
1071 pm8001_cw32(pm8001_ha, 0, MSGU_ODMR_CLR, ODMR_MASK_ALL);
1072}
1073
1074
1075
1076
1077
1078static void
1079pm80xx_chip_interrupt_enable(struct pm8001_hba_info *pm8001_ha, u8 vec)
1080{
1081#ifdef PM8001_USE_MSIX
1082 u32 mask;
1083 mask = (u32)(1 << vec);
1084
1085 pm8001_cw32(pm8001_ha, 0, MSGU_ODMR_CLR, (u32)(mask & 0xFFFFFFFF));
1086 return;
1087#endif
1088 pm80xx_chip_intx_interrupt_enable(pm8001_ha);
1089
1090}
1091
1092
1093
1094
1095
1096static void
1097pm80xx_chip_interrupt_disable(struct pm8001_hba_info *pm8001_ha, u8 vec)
1098{
1099#ifdef PM8001_USE_MSIX
1100 u32 mask;
1101 if (vec == 0xFF)
1102 mask = 0xFFFFFFFF;
1103 else
1104 mask = (u32)(1 << vec);
1105 pm8001_cw32(pm8001_ha, 0, MSGU_ODMR, (u32)(mask & 0xFFFFFFFF));
1106 return;
1107#endif
1108 pm80xx_chip_intx_interrupt_disable(pm8001_ha);
1109}
1110
1111static void pm80xx_send_abort_all(struct pm8001_hba_info *pm8001_ha,
1112 struct pm8001_device *pm8001_ha_dev)
1113{
1114 int res;
1115 u32 ccb_tag;
1116 struct pm8001_ccb_info *ccb;
1117 struct sas_task *task = NULL;
1118 struct task_abort_req task_abort;
1119 struct inbound_queue_table *circularQ;
1120 u32 opc = OPC_INB_SATA_ABORT;
1121 int ret;
1122
1123 if (!pm8001_ha_dev) {
1124 PM8001_FAIL_DBG(pm8001_ha, pm8001_printk("dev is null\n"));
1125 return;
1126 }
1127
1128 task = sas_alloc_slow_task(GFP_ATOMIC);
1129
1130 if (!task) {
1131 PM8001_FAIL_DBG(pm8001_ha, pm8001_printk("cannot "
1132 "allocate task\n"));
1133 return;
1134 }
1135
1136 task->task_done = pm8001_task_done;
1137
1138 res = pm8001_tag_alloc(pm8001_ha, &ccb_tag);
1139 if (res)
1140 return;
1141
1142 ccb = &pm8001_ha->ccb_info[ccb_tag];
1143 ccb->device = pm8001_ha_dev;
1144 ccb->ccb_tag = ccb_tag;
1145 ccb->task = task;
1146
1147 circularQ = &pm8001_ha->inbnd_q_tbl[0];
1148
1149 memset(&task_abort, 0, sizeof(task_abort));
1150 task_abort.abort_all = cpu_to_le32(1);
1151 task_abort.device_id = cpu_to_le32(pm8001_ha_dev->device_id);
1152 task_abort.tag = cpu_to_le32(ccb_tag);
1153
1154 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &task_abort, 0);
1155
1156}
1157
1158static void pm80xx_send_read_log(struct pm8001_hba_info *pm8001_ha,
1159 struct pm8001_device *pm8001_ha_dev)
1160{
1161 struct sata_start_req sata_cmd;
1162 int res;
1163 u32 ccb_tag;
1164 struct pm8001_ccb_info *ccb;
1165 struct sas_task *task = NULL;
1166 struct host_to_dev_fis fis;
1167 struct domain_device *dev;
1168 struct inbound_queue_table *circularQ;
1169 u32 opc = OPC_INB_SATA_HOST_OPSTART;
1170
1171 task = sas_alloc_slow_task(GFP_ATOMIC);
1172
1173 if (!task) {
1174 PM8001_FAIL_DBG(pm8001_ha,
1175 pm8001_printk("cannot allocate task !!!\n"));
1176 return;
1177 }
1178 task->task_done = pm8001_task_done;
1179
1180 res = pm8001_tag_alloc(pm8001_ha, &ccb_tag);
1181 if (res) {
1182 PM8001_FAIL_DBG(pm8001_ha,
1183 pm8001_printk("cannot allocate tag !!!\n"));
1184 return;
1185 }
1186
1187
1188
1189
1190 dev = kzalloc(sizeof(struct domain_device), GFP_ATOMIC);
1191 if (!dev) {
1192 PM8001_FAIL_DBG(pm8001_ha,
1193 pm8001_printk("Domain device cannot be allocated\n"));
1194 sas_free_task(task);
1195 return;
1196 } else {
1197 task->dev = dev;
1198 task->dev->lldd_dev = pm8001_ha_dev;
1199 }
1200
1201 ccb = &pm8001_ha->ccb_info[ccb_tag];
1202 ccb->device = pm8001_ha_dev;
1203 ccb->ccb_tag = ccb_tag;
1204 ccb->task = task;
1205 pm8001_ha_dev->id |= NCQ_READ_LOG_FLAG;
1206 pm8001_ha_dev->id |= NCQ_2ND_RLE_FLAG;
1207
1208 memset(&sata_cmd, 0, sizeof(sata_cmd));
1209 circularQ = &pm8001_ha->inbnd_q_tbl[0];
1210
1211
1212 memset(&fis, 0, sizeof(struct host_to_dev_fis));
1213 fis.fis_type = 0x27;
1214 fis.flags = 0x80;
1215 fis.command = ATA_CMD_READ_LOG_EXT;
1216 fis.lbal = 0x10;
1217 fis.sector_count = 0x1;
1218
1219 sata_cmd.tag = cpu_to_le32(ccb_tag);
1220 sata_cmd.device_id = cpu_to_le32(pm8001_ha_dev->device_id);
1221 sata_cmd.ncqtag_atap_dir_m_dad |= ((0x1 << 7) | (0x5 << 9));
1222 memcpy(&sata_cmd.sata_fis, &fis, sizeof(struct host_to_dev_fis));
1223
1224 res = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &sata_cmd, 0);
1225
1226}
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239static void
1240mpi_ssp_completion(struct pm8001_hba_info *pm8001_ha , void *piomb)
1241{
1242 struct sas_task *t;
1243 struct pm8001_ccb_info *ccb;
1244 unsigned long flags;
1245 u32 status;
1246 u32 param;
1247 u32 tag;
1248 struct ssp_completion_resp *psspPayload;
1249 struct task_status_struct *ts;
1250 struct ssp_response_iu *iu;
1251 struct pm8001_device *pm8001_dev;
1252 psspPayload = (struct ssp_completion_resp *)(piomb + 4);
1253 status = le32_to_cpu(psspPayload->status);
1254 tag = le32_to_cpu(psspPayload->tag);
1255 ccb = &pm8001_ha->ccb_info[tag];
1256 if ((status == IO_ABORTED) && ccb->open_retry) {
1257
1258 ccb->open_retry = 0;
1259 return;
1260 }
1261 pm8001_dev = ccb->device;
1262 param = le32_to_cpu(psspPayload->param);
1263 t = ccb->task;
1264
1265 if (status && status != IO_UNDERFLOW)
1266 PM8001_FAIL_DBG(pm8001_ha,
1267 pm8001_printk("sas IO status 0x%x\n", status));
1268 if (unlikely(!t || !t->lldd_task || !t->dev))
1269 return;
1270 ts = &t->task_status;
1271 switch (status) {
1272 case IO_SUCCESS:
1273 PM8001_IO_DBG(pm8001_ha,
1274 pm8001_printk("IO_SUCCESS ,param = 0x%x\n",
1275 param));
1276 if (param == 0) {
1277 ts->resp = SAS_TASK_COMPLETE;
1278 ts->stat = SAM_STAT_GOOD;
1279 } else {
1280 ts->resp = SAS_TASK_COMPLETE;
1281 ts->stat = SAS_PROTO_RESPONSE;
1282 ts->residual = param;
1283 iu = &psspPayload->ssp_resp_iu;
1284 sas_ssp_task_response(pm8001_ha->dev, t, iu);
1285 }
1286 if (pm8001_dev)
1287 pm8001_dev->running_req--;
1288 break;
1289 case IO_ABORTED:
1290 PM8001_IO_DBG(pm8001_ha,
1291 pm8001_printk("IO_ABORTED IOMB Tag\n"));
1292 ts->resp = SAS_TASK_COMPLETE;
1293 ts->stat = SAS_ABORTED_TASK;
1294 break;
1295 case IO_UNDERFLOW:
1296
1297 PM8001_IO_DBG(pm8001_ha,
1298 pm8001_printk("IO_UNDERFLOW ,param = 0x%x\n",
1299 param));
1300 ts->resp = SAS_TASK_COMPLETE;
1301 ts->stat = SAS_DATA_UNDERRUN;
1302 ts->residual = param;
1303 if (pm8001_dev)
1304 pm8001_dev->running_req--;
1305 break;
1306 case IO_NO_DEVICE:
1307 PM8001_IO_DBG(pm8001_ha,
1308 pm8001_printk("IO_NO_DEVICE\n"));
1309 ts->resp = SAS_TASK_UNDELIVERED;
1310 ts->stat = SAS_PHY_DOWN;
1311 break;
1312 case IO_XFER_ERROR_BREAK:
1313 PM8001_IO_DBG(pm8001_ha,
1314 pm8001_printk("IO_XFER_ERROR_BREAK\n"));
1315 ts->resp = SAS_TASK_COMPLETE;
1316 ts->stat = SAS_OPEN_REJECT;
1317
1318 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1319 break;
1320 case IO_XFER_ERROR_PHY_NOT_READY:
1321 PM8001_IO_DBG(pm8001_ha,
1322 pm8001_printk("IO_XFER_ERROR_PHY_NOT_READY\n"));
1323 ts->resp = SAS_TASK_COMPLETE;
1324 ts->stat = SAS_OPEN_REJECT;
1325 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1326 break;
1327 case IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED:
1328 PM8001_IO_DBG(pm8001_ha,
1329 pm8001_printk("IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED\n"));
1330 ts->resp = SAS_TASK_COMPLETE;
1331 ts->stat = SAS_OPEN_REJECT;
1332 ts->open_rej_reason = SAS_OREJ_EPROTO;
1333 break;
1334 case IO_OPEN_CNX_ERROR_ZONE_VIOLATION:
1335 PM8001_IO_DBG(pm8001_ha,
1336 pm8001_printk("IO_OPEN_CNX_ERROR_ZONE_VIOLATION\n"));
1337 ts->resp = SAS_TASK_COMPLETE;
1338 ts->stat = SAS_OPEN_REJECT;
1339 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
1340 break;
1341 case IO_OPEN_CNX_ERROR_BREAK:
1342 PM8001_IO_DBG(pm8001_ha,
1343 pm8001_printk("IO_OPEN_CNX_ERROR_BREAK\n"));
1344 ts->resp = SAS_TASK_COMPLETE;
1345 ts->stat = SAS_OPEN_REJECT;
1346 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1347 break;
1348 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS:
1349 case IO_XFER_OPEN_RETRY_BACKOFF_THRESHOLD_REACHED:
1350 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_TMO:
1351 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_NO_DEST:
1352 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_COLLIDE:
1353 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_PATHWAY_BLOCKED:
1354 PM8001_IO_DBG(pm8001_ha,
1355 pm8001_printk("IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS\n"));
1356 ts->resp = SAS_TASK_COMPLETE;
1357 ts->stat = SAS_OPEN_REJECT;
1358 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
1359 if (!t->uldd_task)
1360 pm8001_handle_event(pm8001_ha,
1361 pm8001_dev,
1362 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
1363 break;
1364 case IO_OPEN_CNX_ERROR_BAD_DESTINATION:
1365 PM8001_IO_DBG(pm8001_ha,
1366 pm8001_printk("IO_OPEN_CNX_ERROR_BAD_DESTINATION\n"));
1367 ts->resp = SAS_TASK_COMPLETE;
1368 ts->stat = SAS_OPEN_REJECT;
1369 ts->open_rej_reason = SAS_OREJ_BAD_DEST;
1370 break;
1371 case IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED:
1372 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1373 "IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED\n"));
1374 ts->resp = SAS_TASK_COMPLETE;
1375 ts->stat = SAS_OPEN_REJECT;
1376 ts->open_rej_reason = SAS_OREJ_CONN_RATE;
1377 break;
1378 case IO_OPEN_CNX_ERROR_WRONG_DESTINATION:
1379 PM8001_IO_DBG(pm8001_ha,
1380 pm8001_printk("IO_OPEN_CNX_ERROR_WRONG_DESTINATION\n"));
1381 ts->resp = SAS_TASK_UNDELIVERED;
1382 ts->stat = SAS_OPEN_REJECT;
1383 ts->open_rej_reason = SAS_OREJ_WRONG_DEST;
1384 break;
1385 case IO_XFER_ERROR_NAK_RECEIVED:
1386 PM8001_IO_DBG(pm8001_ha,
1387 pm8001_printk("IO_XFER_ERROR_NAK_RECEIVED\n"));
1388 ts->resp = SAS_TASK_COMPLETE;
1389 ts->stat = SAS_OPEN_REJECT;
1390 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1391 break;
1392 case IO_XFER_ERROR_ACK_NAK_TIMEOUT:
1393 PM8001_IO_DBG(pm8001_ha,
1394 pm8001_printk("IO_XFER_ERROR_ACK_NAK_TIMEOUT\n"));
1395 ts->resp = SAS_TASK_COMPLETE;
1396 ts->stat = SAS_NAK_R_ERR;
1397 break;
1398 case IO_XFER_ERROR_DMA:
1399 PM8001_IO_DBG(pm8001_ha,
1400 pm8001_printk("IO_XFER_ERROR_DMA\n"));
1401 ts->resp = SAS_TASK_COMPLETE;
1402 ts->stat = SAS_OPEN_REJECT;
1403 break;
1404 case IO_XFER_OPEN_RETRY_TIMEOUT:
1405 PM8001_IO_DBG(pm8001_ha,
1406 pm8001_printk("IO_XFER_OPEN_RETRY_TIMEOUT\n"));
1407 ts->resp = SAS_TASK_COMPLETE;
1408 ts->stat = SAS_OPEN_REJECT;
1409 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1410 break;
1411 case IO_XFER_ERROR_OFFSET_MISMATCH:
1412 PM8001_IO_DBG(pm8001_ha,
1413 pm8001_printk("IO_XFER_ERROR_OFFSET_MISMATCH\n"));
1414 ts->resp = SAS_TASK_COMPLETE;
1415 ts->stat = SAS_OPEN_REJECT;
1416 break;
1417 case IO_PORT_IN_RESET:
1418 PM8001_IO_DBG(pm8001_ha,
1419 pm8001_printk("IO_PORT_IN_RESET\n"));
1420 ts->resp = SAS_TASK_COMPLETE;
1421 ts->stat = SAS_OPEN_REJECT;
1422 break;
1423 case IO_DS_NON_OPERATIONAL:
1424 PM8001_IO_DBG(pm8001_ha,
1425 pm8001_printk("IO_DS_NON_OPERATIONAL\n"));
1426 ts->resp = SAS_TASK_COMPLETE;
1427 ts->stat = SAS_OPEN_REJECT;
1428 if (!t->uldd_task)
1429 pm8001_handle_event(pm8001_ha,
1430 pm8001_dev,
1431 IO_DS_NON_OPERATIONAL);
1432 break;
1433 case IO_DS_IN_RECOVERY:
1434 PM8001_IO_DBG(pm8001_ha,
1435 pm8001_printk("IO_DS_IN_RECOVERY\n"));
1436 ts->resp = SAS_TASK_COMPLETE;
1437 ts->stat = SAS_OPEN_REJECT;
1438 break;
1439 case IO_TM_TAG_NOT_FOUND:
1440 PM8001_IO_DBG(pm8001_ha,
1441 pm8001_printk("IO_TM_TAG_NOT_FOUND\n"));
1442 ts->resp = SAS_TASK_COMPLETE;
1443 ts->stat = SAS_OPEN_REJECT;
1444 break;
1445 case IO_SSP_EXT_IU_ZERO_LEN_ERROR:
1446 PM8001_IO_DBG(pm8001_ha,
1447 pm8001_printk("IO_SSP_EXT_IU_ZERO_LEN_ERROR\n"));
1448 ts->resp = SAS_TASK_COMPLETE;
1449 ts->stat = SAS_OPEN_REJECT;
1450 break;
1451 case IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY:
1452 PM8001_IO_DBG(pm8001_ha,
1453 pm8001_printk("IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY\n"));
1454 ts->resp = SAS_TASK_COMPLETE;
1455 ts->stat = SAS_OPEN_REJECT;
1456 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1457 break;
1458 default:
1459 PM8001_IO_DBG(pm8001_ha,
1460 pm8001_printk("Unknown status 0x%x\n", status));
1461
1462 ts->resp = SAS_TASK_COMPLETE;
1463 ts->stat = SAS_OPEN_REJECT;
1464 break;
1465 }
1466 PM8001_IO_DBG(pm8001_ha,
1467 pm8001_printk("scsi_status = 0x%x\n ",
1468 psspPayload->ssp_resp_iu.status));
1469 spin_lock_irqsave(&t->task_state_lock, flags);
1470 t->task_state_flags &= ~SAS_TASK_STATE_PENDING;
1471 t->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
1472 t->task_state_flags |= SAS_TASK_STATE_DONE;
1473 if (unlikely((t->task_state_flags & SAS_TASK_STATE_ABORTED))) {
1474 spin_unlock_irqrestore(&t->task_state_lock, flags);
1475 PM8001_FAIL_DBG(pm8001_ha, pm8001_printk(
1476 "task 0x%p done with io_status 0x%x resp 0x%x "
1477 "stat 0x%x but aborted by upper layer!\n",
1478 t, status, ts->resp, ts->stat));
1479 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1480 } else {
1481 spin_unlock_irqrestore(&t->task_state_lock, flags);
1482 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1483 mb();
1484 t->task_done(t);
1485 }
1486}
1487
1488
1489static void mpi_ssp_event(struct pm8001_hba_info *pm8001_ha , void *piomb)
1490{
1491 struct sas_task *t;
1492 unsigned long flags;
1493 struct task_status_struct *ts;
1494 struct pm8001_ccb_info *ccb;
1495 struct pm8001_device *pm8001_dev;
1496 struct ssp_event_resp *psspPayload =
1497 (struct ssp_event_resp *)(piomb + 4);
1498 u32 event = le32_to_cpu(psspPayload->event);
1499 u32 tag = le32_to_cpu(psspPayload->tag);
1500 u32 port_id = le32_to_cpu(psspPayload->port_id);
1501
1502 ccb = &pm8001_ha->ccb_info[tag];
1503 t = ccb->task;
1504 pm8001_dev = ccb->device;
1505 if (event)
1506 PM8001_FAIL_DBG(pm8001_ha,
1507 pm8001_printk("sas IO status 0x%x\n", event));
1508 if (unlikely(!t || !t->lldd_task || !t->dev))
1509 return;
1510 ts = &t->task_status;
1511 PM8001_IO_DBG(pm8001_ha,
1512 pm8001_printk("port_id:0x%x, tag:0x%x, event:0x%x\n",
1513 port_id, tag, event));
1514 switch (event) {
1515 case IO_OVERFLOW:
1516 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_UNDERFLOW\n");)
1517 ts->resp = SAS_TASK_COMPLETE;
1518 ts->stat = SAS_DATA_OVERRUN;
1519 ts->residual = 0;
1520 if (pm8001_dev)
1521 pm8001_dev->running_req--;
1522 break;
1523 case IO_XFER_ERROR_BREAK:
1524 PM8001_IO_DBG(pm8001_ha,
1525 pm8001_printk("IO_XFER_ERROR_BREAK\n"));
1526 pm8001_handle_event(pm8001_ha, t, IO_XFER_ERROR_BREAK);
1527 return;
1528 case IO_XFER_ERROR_PHY_NOT_READY:
1529 PM8001_IO_DBG(pm8001_ha,
1530 pm8001_printk("IO_XFER_ERROR_PHY_NOT_READY\n"));
1531 ts->resp = SAS_TASK_COMPLETE;
1532 ts->stat = SAS_OPEN_REJECT;
1533 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1534 break;
1535 case IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED:
1536 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1537 "IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED\n"));
1538 ts->resp = SAS_TASK_COMPLETE;
1539 ts->stat = SAS_OPEN_REJECT;
1540 ts->open_rej_reason = SAS_OREJ_EPROTO;
1541 break;
1542 case IO_OPEN_CNX_ERROR_ZONE_VIOLATION:
1543 PM8001_IO_DBG(pm8001_ha,
1544 pm8001_printk("IO_OPEN_CNX_ERROR_ZONE_VIOLATION\n"));
1545 ts->resp = SAS_TASK_COMPLETE;
1546 ts->stat = SAS_OPEN_REJECT;
1547 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
1548 break;
1549 case IO_OPEN_CNX_ERROR_BREAK:
1550 PM8001_IO_DBG(pm8001_ha,
1551 pm8001_printk("IO_OPEN_CNX_ERROR_BREAK\n"));
1552 ts->resp = SAS_TASK_COMPLETE;
1553 ts->stat = SAS_OPEN_REJECT;
1554 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1555 break;
1556 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS:
1557 case IO_XFER_OPEN_RETRY_BACKOFF_THRESHOLD_REACHED:
1558 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_TMO:
1559 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_NO_DEST:
1560 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_COLLIDE:
1561 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_PATHWAY_BLOCKED:
1562 PM8001_IO_DBG(pm8001_ha,
1563 pm8001_printk("IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS\n"));
1564 ts->resp = SAS_TASK_COMPLETE;
1565 ts->stat = SAS_OPEN_REJECT;
1566 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
1567 if (!t->uldd_task)
1568 pm8001_handle_event(pm8001_ha,
1569 pm8001_dev,
1570 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
1571 break;
1572 case IO_OPEN_CNX_ERROR_BAD_DESTINATION:
1573 PM8001_IO_DBG(pm8001_ha,
1574 pm8001_printk("IO_OPEN_CNX_ERROR_BAD_DESTINATION\n"));
1575 ts->resp = SAS_TASK_COMPLETE;
1576 ts->stat = SAS_OPEN_REJECT;
1577 ts->open_rej_reason = SAS_OREJ_BAD_DEST;
1578 break;
1579 case IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED:
1580 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1581 "IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED\n"));
1582 ts->resp = SAS_TASK_COMPLETE;
1583 ts->stat = SAS_OPEN_REJECT;
1584 ts->open_rej_reason = SAS_OREJ_CONN_RATE;
1585 break;
1586 case IO_OPEN_CNX_ERROR_WRONG_DESTINATION:
1587 PM8001_IO_DBG(pm8001_ha,
1588 pm8001_printk("IO_OPEN_CNX_ERROR_WRONG_DESTINATION\n"));
1589 ts->resp = SAS_TASK_COMPLETE;
1590 ts->stat = SAS_OPEN_REJECT;
1591 ts->open_rej_reason = SAS_OREJ_WRONG_DEST;
1592 break;
1593 case IO_XFER_ERROR_NAK_RECEIVED:
1594 PM8001_IO_DBG(pm8001_ha,
1595 pm8001_printk("IO_XFER_ERROR_NAK_RECEIVED\n"));
1596 ts->resp = SAS_TASK_COMPLETE;
1597 ts->stat = SAS_OPEN_REJECT;
1598 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1599 break;
1600 case IO_XFER_ERROR_ACK_NAK_TIMEOUT:
1601 PM8001_IO_DBG(pm8001_ha,
1602 pm8001_printk("IO_XFER_ERROR_ACK_NAK_TIMEOUT\n"));
1603 ts->resp = SAS_TASK_COMPLETE;
1604 ts->stat = SAS_NAK_R_ERR;
1605 break;
1606 case IO_XFER_OPEN_RETRY_TIMEOUT:
1607 PM8001_IO_DBG(pm8001_ha,
1608 pm8001_printk("IO_XFER_OPEN_RETRY_TIMEOUT\n"));
1609 pm8001_handle_event(pm8001_ha, t, IO_XFER_OPEN_RETRY_TIMEOUT);
1610 return;
1611 case IO_XFER_ERROR_UNEXPECTED_PHASE:
1612 PM8001_IO_DBG(pm8001_ha,
1613 pm8001_printk("IO_XFER_ERROR_UNEXPECTED_PHASE\n"));
1614 ts->resp = SAS_TASK_COMPLETE;
1615 ts->stat = SAS_DATA_OVERRUN;
1616 break;
1617 case IO_XFER_ERROR_XFER_RDY_OVERRUN:
1618 PM8001_IO_DBG(pm8001_ha,
1619 pm8001_printk("IO_XFER_ERROR_XFER_RDY_OVERRUN\n"));
1620 ts->resp = SAS_TASK_COMPLETE;
1621 ts->stat = SAS_DATA_OVERRUN;
1622 break;
1623 case IO_XFER_ERROR_XFER_RDY_NOT_EXPECTED:
1624 PM8001_IO_DBG(pm8001_ha,
1625 pm8001_printk("IO_XFER_ERROR_XFER_RDY_NOT_EXPECTED\n"));
1626 ts->resp = SAS_TASK_COMPLETE;
1627 ts->stat = SAS_DATA_OVERRUN;
1628 break;
1629 case IO_XFER_ERROR_CMD_ISSUE_ACK_NAK_TIMEOUT:
1630 PM8001_IO_DBG(pm8001_ha,
1631 pm8001_printk("IO_XFER_ERROR_CMD_ISSUE_ACK_NAK_TIMEOUT\n"));
1632 ts->resp = SAS_TASK_COMPLETE;
1633 ts->stat = SAS_DATA_OVERRUN;
1634 break;
1635 case IO_XFER_ERROR_OFFSET_MISMATCH:
1636 PM8001_IO_DBG(pm8001_ha,
1637 pm8001_printk("IO_XFER_ERROR_OFFSET_MISMATCH\n"));
1638 ts->resp = SAS_TASK_COMPLETE;
1639 ts->stat = SAS_DATA_OVERRUN;
1640 break;
1641 case IO_XFER_ERROR_XFER_ZERO_DATA_LEN:
1642 PM8001_IO_DBG(pm8001_ha,
1643 pm8001_printk("IO_XFER_ERROR_XFER_ZERO_DATA_LEN\n"));
1644 ts->resp = SAS_TASK_COMPLETE;
1645 ts->stat = SAS_DATA_OVERRUN;
1646 break;
1647 case IO_XFER_ERROR_INTERNAL_CRC_ERROR:
1648 PM8001_IO_DBG(pm8001_ha,
1649 pm8001_printk("IO_XFR_ERROR_INTERNAL_CRC_ERROR\n"));
1650
1651 ts->resp = SAS_TASK_COMPLETE;
1652 ts->stat = SAS_DATA_OVERRUN;
1653 break;
1654 case IO_XFER_CMD_FRAME_ISSUED:
1655 PM8001_IO_DBG(pm8001_ha,
1656 pm8001_printk("IO_XFER_CMD_FRAME_ISSUED\n"));
1657 return;
1658 default:
1659 PM8001_IO_DBG(pm8001_ha,
1660 pm8001_printk("Unknown status 0x%x\n", event));
1661
1662 ts->resp = SAS_TASK_COMPLETE;
1663 ts->stat = SAS_DATA_OVERRUN;
1664 break;
1665 }
1666 spin_lock_irqsave(&t->task_state_lock, flags);
1667 t->task_state_flags &= ~SAS_TASK_STATE_PENDING;
1668 t->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
1669 t->task_state_flags |= SAS_TASK_STATE_DONE;
1670 if (unlikely((t->task_state_flags & SAS_TASK_STATE_ABORTED))) {
1671 spin_unlock_irqrestore(&t->task_state_lock, flags);
1672 PM8001_FAIL_DBG(pm8001_ha, pm8001_printk(
1673 "task 0x%p done with event 0x%x resp 0x%x "
1674 "stat 0x%x but aborted by upper layer!\n",
1675 t, event, ts->resp, ts->stat));
1676 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1677 } else {
1678 spin_unlock_irqrestore(&t->task_state_lock, flags);
1679 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1680 mb();
1681 t->task_done(t);
1682 }
1683}
1684
1685
1686static void
1687mpi_sata_completion(struct pm8001_hba_info *pm8001_ha, void *piomb)
1688{
1689 struct sas_task *t;
1690 struct pm8001_ccb_info *ccb;
1691 u32 param;
1692 u32 status;
1693 u32 tag;
1694 struct sata_completion_resp *psataPayload;
1695 struct task_status_struct *ts;
1696 struct ata_task_resp *resp ;
1697 u32 *sata_resp;
1698 struct pm8001_device *pm8001_dev;
1699 unsigned long flags;
1700
1701 psataPayload = (struct sata_completion_resp *)(piomb + 4);
1702 status = le32_to_cpu(psataPayload->status);
1703 tag = le32_to_cpu(psataPayload->tag);
1704
1705 if (!tag) {
1706 PM8001_FAIL_DBG(pm8001_ha,
1707 pm8001_printk("tag null\n"));
1708 return;
1709 }
1710 ccb = &pm8001_ha->ccb_info[tag];
1711 param = le32_to_cpu(psataPayload->param);
1712 if (ccb) {
1713 t = ccb->task;
1714 pm8001_dev = ccb->device;
1715 } else {
1716 PM8001_FAIL_DBG(pm8001_ha,
1717 pm8001_printk("ccb null\n"));
1718 return;
1719 }
1720
1721 if (t) {
1722 if (t->dev && (t->dev->lldd_dev))
1723 pm8001_dev = t->dev->lldd_dev;
1724 } else {
1725 PM8001_FAIL_DBG(pm8001_ha,
1726 pm8001_printk("task null\n"));
1727 return;
1728 }
1729
1730 if ((pm8001_dev && !(pm8001_dev->id & NCQ_READ_LOG_FLAG))
1731 && unlikely(!t || !t->lldd_task || !t->dev)) {
1732 PM8001_FAIL_DBG(pm8001_ha,
1733 pm8001_printk("task or dev null\n"));
1734 return;
1735 }
1736
1737 ts = &t->task_status;
1738 if (!ts) {
1739 PM8001_FAIL_DBG(pm8001_ha,
1740 pm8001_printk("ts null\n"));
1741 return;
1742 }
1743
1744 switch (status) {
1745 case IO_SUCCESS:
1746 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_SUCCESS\n"));
1747 if (param == 0) {
1748 ts->resp = SAS_TASK_COMPLETE;
1749 ts->stat = SAM_STAT_GOOD;
1750
1751 if (pm8001_dev &&
1752 (pm8001_dev->id & NCQ_READ_LOG_FLAG)) {
1753
1754 pm8001_dev->id |= NCQ_ABORT_ALL_FLAG;
1755
1756 pm8001_dev->id = pm8001_dev->id & 0x7FFFFFFF;
1757 pm80xx_send_abort_all(pm8001_ha, pm8001_dev);
1758
1759 pm8001_tag_free(pm8001_ha, tag);
1760 sas_free_task(t);
1761 return;
1762 }
1763 } else {
1764 u8 len;
1765 ts->resp = SAS_TASK_COMPLETE;
1766 ts->stat = SAS_PROTO_RESPONSE;
1767 ts->residual = param;
1768 PM8001_IO_DBG(pm8001_ha,
1769 pm8001_printk("SAS_PROTO_RESPONSE len = %d\n",
1770 param));
1771 sata_resp = &psataPayload->sata_resp[0];
1772 resp = (struct ata_task_resp *)ts->buf;
1773 if (t->ata_task.dma_xfer == 0 &&
1774 t->data_dir == PCI_DMA_FROMDEVICE) {
1775 len = sizeof(struct pio_setup_fis);
1776 PM8001_IO_DBG(pm8001_ha,
1777 pm8001_printk("PIO read len = %d\n", len));
1778 } else if (t->ata_task.use_ncq) {
1779 len = sizeof(struct set_dev_bits_fis);
1780 PM8001_IO_DBG(pm8001_ha,
1781 pm8001_printk("FPDMA len = %d\n", len));
1782 } else {
1783 len = sizeof(struct dev_to_host_fis);
1784 PM8001_IO_DBG(pm8001_ha,
1785 pm8001_printk("other len = %d\n", len));
1786 }
1787 if (SAS_STATUS_BUF_SIZE >= sizeof(*resp)) {
1788 resp->frame_len = len;
1789 memcpy(&resp->ending_fis[0], sata_resp, len);
1790 ts->buf_valid_size = sizeof(*resp);
1791 } else
1792 PM8001_IO_DBG(pm8001_ha,
1793 pm8001_printk("response to large\n"));
1794 }
1795 if (pm8001_dev)
1796 pm8001_dev->running_req--;
1797 break;
1798 case IO_ABORTED:
1799 PM8001_IO_DBG(pm8001_ha,
1800 pm8001_printk("IO_ABORTED IOMB Tag\n"));
1801 ts->resp = SAS_TASK_COMPLETE;
1802 ts->stat = SAS_ABORTED_TASK;
1803 if (pm8001_dev)
1804 pm8001_dev->running_req--;
1805 break;
1806
1807 case IO_UNDERFLOW:
1808
1809 PM8001_IO_DBG(pm8001_ha,
1810 pm8001_printk("IO_UNDERFLOW param = %d\n", param));
1811 ts->resp = SAS_TASK_COMPLETE;
1812 ts->stat = SAS_DATA_UNDERRUN;
1813 ts->residual = param;
1814 if (pm8001_dev)
1815 pm8001_dev->running_req--;
1816 break;
1817 case IO_NO_DEVICE:
1818 PM8001_IO_DBG(pm8001_ha,
1819 pm8001_printk("IO_NO_DEVICE\n"));
1820 ts->resp = SAS_TASK_UNDELIVERED;
1821 ts->stat = SAS_PHY_DOWN;
1822 break;
1823 case IO_XFER_ERROR_BREAK:
1824 PM8001_IO_DBG(pm8001_ha,
1825 pm8001_printk("IO_XFER_ERROR_BREAK\n"));
1826 ts->resp = SAS_TASK_COMPLETE;
1827 ts->stat = SAS_INTERRUPTED;
1828 break;
1829 case IO_XFER_ERROR_PHY_NOT_READY:
1830 PM8001_IO_DBG(pm8001_ha,
1831 pm8001_printk("IO_XFER_ERROR_PHY_NOT_READY\n"));
1832 ts->resp = SAS_TASK_COMPLETE;
1833 ts->stat = SAS_OPEN_REJECT;
1834 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
1835 break;
1836 case IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED:
1837 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1838 "IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED\n"));
1839 ts->resp = SAS_TASK_COMPLETE;
1840 ts->stat = SAS_OPEN_REJECT;
1841 ts->open_rej_reason = SAS_OREJ_EPROTO;
1842 break;
1843 case IO_OPEN_CNX_ERROR_ZONE_VIOLATION:
1844 PM8001_IO_DBG(pm8001_ha,
1845 pm8001_printk("IO_OPEN_CNX_ERROR_ZONE_VIOLATION\n"));
1846 ts->resp = SAS_TASK_COMPLETE;
1847 ts->stat = SAS_OPEN_REJECT;
1848 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
1849 break;
1850 case IO_OPEN_CNX_ERROR_BREAK:
1851 PM8001_IO_DBG(pm8001_ha,
1852 pm8001_printk("IO_OPEN_CNX_ERROR_BREAK\n"));
1853 ts->resp = SAS_TASK_COMPLETE;
1854 ts->stat = SAS_OPEN_REJECT;
1855 ts->open_rej_reason = SAS_OREJ_RSVD_CONT0;
1856 break;
1857 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS:
1858 case IO_XFER_OPEN_RETRY_BACKOFF_THRESHOLD_REACHED:
1859 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_TMO:
1860 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_NO_DEST:
1861 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_COLLIDE:
1862 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_PATHWAY_BLOCKED:
1863 PM8001_IO_DBG(pm8001_ha,
1864 pm8001_printk("IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS\n"));
1865 ts->resp = SAS_TASK_COMPLETE;
1866 ts->stat = SAS_DEV_NO_RESPONSE;
1867 if (!t->uldd_task) {
1868 pm8001_handle_event(pm8001_ha,
1869 pm8001_dev,
1870 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
1871 ts->resp = SAS_TASK_UNDELIVERED;
1872 ts->stat = SAS_QUEUE_FULL;
1873 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1874 mb();
1875 spin_unlock_irq(&pm8001_ha->lock);
1876 t->task_done(t);
1877 spin_lock_irq(&pm8001_ha->lock);
1878 return;
1879 }
1880 break;
1881 case IO_OPEN_CNX_ERROR_BAD_DESTINATION:
1882 PM8001_IO_DBG(pm8001_ha,
1883 pm8001_printk("IO_OPEN_CNX_ERROR_BAD_DESTINATION\n"));
1884 ts->resp = SAS_TASK_UNDELIVERED;
1885 ts->stat = SAS_OPEN_REJECT;
1886 ts->open_rej_reason = SAS_OREJ_BAD_DEST;
1887 if (!t->uldd_task) {
1888 pm8001_handle_event(pm8001_ha,
1889 pm8001_dev,
1890 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
1891 ts->resp = SAS_TASK_UNDELIVERED;
1892 ts->stat = SAS_QUEUE_FULL;
1893 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1894 mb();
1895 spin_unlock_irq(&pm8001_ha->lock);
1896 t->task_done(t);
1897 spin_lock_irq(&pm8001_ha->lock);
1898 return;
1899 }
1900 break;
1901 case IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED:
1902 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1903 "IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED\n"));
1904 ts->resp = SAS_TASK_COMPLETE;
1905 ts->stat = SAS_OPEN_REJECT;
1906 ts->open_rej_reason = SAS_OREJ_CONN_RATE;
1907 break;
1908 case IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY:
1909 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
1910 "IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY\n"));
1911 ts->resp = SAS_TASK_COMPLETE;
1912 ts->stat = SAS_DEV_NO_RESPONSE;
1913 if (!t->uldd_task) {
1914 pm8001_handle_event(pm8001_ha,
1915 pm8001_dev,
1916 IO_OPEN_CNX_ERROR_STP_RESOURCES_BUSY);
1917 ts->resp = SAS_TASK_UNDELIVERED;
1918 ts->stat = SAS_QUEUE_FULL;
1919 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1920 mb();
1921 spin_unlock_irq(&pm8001_ha->lock);
1922 t->task_done(t);
1923 spin_lock_irq(&pm8001_ha->lock);
1924 return;
1925 }
1926 break;
1927 case IO_OPEN_CNX_ERROR_WRONG_DESTINATION:
1928 PM8001_IO_DBG(pm8001_ha,
1929 pm8001_printk("IO_OPEN_CNX_ERROR_WRONG_DESTINATION\n"));
1930 ts->resp = SAS_TASK_COMPLETE;
1931 ts->stat = SAS_OPEN_REJECT;
1932 ts->open_rej_reason = SAS_OREJ_WRONG_DEST;
1933 break;
1934 case IO_XFER_ERROR_NAK_RECEIVED:
1935 PM8001_IO_DBG(pm8001_ha,
1936 pm8001_printk("IO_XFER_ERROR_NAK_RECEIVED\n"));
1937 ts->resp = SAS_TASK_COMPLETE;
1938 ts->stat = SAS_NAK_R_ERR;
1939 break;
1940 case IO_XFER_ERROR_ACK_NAK_TIMEOUT:
1941 PM8001_IO_DBG(pm8001_ha,
1942 pm8001_printk("IO_XFER_ERROR_ACK_NAK_TIMEOUT\n"));
1943 ts->resp = SAS_TASK_COMPLETE;
1944 ts->stat = SAS_NAK_R_ERR;
1945 break;
1946 case IO_XFER_ERROR_DMA:
1947 PM8001_IO_DBG(pm8001_ha,
1948 pm8001_printk("IO_XFER_ERROR_DMA\n"));
1949 ts->resp = SAS_TASK_COMPLETE;
1950 ts->stat = SAS_ABORTED_TASK;
1951 break;
1952 case IO_XFER_ERROR_SATA_LINK_TIMEOUT:
1953 PM8001_IO_DBG(pm8001_ha,
1954 pm8001_printk("IO_XFER_ERROR_SATA_LINK_TIMEOUT\n"));
1955 ts->resp = SAS_TASK_UNDELIVERED;
1956 ts->stat = SAS_DEV_NO_RESPONSE;
1957 break;
1958 case IO_XFER_ERROR_REJECTED_NCQ_MODE:
1959 PM8001_IO_DBG(pm8001_ha,
1960 pm8001_printk("IO_XFER_ERROR_REJECTED_NCQ_MODE\n"));
1961 ts->resp = SAS_TASK_COMPLETE;
1962 ts->stat = SAS_DATA_UNDERRUN;
1963 break;
1964 case IO_XFER_OPEN_RETRY_TIMEOUT:
1965 PM8001_IO_DBG(pm8001_ha,
1966 pm8001_printk("IO_XFER_OPEN_RETRY_TIMEOUT\n"));
1967 ts->resp = SAS_TASK_COMPLETE;
1968 ts->stat = SAS_OPEN_TO;
1969 break;
1970 case IO_PORT_IN_RESET:
1971 PM8001_IO_DBG(pm8001_ha,
1972 pm8001_printk("IO_PORT_IN_RESET\n"));
1973 ts->resp = SAS_TASK_COMPLETE;
1974 ts->stat = SAS_DEV_NO_RESPONSE;
1975 break;
1976 case IO_DS_NON_OPERATIONAL:
1977 PM8001_IO_DBG(pm8001_ha,
1978 pm8001_printk("IO_DS_NON_OPERATIONAL\n"));
1979 ts->resp = SAS_TASK_COMPLETE;
1980 ts->stat = SAS_DEV_NO_RESPONSE;
1981 if (!t->uldd_task) {
1982 pm8001_handle_event(pm8001_ha, pm8001_dev,
1983 IO_DS_NON_OPERATIONAL);
1984 ts->resp = SAS_TASK_UNDELIVERED;
1985 ts->stat = SAS_QUEUE_FULL;
1986 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
1987 mb();
1988 spin_unlock_irq(&pm8001_ha->lock);
1989 t->task_done(t);
1990 spin_lock_irq(&pm8001_ha->lock);
1991 return;
1992 }
1993 break;
1994 case IO_DS_IN_RECOVERY:
1995 PM8001_IO_DBG(pm8001_ha,
1996 pm8001_printk("IO_DS_IN_RECOVERY\n"));
1997 ts->resp = SAS_TASK_COMPLETE;
1998 ts->stat = SAS_DEV_NO_RESPONSE;
1999 break;
2000 case IO_DS_IN_ERROR:
2001 PM8001_IO_DBG(pm8001_ha,
2002 pm8001_printk("IO_DS_IN_ERROR\n"));
2003 ts->resp = SAS_TASK_COMPLETE;
2004 ts->stat = SAS_DEV_NO_RESPONSE;
2005 if (!t->uldd_task) {
2006 pm8001_handle_event(pm8001_ha, pm8001_dev,
2007 IO_DS_IN_ERROR);
2008 ts->resp = SAS_TASK_UNDELIVERED;
2009 ts->stat = SAS_QUEUE_FULL;
2010 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2011 mb();
2012 spin_unlock_irq(&pm8001_ha->lock);
2013 t->task_done(t);
2014 spin_lock_irq(&pm8001_ha->lock);
2015 return;
2016 }
2017 break;
2018 case IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY:
2019 PM8001_IO_DBG(pm8001_ha,
2020 pm8001_printk("IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY\n"));
2021 ts->resp = SAS_TASK_COMPLETE;
2022 ts->stat = SAS_OPEN_REJECT;
2023 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2024 default:
2025 PM8001_IO_DBG(pm8001_ha,
2026 pm8001_printk("Unknown status 0x%x\n", status));
2027
2028 ts->resp = SAS_TASK_COMPLETE;
2029 ts->stat = SAS_DEV_NO_RESPONSE;
2030 break;
2031 }
2032 spin_lock_irqsave(&t->task_state_lock, flags);
2033 t->task_state_flags &= ~SAS_TASK_STATE_PENDING;
2034 t->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
2035 t->task_state_flags |= SAS_TASK_STATE_DONE;
2036 if (unlikely((t->task_state_flags & SAS_TASK_STATE_ABORTED))) {
2037 spin_unlock_irqrestore(&t->task_state_lock, flags);
2038 PM8001_FAIL_DBG(pm8001_ha,
2039 pm8001_printk("task 0x%p done with io_status 0x%x"
2040 " resp 0x%x stat 0x%x but aborted by upper layer!\n",
2041 t, status, ts->resp, ts->stat));
2042 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2043 } else if (t->uldd_task) {
2044 spin_unlock_irqrestore(&t->task_state_lock, flags);
2045 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2046 mb();
2047 spin_unlock_irq(&pm8001_ha->lock);
2048 t->task_done(t);
2049 spin_lock_irq(&pm8001_ha->lock);
2050 } else if (!t->uldd_task) {
2051 spin_unlock_irqrestore(&t->task_state_lock, flags);
2052 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2053 mb();
2054 spin_unlock_irq(&pm8001_ha->lock);
2055 t->task_done(t);
2056 spin_lock_irq(&pm8001_ha->lock);
2057 }
2058}
2059
2060
2061static void mpi_sata_event(struct pm8001_hba_info *pm8001_ha , void *piomb)
2062{
2063 struct sas_task *t;
2064 struct task_status_struct *ts;
2065 struct pm8001_ccb_info *ccb;
2066 struct pm8001_device *pm8001_dev;
2067 struct sata_event_resp *psataPayload =
2068 (struct sata_event_resp *)(piomb + 4);
2069 u32 event = le32_to_cpu(psataPayload->event);
2070 u32 tag = le32_to_cpu(psataPayload->tag);
2071 u32 port_id = le32_to_cpu(psataPayload->port_id);
2072 u32 dev_id = le32_to_cpu(psataPayload->device_id);
2073 unsigned long flags;
2074
2075 ccb = &pm8001_ha->ccb_info[tag];
2076
2077 if (ccb) {
2078 t = ccb->task;
2079 pm8001_dev = ccb->device;
2080 } else {
2081 PM8001_FAIL_DBG(pm8001_ha,
2082 pm8001_printk("No CCB !!!. returning\n"));
2083 return;
2084 }
2085 if (event)
2086 PM8001_FAIL_DBG(pm8001_ha,
2087 pm8001_printk("SATA EVENT 0x%x\n", event));
2088
2089
2090 if (event == IO_XFER_ERROR_ABORTED_NCQ_MODE) {
2091
2092 pm8001_dev = pm8001_find_dev(pm8001_ha, dev_id);
2093
2094 if (pm8001_dev)
2095 pm80xx_send_read_log(pm8001_ha, pm8001_dev);
2096 return;
2097 }
2098
2099 if (unlikely(!t || !t->lldd_task || !t->dev)) {
2100 PM8001_FAIL_DBG(pm8001_ha,
2101 pm8001_printk("task or dev null\n"));
2102 return;
2103 }
2104
2105 ts = &t->task_status;
2106 PM8001_IO_DBG(pm8001_ha,
2107 pm8001_printk("port_id:0x%x, tag:0x%x, event:0x%x\n",
2108 port_id, tag, event));
2109 switch (event) {
2110 case IO_OVERFLOW:
2111 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_UNDERFLOW\n"));
2112 ts->resp = SAS_TASK_COMPLETE;
2113 ts->stat = SAS_DATA_OVERRUN;
2114 ts->residual = 0;
2115 if (pm8001_dev)
2116 pm8001_dev->running_req--;
2117 break;
2118 case IO_XFER_ERROR_BREAK:
2119 PM8001_IO_DBG(pm8001_ha,
2120 pm8001_printk("IO_XFER_ERROR_BREAK\n"));
2121 ts->resp = SAS_TASK_COMPLETE;
2122 ts->stat = SAS_INTERRUPTED;
2123 break;
2124 case IO_XFER_ERROR_PHY_NOT_READY:
2125 PM8001_IO_DBG(pm8001_ha,
2126 pm8001_printk("IO_XFER_ERROR_PHY_NOT_READY\n"));
2127 ts->resp = SAS_TASK_COMPLETE;
2128 ts->stat = SAS_OPEN_REJECT;
2129 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2130 break;
2131 case IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED:
2132 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2133 "IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED\n"));
2134 ts->resp = SAS_TASK_COMPLETE;
2135 ts->stat = SAS_OPEN_REJECT;
2136 ts->open_rej_reason = SAS_OREJ_EPROTO;
2137 break;
2138 case IO_OPEN_CNX_ERROR_ZONE_VIOLATION:
2139 PM8001_IO_DBG(pm8001_ha,
2140 pm8001_printk("IO_OPEN_CNX_ERROR_ZONE_VIOLATION\n"));
2141 ts->resp = SAS_TASK_COMPLETE;
2142 ts->stat = SAS_OPEN_REJECT;
2143 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
2144 break;
2145 case IO_OPEN_CNX_ERROR_BREAK:
2146 PM8001_IO_DBG(pm8001_ha,
2147 pm8001_printk("IO_OPEN_CNX_ERROR_BREAK\n"));
2148 ts->resp = SAS_TASK_COMPLETE;
2149 ts->stat = SAS_OPEN_REJECT;
2150 ts->open_rej_reason = SAS_OREJ_RSVD_CONT0;
2151 break;
2152 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS:
2153 case IO_XFER_OPEN_RETRY_BACKOFF_THRESHOLD_REACHED:
2154 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_TMO:
2155 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_NO_DEST:
2156 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_COLLIDE:
2157 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_PATHWAY_BLOCKED:
2158 PM8001_FAIL_DBG(pm8001_ha,
2159 pm8001_printk("IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS\n"));
2160 ts->resp = SAS_TASK_UNDELIVERED;
2161 ts->stat = SAS_DEV_NO_RESPONSE;
2162 if (!t->uldd_task) {
2163 pm8001_handle_event(pm8001_ha,
2164 pm8001_dev,
2165 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
2166 ts->resp = SAS_TASK_COMPLETE;
2167 ts->stat = SAS_QUEUE_FULL;
2168 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2169 mb();
2170 spin_unlock_irq(&pm8001_ha->lock);
2171 t->task_done(t);
2172 spin_lock_irq(&pm8001_ha->lock);
2173 return;
2174 }
2175 break;
2176 case IO_OPEN_CNX_ERROR_BAD_DESTINATION:
2177 PM8001_IO_DBG(pm8001_ha,
2178 pm8001_printk("IO_OPEN_CNX_ERROR_BAD_DESTINATION\n"));
2179 ts->resp = SAS_TASK_UNDELIVERED;
2180 ts->stat = SAS_OPEN_REJECT;
2181 ts->open_rej_reason = SAS_OREJ_BAD_DEST;
2182 break;
2183 case IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED:
2184 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2185 "IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED\n"));
2186 ts->resp = SAS_TASK_COMPLETE;
2187 ts->stat = SAS_OPEN_REJECT;
2188 ts->open_rej_reason = SAS_OREJ_CONN_RATE;
2189 break;
2190 case IO_OPEN_CNX_ERROR_WRONG_DESTINATION:
2191 PM8001_IO_DBG(pm8001_ha,
2192 pm8001_printk("IO_OPEN_CNX_ERROR_WRONG_DESTINATION\n"));
2193 ts->resp = SAS_TASK_COMPLETE;
2194 ts->stat = SAS_OPEN_REJECT;
2195 ts->open_rej_reason = SAS_OREJ_WRONG_DEST;
2196 break;
2197 case IO_XFER_ERROR_NAK_RECEIVED:
2198 PM8001_IO_DBG(pm8001_ha,
2199 pm8001_printk("IO_XFER_ERROR_NAK_RECEIVED\n"));
2200 ts->resp = SAS_TASK_COMPLETE;
2201 ts->stat = SAS_NAK_R_ERR;
2202 break;
2203 case IO_XFER_ERROR_PEER_ABORTED:
2204 PM8001_IO_DBG(pm8001_ha,
2205 pm8001_printk("IO_XFER_ERROR_PEER_ABORTED\n"));
2206 ts->resp = SAS_TASK_COMPLETE;
2207 ts->stat = SAS_NAK_R_ERR;
2208 break;
2209 case IO_XFER_ERROR_REJECTED_NCQ_MODE:
2210 PM8001_IO_DBG(pm8001_ha,
2211 pm8001_printk("IO_XFER_ERROR_REJECTED_NCQ_MODE\n"));
2212 ts->resp = SAS_TASK_COMPLETE;
2213 ts->stat = SAS_DATA_UNDERRUN;
2214 break;
2215 case IO_XFER_OPEN_RETRY_TIMEOUT:
2216 PM8001_IO_DBG(pm8001_ha,
2217 pm8001_printk("IO_XFER_OPEN_RETRY_TIMEOUT\n"));
2218 ts->resp = SAS_TASK_COMPLETE;
2219 ts->stat = SAS_OPEN_TO;
2220 break;
2221 case IO_XFER_ERROR_UNEXPECTED_PHASE:
2222 PM8001_IO_DBG(pm8001_ha,
2223 pm8001_printk("IO_XFER_ERROR_UNEXPECTED_PHASE\n"));
2224 ts->resp = SAS_TASK_COMPLETE;
2225 ts->stat = SAS_OPEN_TO;
2226 break;
2227 case IO_XFER_ERROR_XFER_RDY_OVERRUN:
2228 PM8001_IO_DBG(pm8001_ha,
2229 pm8001_printk("IO_XFER_ERROR_XFER_RDY_OVERRUN\n"));
2230 ts->resp = SAS_TASK_COMPLETE;
2231 ts->stat = SAS_OPEN_TO;
2232 break;
2233 case IO_XFER_ERROR_XFER_RDY_NOT_EXPECTED:
2234 PM8001_IO_DBG(pm8001_ha,
2235 pm8001_printk("IO_XFER_ERROR_XFER_RDY_NOT_EXPECTED\n"));
2236 ts->resp = SAS_TASK_COMPLETE;
2237 ts->stat = SAS_OPEN_TO;
2238 break;
2239 case IO_XFER_ERROR_OFFSET_MISMATCH:
2240 PM8001_IO_DBG(pm8001_ha,
2241 pm8001_printk("IO_XFER_ERROR_OFFSET_MISMATCH\n"));
2242 ts->resp = SAS_TASK_COMPLETE;
2243 ts->stat = SAS_OPEN_TO;
2244 break;
2245 case IO_XFER_ERROR_XFER_ZERO_DATA_LEN:
2246 PM8001_IO_DBG(pm8001_ha,
2247 pm8001_printk("IO_XFER_ERROR_XFER_ZERO_DATA_LEN\n"));
2248 ts->resp = SAS_TASK_COMPLETE;
2249 ts->stat = SAS_OPEN_TO;
2250 break;
2251 case IO_XFER_CMD_FRAME_ISSUED:
2252 PM8001_IO_DBG(pm8001_ha,
2253 pm8001_printk("IO_XFER_CMD_FRAME_ISSUED\n"));
2254 break;
2255 case IO_XFER_PIO_SETUP_ERROR:
2256 PM8001_IO_DBG(pm8001_ha,
2257 pm8001_printk("IO_XFER_PIO_SETUP_ERROR\n"));
2258 ts->resp = SAS_TASK_COMPLETE;
2259 ts->stat = SAS_OPEN_TO;
2260 break;
2261 case IO_XFER_ERROR_INTERNAL_CRC_ERROR:
2262 PM8001_FAIL_DBG(pm8001_ha,
2263 pm8001_printk("IO_XFR_ERROR_INTERNAL_CRC_ERROR\n"));
2264
2265 ts->resp = SAS_TASK_COMPLETE;
2266 ts->stat = SAS_OPEN_TO;
2267 break;
2268 case IO_XFER_DMA_ACTIVATE_TIMEOUT:
2269 PM8001_FAIL_DBG(pm8001_ha,
2270 pm8001_printk("IO_XFR_DMA_ACTIVATE_TIMEOUT\n"));
2271
2272 ts->resp = SAS_TASK_COMPLETE;
2273 ts->stat = SAS_OPEN_TO;
2274 break;
2275 default:
2276 PM8001_IO_DBG(pm8001_ha,
2277 pm8001_printk("Unknown status 0x%x\n", event));
2278
2279 ts->resp = SAS_TASK_COMPLETE;
2280 ts->stat = SAS_OPEN_TO;
2281 break;
2282 }
2283 spin_lock_irqsave(&t->task_state_lock, flags);
2284 t->task_state_flags &= ~SAS_TASK_STATE_PENDING;
2285 t->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
2286 t->task_state_flags |= SAS_TASK_STATE_DONE;
2287 if (unlikely((t->task_state_flags & SAS_TASK_STATE_ABORTED))) {
2288 spin_unlock_irqrestore(&t->task_state_lock, flags);
2289 PM8001_FAIL_DBG(pm8001_ha,
2290 pm8001_printk("task 0x%p done with io_status 0x%x"
2291 " resp 0x%x stat 0x%x but aborted by upper layer!\n",
2292 t, event, ts->resp, ts->stat));
2293 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2294 } else if (t->uldd_task) {
2295 spin_unlock_irqrestore(&t->task_state_lock, flags);
2296 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2297 mb();
2298 spin_unlock_irq(&pm8001_ha->lock);
2299 t->task_done(t);
2300 spin_lock_irq(&pm8001_ha->lock);
2301 } else if (!t->uldd_task) {
2302 spin_unlock_irqrestore(&t->task_state_lock, flags);
2303 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2304 mb();
2305 spin_unlock_irq(&pm8001_ha->lock);
2306 t->task_done(t);
2307 spin_lock_irq(&pm8001_ha->lock);
2308 }
2309}
2310
2311
2312static void
2313mpi_smp_completion(struct pm8001_hba_info *pm8001_ha, void *piomb)
2314{
2315 u32 param, i;
2316 struct sas_task *t;
2317 struct pm8001_ccb_info *ccb;
2318 unsigned long flags;
2319 u32 status;
2320 u32 tag;
2321 struct smp_completion_resp *psmpPayload;
2322 struct task_status_struct *ts;
2323 struct pm8001_device *pm8001_dev;
2324 char *pdma_respaddr = NULL;
2325
2326 psmpPayload = (struct smp_completion_resp *)(piomb + 4);
2327 status = le32_to_cpu(psmpPayload->status);
2328 tag = le32_to_cpu(psmpPayload->tag);
2329
2330 ccb = &pm8001_ha->ccb_info[tag];
2331 param = le32_to_cpu(psmpPayload->param);
2332 t = ccb->task;
2333 ts = &t->task_status;
2334 pm8001_dev = ccb->device;
2335 if (status)
2336 PM8001_FAIL_DBG(pm8001_ha,
2337 pm8001_printk("smp IO status 0x%x\n", status));
2338 if (unlikely(!t || !t->lldd_task || !t->dev))
2339 return;
2340
2341 switch (status) {
2342
2343 case IO_SUCCESS:
2344 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_SUCCESS\n"));
2345 ts->resp = SAS_TASK_COMPLETE;
2346 ts->stat = SAM_STAT_GOOD;
2347 if (pm8001_dev)
2348 pm8001_dev->running_req--;
2349 if (pm8001_ha->smp_exp_mode == SMP_DIRECT) {
2350 PM8001_IO_DBG(pm8001_ha,
2351 pm8001_printk("DIRECT RESPONSE Length:%d\n",
2352 param));
2353 pdma_respaddr = (char *)(phys_to_virt(cpu_to_le64
2354 ((u64)sg_dma_address
2355 (&t->smp_task.smp_resp))));
2356 for (i = 0; i < param; i++) {
2357 *(pdma_respaddr+i) = psmpPayload->_r_a[i];
2358 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2359 "SMP Byte%d DMA data 0x%x psmp 0x%x\n",
2360 i, *(pdma_respaddr+i),
2361 psmpPayload->_r_a[i]));
2362 }
2363 }
2364 break;
2365 case IO_ABORTED:
2366 PM8001_IO_DBG(pm8001_ha,
2367 pm8001_printk("IO_ABORTED IOMB\n"));
2368 ts->resp = SAS_TASK_COMPLETE;
2369 ts->stat = SAS_ABORTED_TASK;
2370 if (pm8001_dev)
2371 pm8001_dev->running_req--;
2372 break;
2373 case IO_OVERFLOW:
2374 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_UNDERFLOW\n"));
2375 ts->resp = SAS_TASK_COMPLETE;
2376 ts->stat = SAS_DATA_OVERRUN;
2377 ts->residual = 0;
2378 if (pm8001_dev)
2379 pm8001_dev->running_req--;
2380 break;
2381 case IO_NO_DEVICE:
2382 PM8001_IO_DBG(pm8001_ha, pm8001_printk("IO_NO_DEVICE\n"));
2383 ts->resp = SAS_TASK_COMPLETE;
2384 ts->stat = SAS_PHY_DOWN;
2385 break;
2386 case IO_ERROR_HW_TIMEOUT:
2387 PM8001_IO_DBG(pm8001_ha,
2388 pm8001_printk("IO_ERROR_HW_TIMEOUT\n"));
2389 ts->resp = SAS_TASK_COMPLETE;
2390 ts->stat = SAM_STAT_BUSY;
2391 break;
2392 case IO_XFER_ERROR_BREAK:
2393 PM8001_IO_DBG(pm8001_ha,
2394 pm8001_printk("IO_XFER_ERROR_BREAK\n"));
2395 ts->resp = SAS_TASK_COMPLETE;
2396 ts->stat = SAM_STAT_BUSY;
2397 break;
2398 case IO_XFER_ERROR_PHY_NOT_READY:
2399 PM8001_IO_DBG(pm8001_ha,
2400 pm8001_printk("IO_XFER_ERROR_PHY_NOT_READY\n"));
2401 ts->resp = SAS_TASK_COMPLETE;
2402 ts->stat = SAM_STAT_BUSY;
2403 break;
2404 case IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED:
2405 PM8001_IO_DBG(pm8001_ha,
2406 pm8001_printk("IO_OPEN_CNX_ERROR_PROTOCOL_NOT_SUPPORTED\n"));
2407 ts->resp = SAS_TASK_COMPLETE;
2408 ts->stat = SAS_OPEN_REJECT;
2409 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
2410 break;
2411 case IO_OPEN_CNX_ERROR_ZONE_VIOLATION:
2412 PM8001_IO_DBG(pm8001_ha,
2413 pm8001_printk("IO_OPEN_CNX_ERROR_ZONE_VIOLATION\n"));
2414 ts->resp = SAS_TASK_COMPLETE;
2415 ts->stat = SAS_OPEN_REJECT;
2416 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
2417 break;
2418 case IO_OPEN_CNX_ERROR_BREAK:
2419 PM8001_IO_DBG(pm8001_ha,
2420 pm8001_printk("IO_OPEN_CNX_ERROR_BREAK\n"));
2421 ts->resp = SAS_TASK_COMPLETE;
2422 ts->stat = SAS_OPEN_REJECT;
2423 ts->open_rej_reason = SAS_OREJ_RSVD_CONT0;
2424 break;
2425 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS:
2426 case IO_XFER_OPEN_RETRY_BACKOFF_THRESHOLD_REACHED:
2427 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_TMO:
2428 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_NO_DEST:
2429 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_OPEN_COLLIDE:
2430 case IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS_PATHWAY_BLOCKED:
2431 PM8001_IO_DBG(pm8001_ha,
2432 pm8001_printk("IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS\n"));
2433 ts->resp = SAS_TASK_COMPLETE;
2434 ts->stat = SAS_OPEN_REJECT;
2435 ts->open_rej_reason = SAS_OREJ_UNKNOWN;
2436 pm8001_handle_event(pm8001_ha,
2437 pm8001_dev,
2438 IO_OPEN_CNX_ERROR_IT_NEXUS_LOSS);
2439 break;
2440 case IO_OPEN_CNX_ERROR_BAD_DESTINATION:
2441 PM8001_IO_DBG(pm8001_ha,
2442 pm8001_printk("IO_OPEN_CNX_ERROR_BAD_DESTINATION\n"));
2443 ts->resp = SAS_TASK_COMPLETE;
2444 ts->stat = SAS_OPEN_REJECT;
2445 ts->open_rej_reason = SAS_OREJ_BAD_DEST;
2446 break;
2447 case IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED:
2448 PM8001_IO_DBG(pm8001_ha, pm8001_printk(\
2449 "IO_OPEN_CNX_ERROR_CONNECTION_RATE_NOT_SUPPORTED\n"));
2450 ts->resp = SAS_TASK_COMPLETE;
2451 ts->stat = SAS_OPEN_REJECT;
2452 ts->open_rej_reason = SAS_OREJ_CONN_RATE;
2453 break;
2454 case IO_OPEN_CNX_ERROR_WRONG_DESTINATION:
2455 PM8001_IO_DBG(pm8001_ha,
2456 pm8001_printk("IO_OPEN_CNX_ERROR_WRONG_DESTINATION\n"));
2457 ts->resp = SAS_TASK_COMPLETE;
2458 ts->stat = SAS_OPEN_REJECT;
2459 ts->open_rej_reason = SAS_OREJ_WRONG_DEST;
2460 break;
2461 case IO_XFER_ERROR_RX_FRAME:
2462 PM8001_IO_DBG(pm8001_ha,
2463 pm8001_printk("IO_XFER_ERROR_RX_FRAME\n"));
2464 ts->resp = SAS_TASK_COMPLETE;
2465 ts->stat = SAS_DEV_NO_RESPONSE;
2466 break;
2467 case IO_XFER_OPEN_RETRY_TIMEOUT:
2468 PM8001_IO_DBG(pm8001_ha,
2469 pm8001_printk("IO_XFER_OPEN_RETRY_TIMEOUT\n"));
2470 ts->resp = SAS_TASK_COMPLETE;
2471 ts->stat = SAS_OPEN_REJECT;
2472 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2473 break;
2474 case IO_ERROR_INTERNAL_SMP_RESOURCE:
2475 PM8001_IO_DBG(pm8001_ha,
2476 pm8001_printk("IO_ERROR_INTERNAL_SMP_RESOURCE\n"));
2477 ts->resp = SAS_TASK_COMPLETE;
2478 ts->stat = SAS_QUEUE_FULL;
2479 break;
2480 case IO_PORT_IN_RESET:
2481 PM8001_IO_DBG(pm8001_ha,
2482 pm8001_printk("IO_PORT_IN_RESET\n"));
2483 ts->resp = SAS_TASK_COMPLETE;
2484 ts->stat = SAS_OPEN_REJECT;
2485 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2486 break;
2487 case IO_DS_NON_OPERATIONAL:
2488 PM8001_IO_DBG(pm8001_ha,
2489 pm8001_printk("IO_DS_NON_OPERATIONAL\n"));
2490 ts->resp = SAS_TASK_COMPLETE;
2491 ts->stat = SAS_DEV_NO_RESPONSE;
2492 break;
2493 case IO_DS_IN_RECOVERY:
2494 PM8001_IO_DBG(pm8001_ha,
2495 pm8001_printk("IO_DS_IN_RECOVERY\n"));
2496 ts->resp = SAS_TASK_COMPLETE;
2497 ts->stat = SAS_OPEN_REJECT;
2498 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2499 break;
2500 case IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY:
2501 PM8001_IO_DBG(pm8001_ha,
2502 pm8001_printk("IO_OPEN_CNX_ERROR_HW_RESOURCE_BUSY\n"));
2503 ts->resp = SAS_TASK_COMPLETE;
2504 ts->stat = SAS_OPEN_REJECT;
2505 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY;
2506 break;
2507 default:
2508 PM8001_IO_DBG(pm8001_ha,
2509 pm8001_printk("Unknown status 0x%x\n", status));
2510 ts->resp = SAS_TASK_COMPLETE;
2511 ts->stat = SAS_DEV_NO_RESPONSE;
2512
2513 break;
2514 }
2515 spin_lock_irqsave(&t->task_state_lock, flags);
2516 t->task_state_flags &= ~SAS_TASK_STATE_PENDING;
2517 t->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
2518 t->task_state_flags |= SAS_TASK_STATE_DONE;
2519 if (unlikely((t->task_state_flags & SAS_TASK_STATE_ABORTED))) {
2520 spin_unlock_irqrestore(&t->task_state_lock, flags);
2521 PM8001_FAIL_DBG(pm8001_ha, pm8001_printk(
2522 "task 0x%p done with io_status 0x%x resp 0x%x"
2523 "stat 0x%x but aborted by upper layer!\n",
2524 t, status, ts->resp, ts->stat));
2525 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2526 } else {
2527 spin_unlock_irqrestore(&t->task_state_lock, flags);
2528 pm8001_ccb_task_free(pm8001_ha, t, ccb, tag);
2529 mb();
2530 t->task_done(t);
2531 }
2532}
2533
2534
2535
2536
2537
2538
2539
2540
2541
2542
2543
2544static void pm80xx_hw_event_ack_req(struct pm8001_hba_info *pm8001_ha,
2545 u32 Qnum, u32 SEA, u32 port_id, u32 phyId, u32 param0, u32 param1)
2546{
2547 struct hw_event_ack_req payload;
2548 u32 opc = OPC_INB_SAS_HW_EVENT_ACK;
2549
2550 struct inbound_queue_table *circularQ;
2551
2552 memset((u8 *)&payload, 0, sizeof(payload));
2553 circularQ = &pm8001_ha->inbnd_q_tbl[Qnum];
2554 payload.tag = cpu_to_le32(1);
2555 payload.phyid_sea_portid = cpu_to_le32(((SEA & 0xFFFF) << 8) |
2556 ((phyId & 0xFF) << 24) | (port_id & 0xFF));
2557 payload.param0 = cpu_to_le32(param0);
2558 payload.param1 = cpu_to_le32(param1);
2559 pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
2560}
2561
2562static int pm80xx_chip_phy_ctl_req(struct pm8001_hba_info *pm8001_ha,
2563 u32 phyId, u32 phy_op);
2564
2565
2566
2567
2568
2569
2570static void
2571hw_event_sas_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb)
2572{
2573 struct hw_event_resp *pPayload =
2574 (struct hw_event_resp *)(piomb + 4);
2575 u32 lr_status_evt_portid =
2576 le32_to_cpu(pPayload->lr_status_evt_portid);
2577 u32 phyid_npip_portstate = le32_to_cpu(pPayload->phyid_npip_portstate);
2578
2579 u8 link_rate =
2580 (u8)((lr_status_evt_portid & 0xF0000000) >> 28);
2581 u8 port_id = (u8)(lr_status_evt_portid & 0x000000FF);
2582 u8 phy_id =
2583 (u8)((phyid_npip_portstate & 0xFF0000) >> 16);
2584 u8 portstate = (u8)(phyid_npip_portstate & 0x0000000F);
2585
2586 struct pm8001_port *port = &pm8001_ha->port[port_id];
2587 struct sas_ha_struct *sas_ha = pm8001_ha->sas;
2588 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id];
2589 unsigned long flags;
2590 u8 deviceType = pPayload->sas_identify.dev_type;
2591 port->port_state = portstate;
2592 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
2593 "portid:%d; phyid:%d; linkrate:%d; "
2594 "portstate:%x; devicetype:%x\n",
2595 port_id, phy_id, link_rate, portstate, deviceType));
2596
2597 switch (deviceType) {
2598 case SAS_PHY_UNUSED:
2599 PM8001_MSG_DBG(pm8001_ha,
2600 pm8001_printk("device type no device.\n"));
2601 break;
2602 case SAS_END_DEVICE:
2603 PM8001_MSG_DBG(pm8001_ha, pm8001_printk("end device.\n"));
2604 pm80xx_chip_phy_ctl_req(pm8001_ha, phy_id,
2605 PHY_NOTIFY_ENABLE_SPINUP);
2606 port->port_attached = 1;
2607 pm8001_get_lrate_mode(phy, link_rate);
2608 break;
2609 case SAS_EDGE_EXPANDER_DEVICE:
2610 PM8001_MSG_DBG(pm8001_ha,
2611 pm8001_printk("expander device.\n"));
2612 port->port_attached = 1;
2613 pm8001_get_lrate_mode(phy, link_rate);
2614 break;
2615 case SAS_FANOUT_EXPANDER_DEVICE:
2616 PM8001_MSG_DBG(pm8001_ha,
2617 pm8001_printk("fanout expander device.\n"));
2618 port->port_attached = 1;
2619 pm8001_get_lrate_mode(phy, link_rate);
2620 break;
2621 default:
2622 PM8001_MSG_DBG(pm8001_ha,
2623 pm8001_printk("unknown device type(%x)\n", deviceType));
2624 break;
2625 }
2626 phy->phy_type |= PORT_TYPE_SAS;
2627 phy->identify.device_type = deviceType;
2628 phy->phy_attached = 1;
2629 if (phy->identify.device_type == SAS_END_DEVICE)
2630 phy->identify.target_port_protocols = SAS_PROTOCOL_SSP;
2631 else if (phy->identify.device_type != SAS_PHY_UNUSED)
2632 phy->identify.target_port_protocols = SAS_PROTOCOL_SMP;
2633 phy->sas_phy.oob_mode = SAS_OOB_MODE;
2634 sas_ha->notify_phy_event(&phy->sas_phy, PHYE_OOB_DONE);
2635 spin_lock_irqsave(&phy->sas_phy.frame_rcvd_lock, flags);
2636 memcpy(phy->frame_rcvd, &pPayload->sas_identify,
2637 sizeof(struct sas_identify_frame)-4);
2638 phy->frame_rcvd_size = sizeof(struct sas_identify_frame) - 4;
2639 pm8001_get_attached_sas_addr(phy, phy->sas_phy.attached_sas_addr);
2640 spin_unlock_irqrestore(&phy->sas_phy.frame_rcvd_lock, flags);
2641 if (pm8001_ha->flags == PM8001F_RUN_TIME)
2642 mdelay(200);
2643 pm8001_bytes_dmaed(pm8001_ha, phy_id);
2644}
2645
2646
2647
2648
2649
2650
2651static void
2652hw_event_sata_phy_up(struct pm8001_hba_info *pm8001_ha, void *piomb)
2653{
2654 struct hw_event_resp *pPayload =
2655 (struct hw_event_resp *)(piomb + 4);
2656 u32 phyid_npip_portstate = le32_to_cpu(pPayload->phyid_npip_portstate);
2657 u32 lr_status_evt_portid =
2658 le32_to_cpu(pPayload->lr_status_evt_portid);
2659 u8 link_rate =
2660 (u8)((lr_status_evt_portid & 0xF0000000) >> 28);
2661 u8 port_id = (u8)(lr_status_evt_portid & 0x000000FF);
2662 u8 phy_id =
2663 (u8)((phyid_npip_portstate & 0xFF0000) >> 16);
2664
2665 u8 portstate = (u8)(phyid_npip_portstate & 0x0000000F);
2666
2667 struct pm8001_port *port = &pm8001_ha->port[port_id];
2668 struct sas_ha_struct *sas_ha = pm8001_ha->sas;
2669 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id];
2670 unsigned long flags;
2671 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
2672 "port id %d, phy id %d link_rate %d portstate 0x%x\n",
2673 port_id, phy_id, link_rate, portstate));
2674
2675 port->port_state = portstate;
2676 port->port_attached = 1;
2677 pm8001_get_lrate_mode(phy, link_rate);
2678 phy->phy_type |= PORT_TYPE_SATA;
2679 phy->phy_attached = 1;
2680 phy->sas_phy.oob_mode = SATA_OOB_MODE;
2681 sas_ha->notify_phy_event(&phy->sas_phy, PHYE_OOB_DONE);
2682 spin_lock_irqsave(&phy->sas_phy.frame_rcvd_lock, flags);
2683 memcpy(phy->frame_rcvd, ((u8 *)&pPayload->sata_fis - 4),
2684 sizeof(struct dev_to_host_fis));
2685 phy->frame_rcvd_size = sizeof(struct dev_to_host_fis);
2686 phy->identify.target_port_protocols = SAS_PROTOCOL_SATA;
2687 phy->identify.device_type = SAS_SATA_DEV;
2688 pm8001_get_attached_sas_addr(phy, phy->sas_phy.attached_sas_addr);
2689 spin_unlock_irqrestore(&phy->sas_phy.frame_rcvd_lock, flags);
2690 pm8001_bytes_dmaed(pm8001_ha, phy_id);
2691}
2692
2693
2694
2695
2696
2697
2698static void
2699hw_event_phy_down(struct pm8001_hba_info *pm8001_ha, void *piomb)
2700{
2701 struct hw_event_resp *pPayload =
2702 (struct hw_event_resp *)(piomb + 4);
2703
2704 u32 lr_status_evt_portid =
2705 le32_to_cpu(pPayload->lr_status_evt_portid);
2706 u8 port_id = (u8)(lr_status_evt_portid & 0x000000FF);
2707 u32 phyid_npip_portstate = le32_to_cpu(pPayload->phyid_npip_portstate);
2708 u8 phy_id =
2709 (u8)((phyid_npip_portstate & 0xFF0000) >> 16);
2710 u8 portstate = (u8)(phyid_npip_portstate & 0x0000000F);
2711
2712 struct pm8001_port *port = &pm8001_ha->port[port_id];
2713 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id];
2714 port->port_state = portstate;
2715 phy->phy_type = 0;
2716 phy->identify.device_type = 0;
2717 phy->phy_attached = 0;
2718 memset(&phy->dev_sas_addr, 0, SAS_ADDR_SIZE);
2719 switch (portstate) {
2720 case PORT_VALID:
2721 break;
2722 case PORT_INVALID:
2723 PM8001_MSG_DBG(pm8001_ha,
2724 pm8001_printk(" PortInvalid portID %d\n", port_id));
2725 PM8001_MSG_DBG(pm8001_ha,
2726 pm8001_printk(" Last phy Down and port invalid\n"));
2727 port->port_attached = 0;
2728 pm80xx_hw_event_ack_req(pm8001_ha, 0, HW_EVENT_PHY_DOWN,
2729 port_id, phy_id, 0, 0);
2730 break;
2731 case PORT_IN_RESET:
2732 PM8001_MSG_DBG(pm8001_ha,
2733 pm8001_printk(" Port In Reset portID %d\n", port_id));
2734 break;
2735 case PORT_NOT_ESTABLISHED:
2736 PM8001_MSG_DBG(pm8001_ha,
2737 pm8001_printk(" phy Down and PORT_NOT_ESTABLISHED\n"));
2738 port->port_attached = 0;
2739 break;
2740 case PORT_LOSTCOMM:
2741 PM8001_MSG_DBG(pm8001_ha,
2742 pm8001_printk(" phy Down and PORT_LOSTCOMM\n"));
2743 PM8001_MSG_DBG(pm8001_ha,
2744 pm8001_printk(" Last phy Down and port invalid\n"));
2745 port->port_attached = 0;
2746 pm80xx_hw_event_ack_req(pm8001_ha, 0, HW_EVENT_PHY_DOWN,
2747 port_id, phy_id, 0, 0);
2748 break;
2749 default:
2750 port->port_attached = 0;
2751 PM8001_MSG_DBG(pm8001_ha,
2752 pm8001_printk(" phy Down and(default) = 0x%x\n",
2753 portstate));
2754 break;
2755
2756 }
2757}
2758
2759static int mpi_phy_start_resp(struct pm8001_hba_info *pm8001_ha, void *piomb)
2760{
2761 struct phy_start_resp *pPayload =
2762 (struct phy_start_resp *)(piomb + 4);
2763 u32 status =
2764 le32_to_cpu(pPayload->status);
2765 u32 phy_id =
2766 le32_to_cpu(pPayload->phyid);
2767 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id];
2768
2769 PM8001_INIT_DBG(pm8001_ha,
2770 pm8001_printk("phy start resp status:0x%x, phyid:0x%x\n",
2771 status, phy_id));
2772 if (status == 0) {
2773 phy->phy_state = 1;
2774 if (pm8001_ha->flags == PM8001F_RUN_TIME)
2775 complete(phy->enable_completion);
2776 }
2777 return 0;
2778
2779}
2780
2781
2782
2783
2784
2785
2786static int mpi_thermal_hw_event(struct pm8001_hba_info *pm8001_ha, void *piomb)
2787{
2788 struct thermal_hw_event *pPayload =
2789 (struct thermal_hw_event *)(piomb + 4);
2790
2791 u32 thermal_event = le32_to_cpu(pPayload->thermal_event);
2792 u32 rht_lht = le32_to_cpu(pPayload->rht_lht);
2793
2794 if (thermal_event & 0x40) {
2795 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2796 "Thermal Event: Local high temperature violated!\n"));
2797 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2798 "Thermal Event: Measured local high temperature %d\n",
2799 ((rht_lht & 0xFF00) >> 8)));
2800 }
2801 if (thermal_event & 0x10) {
2802 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2803 "Thermal Event: Remote high temperature violated!\n"));
2804 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
2805 "Thermal Event: Measured remote high temperature %d\n",
2806 ((rht_lht & 0xFF000000) >> 24)));
2807 }
2808 return 0;
2809}
2810
2811
2812
2813
2814
2815
2816static int mpi_hw_event(struct pm8001_hba_info *pm8001_ha, void *piomb)
2817{
2818 unsigned long flags;
2819 struct hw_event_resp *pPayload =
2820 (struct hw_event_resp *)(piomb + 4);
2821 u32 lr_status_evt_portid =
2822 le32_to_cpu(pPayload->lr_status_evt_portid);
2823 u32 phyid_npip_portstate = le32_to_cpu(pPayload->phyid_npip_portstate);
2824 u8 port_id = (u8)(lr_status_evt_portid & 0x000000FF);
2825 u8 phy_id =
2826 (u8)((phyid_npip_portstate & 0xFF0000) >> 16);
2827 u16 eventType =
2828 (u16)((lr_status_evt_portid & 0x00FFFF00) >> 8);
2829 u8 status =
2830 (u8)((lr_status_evt_portid & 0x0F000000) >> 24);
2831
2832 struct sas_ha_struct *sas_ha = pm8001_ha->sas;
2833 struct pm8001_phy *phy = &pm8001_ha->phy[phy_id];
2834 struct asd_sas_phy *sas_phy = sas_ha->sas_phy[phy_id];
2835 PM8001_MSG_DBG(pm8001_ha,
2836 pm8001_printk("portid:%d phyid:%d event:0x%x status:0x%x\n",
2837 port_id, phy_id, eventType, status));
2838
2839 switch (eventType) {
2840
2841 case HW_EVENT_SAS_PHY_UP:
2842 PM8001_MSG_DBG(pm8001_ha,
2843 pm8001_printk("HW_EVENT_PHY_START_STATUS\n"));
2844 hw_event_sas_phy_up(pm8001_ha, piomb);
2845 break;
2846 case HW_EVENT_SATA_PHY_UP:
2847 PM8001_MSG_DBG(pm8001_ha,
2848 pm8001_printk("HW_EVENT_SATA_PHY_UP\n"));
2849 hw_event_sata_phy_up(pm8001_ha, piomb);
2850 break;
2851 case HW_EVENT_SATA_SPINUP_HOLD:
2852 PM8001_MSG_DBG(pm8001_ha,
2853 pm8001_printk("HW_EVENT_SATA_SPINUP_HOLD\n"));
2854 sas_ha->notify_phy_event(&phy->sas_phy, PHYE_SPINUP_HOLD);
2855 break;
2856 case HW_EVENT_PHY_DOWN:
2857 PM8001_MSG_DBG(pm8001_ha,
2858 pm8001_printk("HW_EVENT_PHY_DOWN\n"));
2859 sas_ha->notify_phy_event(&phy->sas_phy, PHYE_LOSS_OF_SIGNAL);
2860 phy->phy_attached = 0;
2861 phy->phy_state = 0;
2862 hw_event_phy_down(pm8001_ha, piomb);
2863 break;
2864 case HW_EVENT_PORT_INVALID:
2865 PM8001_MSG_DBG(pm8001_ha,
2866 pm8001_printk("HW_EVENT_PORT_INVALID\n"));
2867 sas_phy_disconnected(sas_phy);
2868 phy->phy_attached = 0;
2869 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2870 break;
2871
2872
2873 case HW_EVENT_BROADCAST_CHANGE:
2874 PM8001_MSG_DBG(pm8001_ha,
2875 pm8001_printk("HW_EVENT_BROADCAST_CHANGE\n"));
2876 pm80xx_hw_event_ack_req(pm8001_ha, 0, HW_EVENT_BROADCAST_CHANGE,
2877 port_id, phy_id, 1, 0);
2878 spin_lock_irqsave(&sas_phy->sas_prim_lock, flags);
2879 sas_phy->sas_prim = HW_EVENT_BROADCAST_CHANGE;
2880 spin_unlock_irqrestore(&sas_phy->sas_prim_lock, flags);
2881 sas_ha->notify_port_event(sas_phy, PORTE_BROADCAST_RCVD);
2882 break;
2883 case HW_EVENT_PHY_ERROR:
2884 PM8001_MSG_DBG(pm8001_ha,
2885 pm8001_printk("HW_EVENT_PHY_ERROR\n"));
2886 sas_phy_disconnected(&phy->sas_phy);
2887 phy->phy_attached = 0;
2888 sas_ha->notify_phy_event(&phy->sas_phy, PHYE_OOB_ERROR);
2889 break;
2890 case HW_EVENT_BROADCAST_EXP:
2891 PM8001_MSG_DBG(pm8001_ha,
2892 pm8001_printk("HW_EVENT_BROADCAST_EXP\n"));
2893 spin_lock_irqsave(&sas_phy->sas_prim_lock, flags);
2894 sas_phy->sas_prim = HW_EVENT_BROADCAST_EXP;
2895 spin_unlock_irqrestore(&sas_phy->sas_prim_lock, flags);
2896 sas_ha->notify_port_event(sas_phy, PORTE_BROADCAST_RCVD);
2897 break;
2898 case HW_EVENT_LINK_ERR_INVALID_DWORD:
2899 PM8001_MSG_DBG(pm8001_ha,
2900 pm8001_printk("HW_EVENT_LINK_ERR_INVALID_DWORD\n"));
2901 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2902 HW_EVENT_LINK_ERR_INVALID_DWORD, port_id, phy_id, 0, 0);
2903 sas_phy_disconnected(sas_phy);
2904 phy->phy_attached = 0;
2905 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2906 break;
2907 case HW_EVENT_LINK_ERR_DISPARITY_ERROR:
2908 PM8001_MSG_DBG(pm8001_ha,
2909 pm8001_printk("HW_EVENT_LINK_ERR_DISPARITY_ERROR\n"));
2910 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2911 HW_EVENT_LINK_ERR_DISPARITY_ERROR,
2912 port_id, phy_id, 0, 0);
2913 sas_phy_disconnected(sas_phy);
2914 phy->phy_attached = 0;
2915 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2916 break;
2917 case HW_EVENT_LINK_ERR_CODE_VIOLATION:
2918 PM8001_MSG_DBG(pm8001_ha,
2919 pm8001_printk("HW_EVENT_LINK_ERR_CODE_VIOLATION\n"));
2920 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2921 HW_EVENT_LINK_ERR_CODE_VIOLATION,
2922 port_id, phy_id, 0, 0);
2923 sas_phy_disconnected(sas_phy);
2924 phy->phy_attached = 0;
2925 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2926 break;
2927 case HW_EVENT_LINK_ERR_LOSS_OF_DWORD_SYNCH:
2928 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
2929 "HW_EVENT_LINK_ERR_LOSS_OF_DWORD_SYNCH\n"));
2930 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2931 HW_EVENT_LINK_ERR_LOSS_OF_DWORD_SYNCH,
2932 port_id, phy_id, 0, 0);
2933 sas_phy_disconnected(sas_phy);
2934 phy->phy_attached = 0;
2935 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2936 break;
2937 case HW_EVENT_MALFUNCTION:
2938 PM8001_MSG_DBG(pm8001_ha,
2939 pm8001_printk("HW_EVENT_MALFUNCTION\n"));
2940 break;
2941 case HW_EVENT_BROADCAST_SES:
2942 PM8001_MSG_DBG(pm8001_ha,
2943 pm8001_printk("HW_EVENT_BROADCAST_SES\n"));
2944 spin_lock_irqsave(&sas_phy->sas_prim_lock, flags);
2945 sas_phy->sas_prim = HW_EVENT_BROADCAST_SES;
2946 spin_unlock_irqrestore(&sas_phy->sas_prim_lock, flags);
2947 sas_ha->notify_port_event(sas_phy, PORTE_BROADCAST_RCVD);
2948 break;
2949 case HW_EVENT_INBOUND_CRC_ERROR:
2950 PM8001_MSG_DBG(pm8001_ha,
2951 pm8001_printk("HW_EVENT_INBOUND_CRC_ERROR\n"));
2952 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2953 HW_EVENT_INBOUND_CRC_ERROR,
2954 port_id, phy_id, 0, 0);
2955 break;
2956 case HW_EVENT_HARD_RESET_RECEIVED:
2957 PM8001_MSG_DBG(pm8001_ha,
2958 pm8001_printk("HW_EVENT_HARD_RESET_RECEIVED\n"));
2959 sas_ha->notify_port_event(sas_phy, PORTE_HARD_RESET);
2960 break;
2961 case HW_EVENT_ID_FRAME_TIMEOUT:
2962 PM8001_MSG_DBG(pm8001_ha,
2963 pm8001_printk("HW_EVENT_ID_FRAME_TIMEOUT\n"));
2964 sas_phy_disconnected(sas_phy);
2965 phy->phy_attached = 0;
2966 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2967 break;
2968 case HW_EVENT_LINK_ERR_PHY_RESET_FAILED:
2969 PM8001_MSG_DBG(pm8001_ha,
2970 pm8001_printk("HW_EVENT_LINK_ERR_PHY_RESET_FAILED\n"));
2971 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2972 HW_EVENT_LINK_ERR_PHY_RESET_FAILED,
2973 port_id, phy_id, 0, 0);
2974 sas_phy_disconnected(sas_phy);
2975 phy->phy_attached = 0;
2976 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2977 break;
2978 case HW_EVENT_PORT_RESET_TIMER_TMO:
2979 PM8001_MSG_DBG(pm8001_ha,
2980 pm8001_printk("HW_EVENT_PORT_RESET_TIMER_TMO\n"));
2981 sas_phy_disconnected(sas_phy);
2982 phy->phy_attached = 0;
2983 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2984 break;
2985 case HW_EVENT_PORT_RECOVERY_TIMER_TMO:
2986 PM8001_MSG_DBG(pm8001_ha,
2987 pm8001_printk("HW_EVENT_PORT_RECOVERY_TIMER_TMO\n"));
2988 pm80xx_hw_event_ack_req(pm8001_ha, 0,
2989 HW_EVENT_PORT_RECOVERY_TIMER_TMO,
2990 port_id, phy_id, 0, 0);
2991 sas_phy_disconnected(sas_phy);
2992 phy->phy_attached = 0;
2993 sas_ha->notify_port_event(sas_phy, PORTE_LINK_RESET_ERR);
2994 break;
2995 case HW_EVENT_PORT_RECOVER:
2996 PM8001_MSG_DBG(pm8001_ha,
2997 pm8001_printk("HW_EVENT_PORT_RECOVER\n"));
2998 break;
2999 case HW_EVENT_PORT_RESET_COMPLETE:
3000 PM8001_MSG_DBG(pm8001_ha,
3001 pm8001_printk("HW_EVENT_PORT_RESET_COMPLETE\n"));
3002 break;
3003 case EVENT_BROADCAST_ASYNCH_EVENT:
3004 PM8001_MSG_DBG(pm8001_ha,
3005 pm8001_printk("EVENT_BROADCAST_ASYNCH_EVENT\n"));
3006 break;
3007 default:
3008 PM8001_MSG_DBG(pm8001_ha,
3009 pm8001_printk("Unknown event type 0x%x\n", eventType));
3010 break;
3011 }
3012 return 0;
3013}
3014
3015
3016
3017
3018
3019
3020static int mpi_phy_stop_resp(struct pm8001_hba_info *pm8001_ha, void *piomb)
3021{
3022 struct phy_stop_resp *pPayload =
3023 (struct phy_stop_resp *)(piomb + 4);
3024 u32 status =
3025 le32_to_cpu(pPayload->status);
3026 u32 phyid =
3027 le32_to_cpu(pPayload->phyid);
3028 struct pm8001_phy *phy = &pm8001_ha->phy[phyid];
3029 PM8001_MSG_DBG(pm8001_ha,
3030 pm8001_printk("phy:0x%x status:0x%x\n",
3031 phyid, status));
3032 if (status == 0)
3033 phy->phy_state = 0;
3034 return 0;
3035}
3036
3037
3038
3039
3040
3041
3042static int mpi_set_controller_config_resp(struct pm8001_hba_info *pm8001_ha,
3043 void *piomb)
3044{
3045 struct set_ctrl_cfg_resp *pPayload =
3046 (struct set_ctrl_cfg_resp *)(piomb + 4);
3047 u32 status = le32_to_cpu(pPayload->status);
3048 u32 err_qlfr_pgcd = le32_to_cpu(pPayload->err_qlfr_pgcd);
3049
3050 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3051 "SET CONTROLLER RESP: status 0x%x qlfr_pgcd 0x%x\n",
3052 status, err_qlfr_pgcd));
3053
3054 return 0;
3055}
3056
3057
3058
3059
3060
3061
3062static int mpi_get_controller_config_resp(struct pm8001_hba_info *pm8001_ha,
3063 void *piomb)
3064{
3065 PM8001_MSG_DBG(pm8001_ha,
3066 pm8001_printk(" pm80xx_addition_functionality\n"));
3067
3068 return 0;
3069}
3070
3071
3072
3073
3074
3075
3076static int mpi_get_phy_profile_resp(struct pm8001_hba_info *pm8001_ha,
3077 void *piomb)
3078{
3079 PM8001_MSG_DBG(pm8001_ha,
3080 pm8001_printk(" pm80xx_addition_functionality\n"));
3081
3082 return 0;
3083}
3084
3085
3086
3087
3088
3089
3090static int mpi_flash_op_ext_resp(struct pm8001_hba_info *pm8001_ha, void *piomb)
3091{
3092 PM8001_MSG_DBG(pm8001_ha,
3093 pm8001_printk(" pm80xx_addition_functionality\n"));
3094
3095 return 0;
3096}
3097
3098
3099
3100
3101
3102
3103static int mpi_set_phy_profile_resp(struct pm8001_hba_info *pm8001_ha,
3104 void *piomb)
3105{
3106 PM8001_MSG_DBG(pm8001_ha,
3107 pm8001_printk(" pm80xx_addition_functionality\n"));
3108
3109 return 0;
3110}
3111
3112
3113
3114
3115
3116
3117static int mpi_kek_management_resp(struct pm8001_hba_info *pm8001_ha,
3118 void *piomb)
3119{
3120 struct kek_mgmt_resp *pPayload = (struct kek_mgmt_resp *)(piomb + 4);
3121
3122 u32 status = le32_to_cpu(pPayload->status);
3123 u32 kidx_new_curr_ksop = le32_to_cpu(pPayload->kidx_new_curr_ksop);
3124 u32 err_qlfr = le32_to_cpu(pPayload->err_qlfr);
3125
3126 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3127 "KEK MGMT RESP. Status 0x%x idx_ksop 0x%x err_qlfr 0x%x\n",
3128 status, kidx_new_curr_ksop, err_qlfr));
3129
3130 return 0;
3131}
3132
3133
3134
3135
3136
3137
3138static int mpi_dek_management_resp(struct pm8001_hba_info *pm8001_ha,
3139 void *piomb)
3140{
3141 PM8001_MSG_DBG(pm8001_ha,
3142 pm8001_printk(" pm80xx_addition_functionality\n"));
3143
3144 return 0;
3145}
3146
3147
3148
3149
3150
3151
3152static int ssp_coalesced_comp_resp(struct pm8001_hba_info *pm8001_ha,
3153 void *piomb)
3154{
3155 PM8001_MSG_DBG(pm8001_ha,
3156 pm8001_printk(" pm80xx_addition_functionality\n"));
3157
3158 return 0;
3159}
3160
3161
3162
3163
3164
3165
3166static void process_one_iomb(struct pm8001_hba_info *pm8001_ha, void *piomb)
3167{
3168 __le32 pHeader = *(__le32 *)piomb;
3169 u32 opc = (u32)((le32_to_cpu(pHeader)) & 0xFFF);
3170
3171 switch (opc) {
3172 case OPC_OUB_ECHO:
3173 PM8001_MSG_DBG(pm8001_ha, pm8001_printk("OPC_OUB_ECHO\n"));
3174 break;
3175 case OPC_OUB_HW_EVENT:
3176 PM8001_MSG_DBG(pm8001_ha,
3177 pm8001_printk("OPC_OUB_HW_EVENT\n"));
3178 mpi_hw_event(pm8001_ha, piomb);
3179 break;
3180 case OPC_OUB_THERM_HW_EVENT:
3181 PM8001_MSG_DBG(pm8001_ha,
3182 pm8001_printk("OPC_OUB_THERMAL_EVENT\n"));
3183 mpi_thermal_hw_event(pm8001_ha, piomb);
3184 break;
3185 case OPC_OUB_SSP_COMP:
3186 PM8001_MSG_DBG(pm8001_ha,
3187 pm8001_printk("OPC_OUB_SSP_COMP\n"));
3188 mpi_ssp_completion(pm8001_ha, piomb);
3189 break;
3190 case OPC_OUB_SMP_COMP:
3191 PM8001_MSG_DBG(pm8001_ha,
3192 pm8001_printk("OPC_OUB_SMP_COMP\n"));
3193 mpi_smp_completion(pm8001_ha, piomb);
3194 break;
3195 case OPC_OUB_LOCAL_PHY_CNTRL:
3196 PM8001_MSG_DBG(pm8001_ha,
3197 pm8001_printk("OPC_OUB_LOCAL_PHY_CNTRL\n"));
3198 pm8001_mpi_local_phy_ctl(pm8001_ha, piomb);
3199 break;
3200 case OPC_OUB_DEV_REGIST:
3201 PM8001_MSG_DBG(pm8001_ha,
3202 pm8001_printk("OPC_OUB_DEV_REGIST\n"));
3203 pm8001_mpi_reg_resp(pm8001_ha, piomb);
3204 break;
3205 case OPC_OUB_DEREG_DEV:
3206 PM8001_MSG_DBG(pm8001_ha,
3207 pm8001_printk("unresgister the deviece\n"));
3208 pm8001_mpi_dereg_resp(pm8001_ha, piomb);
3209 break;
3210 case OPC_OUB_GET_DEV_HANDLE:
3211 PM8001_MSG_DBG(pm8001_ha,
3212 pm8001_printk("OPC_OUB_GET_DEV_HANDLE\n"));
3213 break;
3214 case OPC_OUB_SATA_COMP:
3215 PM8001_MSG_DBG(pm8001_ha,
3216 pm8001_printk("OPC_OUB_SATA_COMP\n"));
3217 mpi_sata_completion(pm8001_ha, piomb);
3218 break;
3219 case OPC_OUB_SATA_EVENT:
3220 PM8001_MSG_DBG(pm8001_ha,
3221 pm8001_printk("OPC_OUB_SATA_EVENT\n"));
3222 mpi_sata_event(pm8001_ha, piomb);
3223 break;
3224 case OPC_OUB_SSP_EVENT:
3225 PM8001_MSG_DBG(pm8001_ha,
3226 pm8001_printk("OPC_OUB_SSP_EVENT\n"));
3227 mpi_ssp_event(pm8001_ha, piomb);
3228 break;
3229 case OPC_OUB_DEV_HANDLE_ARRIV:
3230 PM8001_MSG_DBG(pm8001_ha,
3231 pm8001_printk("OPC_OUB_DEV_HANDLE_ARRIV\n"));
3232
3233 break;
3234 case OPC_OUB_SSP_RECV_EVENT:
3235 PM8001_MSG_DBG(pm8001_ha,
3236 pm8001_printk("OPC_OUB_SSP_RECV_EVENT\n"));
3237
3238 break;
3239 case OPC_OUB_FW_FLASH_UPDATE:
3240 PM8001_MSG_DBG(pm8001_ha,
3241 pm8001_printk("OPC_OUB_FW_FLASH_UPDATE\n"));
3242 pm8001_mpi_fw_flash_update_resp(pm8001_ha, piomb);
3243 break;
3244 case OPC_OUB_GPIO_RESPONSE:
3245 PM8001_MSG_DBG(pm8001_ha,
3246 pm8001_printk("OPC_OUB_GPIO_RESPONSE\n"));
3247 break;
3248 case OPC_OUB_GPIO_EVENT:
3249 PM8001_MSG_DBG(pm8001_ha,
3250 pm8001_printk("OPC_OUB_GPIO_EVENT\n"));
3251 break;
3252 case OPC_OUB_GENERAL_EVENT:
3253 PM8001_MSG_DBG(pm8001_ha,
3254 pm8001_printk("OPC_OUB_GENERAL_EVENT\n"));
3255 pm8001_mpi_general_event(pm8001_ha, piomb);
3256 break;
3257 case OPC_OUB_SSP_ABORT_RSP:
3258 PM8001_MSG_DBG(pm8001_ha,
3259 pm8001_printk("OPC_OUB_SSP_ABORT_RSP\n"));
3260 pm8001_mpi_task_abort_resp(pm8001_ha, piomb);
3261 break;
3262 case OPC_OUB_SATA_ABORT_RSP:
3263 PM8001_MSG_DBG(pm8001_ha,
3264 pm8001_printk("OPC_OUB_SATA_ABORT_RSP\n"));
3265 pm8001_mpi_task_abort_resp(pm8001_ha, piomb);
3266 break;
3267 case OPC_OUB_SAS_DIAG_MODE_START_END:
3268 PM8001_MSG_DBG(pm8001_ha,
3269 pm8001_printk("OPC_OUB_SAS_DIAG_MODE_START_END\n"));
3270 break;
3271 case OPC_OUB_SAS_DIAG_EXECUTE:
3272 PM8001_MSG_DBG(pm8001_ha,
3273 pm8001_printk("OPC_OUB_SAS_DIAG_EXECUTE\n"));
3274 break;
3275 case OPC_OUB_GET_TIME_STAMP:
3276 PM8001_MSG_DBG(pm8001_ha,
3277 pm8001_printk("OPC_OUB_GET_TIME_STAMP\n"));
3278 break;
3279 case OPC_OUB_SAS_HW_EVENT_ACK:
3280 PM8001_MSG_DBG(pm8001_ha,
3281 pm8001_printk("OPC_OUB_SAS_HW_EVENT_ACK\n"));
3282 break;
3283 case OPC_OUB_PORT_CONTROL:
3284 PM8001_MSG_DBG(pm8001_ha,
3285 pm8001_printk("OPC_OUB_PORT_CONTROL\n"));
3286 break;
3287 case OPC_OUB_SMP_ABORT_RSP:
3288 PM8001_MSG_DBG(pm8001_ha,
3289 pm8001_printk("OPC_OUB_SMP_ABORT_RSP\n"));
3290 pm8001_mpi_task_abort_resp(pm8001_ha, piomb);
3291 break;
3292 case OPC_OUB_GET_NVMD_DATA:
3293 PM8001_MSG_DBG(pm8001_ha,
3294 pm8001_printk("OPC_OUB_GET_NVMD_DATA\n"));
3295 pm8001_mpi_get_nvmd_resp(pm8001_ha, piomb);
3296 break;
3297 case OPC_OUB_SET_NVMD_DATA:
3298 PM8001_MSG_DBG(pm8001_ha,
3299 pm8001_printk("OPC_OUB_SET_NVMD_DATA\n"));
3300 pm8001_mpi_set_nvmd_resp(pm8001_ha, piomb);
3301 break;
3302 case OPC_OUB_DEVICE_HANDLE_REMOVAL:
3303 PM8001_MSG_DBG(pm8001_ha,
3304 pm8001_printk("OPC_OUB_DEVICE_HANDLE_REMOVAL\n"));
3305 break;
3306 case OPC_OUB_SET_DEVICE_STATE:
3307 PM8001_MSG_DBG(pm8001_ha,
3308 pm8001_printk("OPC_OUB_SET_DEVICE_STATE\n"));
3309 pm8001_mpi_set_dev_state_resp(pm8001_ha, piomb);
3310 break;
3311 case OPC_OUB_GET_DEVICE_STATE:
3312 PM8001_MSG_DBG(pm8001_ha,
3313 pm8001_printk("OPC_OUB_GET_DEVICE_STATE\n"));
3314 break;
3315 case OPC_OUB_SET_DEV_INFO:
3316 PM8001_MSG_DBG(pm8001_ha,
3317 pm8001_printk("OPC_OUB_SET_DEV_INFO\n"));
3318 break;
3319
3320 case OPC_OUB_PHY_START_RESP:
3321 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3322 "OPC_OUB_PHY_START_RESP opcode:%x\n", opc));
3323 mpi_phy_start_resp(pm8001_ha, piomb);
3324 break;
3325 case OPC_OUB_PHY_STOP_RESP:
3326 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3327 "OPC_OUB_PHY_STOP_RESP opcode:%x\n", opc));
3328 mpi_phy_stop_resp(pm8001_ha, piomb);
3329 break;
3330 case OPC_OUB_SET_CONTROLLER_CONFIG:
3331 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3332 "OPC_OUB_SET_CONTROLLER_CONFIG opcode:%x\n", opc));
3333 mpi_set_controller_config_resp(pm8001_ha, piomb);
3334 break;
3335 case OPC_OUB_GET_CONTROLLER_CONFIG:
3336 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3337 "OPC_OUB_GET_CONTROLLER_CONFIG opcode:%x\n", opc));
3338 mpi_get_controller_config_resp(pm8001_ha, piomb);
3339 break;
3340 case OPC_OUB_GET_PHY_PROFILE:
3341 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3342 "OPC_OUB_GET_PHY_PROFILE opcode:%x\n", opc));
3343 mpi_get_phy_profile_resp(pm8001_ha, piomb);
3344 break;
3345 case OPC_OUB_FLASH_OP_EXT:
3346 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3347 "OPC_OUB_FLASH_OP_EXT opcode:%x\n", opc));
3348 mpi_flash_op_ext_resp(pm8001_ha, piomb);
3349 break;
3350 case OPC_OUB_SET_PHY_PROFILE:
3351 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3352 "OPC_OUB_SET_PHY_PROFILE opcode:%x\n", opc));
3353 mpi_set_phy_profile_resp(pm8001_ha, piomb);
3354 break;
3355 case OPC_OUB_KEK_MANAGEMENT_RESP:
3356 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3357 "OPC_OUB_KEK_MANAGEMENT_RESP opcode:%x\n", opc));
3358 mpi_kek_management_resp(pm8001_ha, piomb);
3359 break;
3360 case OPC_OUB_DEK_MANAGEMENT_RESP:
3361 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3362 "OPC_OUB_DEK_MANAGEMENT_RESP opcode:%x\n", opc));
3363 mpi_dek_management_resp(pm8001_ha, piomb);
3364 break;
3365 case OPC_OUB_SSP_COALESCED_COMP_RESP:
3366 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3367 "OPC_OUB_SSP_COALESCED_COMP_RESP opcode:%x\n", opc));
3368 ssp_coalesced_comp_resp(pm8001_ha, piomb);
3369 break;
3370 default:
3371 PM8001_MSG_DBG(pm8001_ha, pm8001_printk(
3372 "Unknown outbound Queue IOMB OPC = 0x%x\n", opc));
3373 break;
3374 }
3375}
3376
3377static int process_oq(struct pm8001_hba_info *pm8001_ha, u8 vec)
3378{
3379 struct outbound_queue_table *circularQ;
3380 void *pMsg1 = NULL;
3381 u8 uninitialized_var(bc);
3382 u32 ret = MPI_IO_STATUS_FAIL;
3383 unsigned long flags;
3384
3385 spin_lock_irqsave(&pm8001_ha->lock, flags);
3386 circularQ = &pm8001_ha->outbnd_q_tbl[vec];
3387 do {
3388 ret = pm8001_mpi_msg_consume(pm8001_ha, circularQ, &pMsg1, &bc);
3389 if (MPI_IO_STATUS_SUCCESS == ret) {
3390
3391 process_one_iomb(pm8001_ha, (void *)(pMsg1 - 4));
3392
3393 pm8001_mpi_msg_free_set(pm8001_ha, pMsg1,
3394 circularQ, bc);
3395 }
3396 if (MPI_IO_STATUS_BUSY == ret) {
3397
3398 circularQ->producer_index =
3399 cpu_to_le32(pm8001_read_32(circularQ->pi_virt));
3400 if (le32_to_cpu(circularQ->producer_index) ==
3401 circularQ->consumer_idx)
3402
3403 break;
3404 }
3405 } while (1);
3406 spin_unlock_irqrestore(&pm8001_ha->lock, flags);
3407 return ret;
3408}
3409
3410
3411static const u8 data_dir_flags[] = {
3412 [PCI_DMA_BIDIRECTIONAL] = DATA_DIR_BYRECIPIENT,
3413 [PCI_DMA_TODEVICE] = DATA_DIR_OUT,
3414 [PCI_DMA_FROMDEVICE] = DATA_DIR_IN,
3415 [PCI_DMA_NONE] = DATA_DIR_NONE,
3416};
3417
3418static void build_smp_cmd(u32 deviceID, __le32 hTag,
3419 struct smp_req *psmp_cmd, int mode, int length)
3420{
3421 psmp_cmd->tag = hTag;
3422 psmp_cmd->device_id = cpu_to_le32(deviceID);
3423 if (mode == SMP_DIRECT) {
3424 length = length - 4;
3425 psmp_cmd->len_ip_ir = cpu_to_le32(length << 16);
3426 } else {
3427 psmp_cmd->len_ip_ir = cpu_to_le32(1|(1 << 1));
3428 }
3429}
3430
3431
3432
3433
3434
3435
3436static int pm80xx_chip_smp_req(struct pm8001_hba_info *pm8001_ha,
3437 struct pm8001_ccb_info *ccb)
3438{
3439 int elem, rc;
3440 struct sas_task *task = ccb->task;
3441 struct domain_device *dev = task->dev;
3442 struct pm8001_device *pm8001_dev = dev->lldd_dev;
3443 struct scatterlist *sg_req, *sg_resp;
3444 u32 req_len, resp_len;
3445 struct smp_req smp_cmd;
3446 u32 opc;
3447 struct inbound_queue_table *circularQ;
3448 char *preq_dma_addr = NULL;
3449 __le64 tmp_addr;
3450 u32 i, length;
3451
3452 memset(&smp_cmd, 0, sizeof(smp_cmd));
3453
3454
3455
3456 sg_req = &task->smp_task.smp_req;
3457 elem = dma_map_sg(pm8001_ha->dev, sg_req, 1, PCI_DMA_TODEVICE);
3458 if (!elem)
3459 return -ENOMEM;
3460 req_len = sg_dma_len(sg_req);
3461
3462 sg_resp = &task->smp_task.smp_resp;
3463 elem = dma_map_sg(pm8001_ha->dev, sg_resp, 1, PCI_DMA_FROMDEVICE);
3464 if (!elem) {
3465 rc = -ENOMEM;
3466 goto err_out;
3467 }
3468 resp_len = sg_dma_len(sg_resp);
3469
3470 if ((req_len & 0x3) || (resp_len & 0x3)) {
3471 rc = -EINVAL;
3472 goto err_out_2;
3473 }
3474
3475 opc = OPC_INB_SMP_REQUEST;
3476 circularQ = &pm8001_ha->inbnd_q_tbl[0];
3477 smp_cmd.tag = cpu_to_le32(ccb->ccb_tag);
3478
3479 length = sg_req->length;
3480 PM8001_IO_DBG(pm8001_ha,
3481 pm8001_printk("SMP Frame Length %d\n", sg_req->length));
3482 if (!(length - 8))
3483 pm8001_ha->smp_exp_mode = SMP_DIRECT;
3484 else
3485 pm8001_ha->smp_exp_mode = SMP_INDIRECT;
3486
3487
3488 pm8001_ha->smp_exp_mode = SMP_DIRECT;
3489
3490 tmp_addr = cpu_to_le64((u64)sg_dma_address(&task->smp_task.smp_req));
3491 preq_dma_addr = (char *)phys_to_virt(tmp_addr);
3492
3493
3494 if (pm8001_ha->smp_exp_mode == SMP_INDIRECT) {
3495 PM8001_IO_DBG(pm8001_ha,
3496 pm8001_printk("SMP REQUEST INDIRECT MODE\n"));
3497
3498
3499 for (i = 0; i < 4; i++)
3500 smp_cmd.smp_req16[i] = *(preq_dma_addr + i);
3501
3502 smp_cmd.long_smp_req.long_req_addr =
3503 cpu_to_le64((u64)sg_dma_address
3504 (&task->smp_task.smp_req) - 4);
3505
3506 smp_cmd.long_smp_req.long_req_size =
3507 cpu_to_le32((u32)sg_dma_len(&task->smp_task.smp_req)-8);
3508 smp_cmd.long_smp_req.long_resp_addr =
3509 cpu_to_le64((u64)sg_dma_address
3510 (&task->smp_task.smp_resp));
3511 smp_cmd.long_smp_req.long_resp_size =
3512 cpu_to_le32((u32)sg_dma_len
3513 (&task->smp_task.smp_resp)-4);
3514 } else {
3515 smp_cmd.long_smp_req.long_req_addr =
3516 cpu_to_le64((u64)sg_dma_address
3517 (&task->smp_task.smp_req));
3518 smp_cmd.long_smp_req.long_req_size =
3519 cpu_to_le32((u32)sg_dma_len(&task->smp_task.smp_req)-4);
3520 smp_cmd.long_smp_req.long_resp_addr =
3521 cpu_to_le64((u64)sg_dma_address
3522 (&task->smp_task.smp_resp));
3523 smp_cmd.long_smp_req.long_resp_size =
3524 cpu_to_le32
3525 ((u32)sg_dma_len(&task->smp_task.smp_resp)-4);
3526 }
3527 if (pm8001_ha->smp_exp_mode == SMP_DIRECT) {
3528 PM8001_IO_DBG(pm8001_ha,
3529 pm8001_printk("SMP REQUEST DIRECT MODE\n"));
3530 for (i = 0; i < length; i++)
3531 if (i < 16) {
3532 smp_cmd.smp_req16[i] = *(preq_dma_addr+i);
3533 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3534 "Byte[%d]:%x (DMA data:%x)\n",
3535 i, smp_cmd.smp_req16[i],
3536 *(preq_dma_addr)));
3537 } else {
3538 smp_cmd.smp_req[i] = *(preq_dma_addr+i);
3539 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3540 "Byte[%d]:%x (DMA data:%x)\n",
3541 i, smp_cmd.smp_req[i],
3542 *(preq_dma_addr)));
3543 }
3544 }
3545
3546 build_smp_cmd(pm8001_dev->device_id, smp_cmd.tag,
3547 &smp_cmd, pm8001_ha->smp_exp_mode, length);
3548 pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, (u32 *)&smp_cmd, 0);
3549 return 0;
3550
3551err_out_2:
3552 dma_unmap_sg(pm8001_ha->dev, &ccb->task->smp_task.smp_resp, 1,
3553 PCI_DMA_FROMDEVICE);
3554err_out:
3555 dma_unmap_sg(pm8001_ha->dev, &ccb->task->smp_task.smp_req, 1,
3556 PCI_DMA_TODEVICE);
3557 return rc;
3558}
3559
3560static int check_enc_sas_cmd(struct sas_task *task)
3561{
3562 if ((task->ssp_task.cdb[0] == READ_10)
3563 || (task->ssp_task.cdb[0] == WRITE_10)
3564 || (task->ssp_task.cdb[0] == WRITE_VERIFY))
3565 return 1;
3566 else
3567 return 0;
3568}
3569
3570static int check_enc_sat_cmd(struct sas_task *task)
3571{
3572 int ret = 0;
3573 switch (task->ata_task.fis.command) {
3574 case ATA_CMD_FPDMA_READ:
3575 case ATA_CMD_READ_EXT:
3576 case ATA_CMD_READ:
3577 case ATA_CMD_FPDMA_WRITE:
3578 case ATA_CMD_WRITE_EXT:
3579 case ATA_CMD_WRITE:
3580 case ATA_CMD_PIO_READ:
3581 case ATA_CMD_PIO_READ_EXT:
3582 case ATA_CMD_PIO_WRITE:
3583 case ATA_CMD_PIO_WRITE_EXT:
3584 ret = 1;
3585 break;
3586 default:
3587 ret = 0;
3588 break;
3589 }
3590 return ret;
3591}
3592
3593
3594
3595
3596
3597
3598static int pm80xx_chip_ssp_io_req(struct pm8001_hba_info *pm8001_ha,
3599 struct pm8001_ccb_info *ccb)
3600{
3601 struct sas_task *task = ccb->task;
3602 struct domain_device *dev = task->dev;
3603 struct pm8001_device *pm8001_dev = dev->lldd_dev;
3604 struct ssp_ini_io_start_req ssp_cmd;
3605 u32 tag = ccb->ccb_tag;
3606 int ret;
3607 u64 phys_addr;
3608 struct inbound_queue_table *circularQ;
3609 static u32 inb;
3610 static u32 outb;
3611 u32 opc = OPC_INB_SSPINIIOSTART;
3612 memset(&ssp_cmd, 0, sizeof(ssp_cmd));
3613 memcpy(ssp_cmd.ssp_iu.lun, task->ssp_task.LUN, 8);
3614
3615
3616
3617
3618 ssp_cmd.dad_dir_m_tlr =
3619 cpu_to_le32(data_dir_flags[task->data_dir] << 8 | 0x0);
3620 ssp_cmd.data_len = cpu_to_le32(task->total_xfer_len);
3621 ssp_cmd.device_id = cpu_to_le32(pm8001_dev->device_id);
3622 ssp_cmd.tag = cpu_to_le32(tag);
3623 if (task->ssp_task.enable_first_burst)
3624 ssp_cmd.ssp_iu.efb_prio_attr |= 0x80;
3625 ssp_cmd.ssp_iu.efb_prio_attr |= (task->ssp_task.task_prio << 3);
3626 ssp_cmd.ssp_iu.efb_prio_attr |= (task->ssp_task.task_attr & 7);
3627 memcpy(ssp_cmd.ssp_iu.cdb, task->ssp_task.cdb, 16);
3628 circularQ = &pm8001_ha->inbnd_q_tbl[0];
3629
3630
3631 if (pm8001_ha->chip->encrypt &&
3632 !(pm8001_ha->encrypt_info.status) && check_enc_sas_cmd(task)) {
3633 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3634 "Encryption enabled.Sending Encrypt SAS command 0x%x\n",
3635 task->ssp_task.cdb[0]));
3636 opc = OPC_INB_SSP_INI_DIF_ENC_IO;
3637
3638 ssp_cmd.dad_dir_m_tlr = cpu_to_le32
3639 ((data_dir_flags[task->data_dir] << 8) | 0x20 | 0x0);
3640
3641
3642 if (task->num_scatter > 1) {
3643 pm8001_chip_make_sg(task->scatter,
3644 ccb->n_elem, ccb->buf_prd);
3645 phys_addr = ccb->ccb_dma_handle +
3646 offsetof(struct pm8001_ccb_info, buf_prd[0]);
3647 ssp_cmd.enc_addr_low =
3648 cpu_to_le32(lower_32_bits(phys_addr));
3649 ssp_cmd.enc_addr_high =
3650 cpu_to_le32(upper_32_bits(phys_addr));
3651 ssp_cmd.enc_esgl = cpu_to_le32(1<<31);
3652 } else if (task->num_scatter == 1) {
3653 u64 dma_addr = sg_dma_address(task->scatter);
3654 ssp_cmd.enc_addr_low =
3655 cpu_to_le32(lower_32_bits(dma_addr));
3656 ssp_cmd.enc_addr_high =
3657 cpu_to_le32(upper_32_bits(dma_addr));
3658 ssp_cmd.enc_len = cpu_to_le32(task->total_xfer_len);
3659 ssp_cmd.enc_esgl = 0;
3660 } else if (task->num_scatter == 0) {
3661 ssp_cmd.enc_addr_low = 0;
3662 ssp_cmd.enc_addr_high = 0;
3663 ssp_cmd.enc_len = cpu_to_le32(task->total_xfer_len);
3664 ssp_cmd.enc_esgl = 0;
3665 }
3666
3667 ssp_cmd.key_cmode = 0x6 << 4;
3668
3669 ssp_cmd.twk_val0 = cpu_to_le32((task->ssp_task.cdb[2] << 24) |
3670 (task->ssp_task.cdb[3] << 16) |
3671 (task->ssp_task.cdb[4] << 8) |
3672 (task->ssp_task.cdb[5]));
3673 } else {
3674 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3675 "Sending Normal SAS command 0x%x inb q %x\n",
3676 task->ssp_task.cdb[0], inb));
3677
3678 if (task->num_scatter > 1) {
3679 pm8001_chip_make_sg(task->scatter, ccb->n_elem,
3680 ccb->buf_prd);
3681 phys_addr = ccb->ccb_dma_handle +
3682 offsetof(struct pm8001_ccb_info, buf_prd[0]);
3683 ssp_cmd.addr_low =
3684 cpu_to_le32(lower_32_bits(phys_addr));
3685 ssp_cmd.addr_high =
3686 cpu_to_le32(upper_32_bits(phys_addr));
3687 ssp_cmd.esgl = cpu_to_le32(1<<31);
3688 } else if (task->num_scatter == 1) {
3689 u64 dma_addr = sg_dma_address(task->scatter);
3690 ssp_cmd.addr_low = cpu_to_le32(lower_32_bits(dma_addr));
3691 ssp_cmd.addr_high =
3692 cpu_to_le32(upper_32_bits(dma_addr));
3693 ssp_cmd.len = cpu_to_le32(task->total_xfer_len);
3694 ssp_cmd.esgl = 0;
3695 } else if (task->num_scatter == 0) {
3696 ssp_cmd.addr_low = 0;
3697 ssp_cmd.addr_high = 0;
3698 ssp_cmd.len = cpu_to_le32(task->total_xfer_len);
3699 ssp_cmd.esgl = 0;
3700 }
3701 }
3702 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &ssp_cmd, outb++);
3703
3704
3705 outb = outb%PM8001_MAX_SPCV_OUTB_NUM;
3706
3707 return ret;
3708}
3709
3710static int pm80xx_chip_sata_req(struct pm8001_hba_info *pm8001_ha,
3711 struct pm8001_ccb_info *ccb)
3712{
3713 struct sas_task *task = ccb->task;
3714 struct domain_device *dev = task->dev;
3715 struct pm8001_device *pm8001_ha_dev = dev->lldd_dev;
3716 u32 tag = ccb->ccb_tag;
3717 int ret;
3718 static u32 inb;
3719 static u32 outb;
3720 struct sata_start_req sata_cmd;
3721 u32 hdr_tag, ncg_tag = 0;
3722 u64 phys_addr;
3723 u32 ATAP = 0x0;
3724 u32 dir;
3725 struct inbound_queue_table *circularQ;
3726 unsigned long flags;
3727 u32 opc = OPC_INB_SATA_HOST_OPSTART;
3728 memset(&sata_cmd, 0, sizeof(sata_cmd));
3729 circularQ = &pm8001_ha->inbnd_q_tbl[0];
3730
3731 if (task->data_dir == PCI_DMA_NONE) {
3732 ATAP = 0x04;
3733 PM8001_IO_DBG(pm8001_ha, pm8001_printk("no data\n"));
3734 } else if (likely(!task->ata_task.device_control_reg_update)) {
3735 if (task->ata_task.dma_xfer) {
3736 ATAP = 0x06;
3737 PM8001_IO_DBG(pm8001_ha, pm8001_printk("DMA\n"));
3738 } else {
3739 ATAP = 0x05;
3740 PM8001_IO_DBG(pm8001_ha, pm8001_printk("PIO\n"));
3741 }
3742 if (task->ata_task.use_ncq &&
3743 dev->sata_dev.command_set != ATAPI_COMMAND_SET) {
3744 ATAP = 0x07;
3745 PM8001_IO_DBG(pm8001_ha, pm8001_printk("FPDMA\n"));
3746 }
3747 }
3748 if (task->ata_task.use_ncq && pm8001_get_ncq_tag(task, &hdr_tag)) {
3749 task->ata_task.fis.sector_count |= (u8) (hdr_tag << 3);
3750 ncg_tag = hdr_tag;
3751 }
3752 dir = data_dir_flags[task->data_dir] << 8;
3753 sata_cmd.tag = cpu_to_le32(tag);
3754 sata_cmd.device_id = cpu_to_le32(pm8001_ha_dev->device_id);
3755 sata_cmd.data_len = cpu_to_le32(task->total_xfer_len);
3756
3757 sata_cmd.sata_fis = task->ata_task.fis;
3758 if (likely(!task->ata_task.device_control_reg_update))
3759 sata_cmd.sata_fis.flags |= 0x80;
3760 sata_cmd.sata_fis.flags &= 0xF0;
3761
3762
3763 if (pm8001_ha->chip->encrypt &&
3764 !(pm8001_ha->encrypt_info.status) && check_enc_sat_cmd(task)) {
3765 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3766 "Encryption enabled.Sending Encrypt SATA cmd 0x%x\n",
3767 sata_cmd.sata_fis.command));
3768 opc = OPC_INB_SATA_DIF_ENC_IO;
3769
3770
3771 sata_cmd.ncqtag_atap_dir_m_dad =
3772 cpu_to_le32(((ncg_tag & 0xff)<<16)|
3773 ((ATAP & 0x3f) << 10) | 0x20 | dir);
3774
3775
3776 if (task->num_scatter > 1) {
3777 pm8001_chip_make_sg(task->scatter,
3778 ccb->n_elem, ccb->buf_prd);
3779 phys_addr = ccb->ccb_dma_handle +
3780 offsetof(struct pm8001_ccb_info, buf_prd[0]);
3781 sata_cmd.enc_addr_low = lower_32_bits(phys_addr);
3782 sata_cmd.enc_addr_high = upper_32_bits(phys_addr);
3783 sata_cmd.enc_esgl = cpu_to_le32(1 << 31);
3784 } else if (task->num_scatter == 1) {
3785 u64 dma_addr = sg_dma_address(task->scatter);
3786 sata_cmd.enc_addr_low = lower_32_bits(dma_addr);
3787 sata_cmd.enc_addr_high = upper_32_bits(dma_addr);
3788 sata_cmd.enc_len = cpu_to_le32(task->total_xfer_len);
3789 sata_cmd.enc_esgl = 0;
3790 } else if (task->num_scatter == 0) {
3791 sata_cmd.enc_addr_low = 0;
3792 sata_cmd.enc_addr_high = 0;
3793 sata_cmd.enc_len = cpu_to_le32(task->total_xfer_len);
3794 sata_cmd.enc_esgl = 0;
3795 }
3796
3797 sata_cmd.key_index_mode = 0x6 << 4;
3798
3799 sata_cmd.twk_val0 =
3800 cpu_to_le32((sata_cmd.sata_fis.lbal_exp << 24) |
3801 (sata_cmd.sata_fis.lbah << 16) |
3802 (sata_cmd.sata_fis.lbam << 8) |
3803 (sata_cmd.sata_fis.lbal));
3804 sata_cmd.twk_val1 =
3805 cpu_to_le32((sata_cmd.sata_fis.lbah_exp << 8) |
3806 (sata_cmd.sata_fis.lbam_exp));
3807 } else {
3808 PM8001_IO_DBG(pm8001_ha, pm8001_printk(
3809 "Sending Normal SATA command 0x%x inb %x\n",
3810 sata_cmd.sata_fis.command, inb));
3811
3812 sata_cmd.ncqtag_atap_dir_m_dad =
3813 cpu_to_le32(((ncg_tag & 0xff)<<16) |
3814 ((ATAP & 0x3f) << 10) | dir);
3815
3816
3817 if (task->num_scatter > 1) {
3818 pm8001_chip_make_sg(task->scatter,
3819 ccb->n_elem, ccb->buf_prd);
3820 phys_addr = ccb->ccb_dma_handle +
3821 offsetof(struct pm8001_ccb_info, buf_prd[0]);
3822 sata_cmd.addr_low = lower_32_bits(phys_addr);
3823 sata_cmd.addr_high = upper_32_bits(phys_addr);
3824 sata_cmd.esgl = cpu_to_le32(1 << 31);
3825 } else if (task->num_scatter == 1) {
3826 u64 dma_addr = sg_dma_address(task->scatter);
3827 sata_cmd.addr_low = lower_32_bits(dma_addr);
3828 sata_cmd.addr_high = upper_32_bits(dma_addr);
3829 sata_cmd.len = cpu_to_le32(task->total_xfer_len);
3830 sata_cmd.esgl = 0;
3831 } else if (task->num_scatter == 0) {
3832 sata_cmd.addr_low = 0;
3833 sata_cmd.addr_high = 0;
3834 sata_cmd.len = cpu_to_le32(task->total_xfer_len);
3835 sata_cmd.esgl = 0;
3836 }
3837
3838 sata_cmd.atapi_scsi_cdb[0] =
3839 cpu_to_le32(((task->ata_task.atapi_packet[0]) |
3840 (task->ata_task.atapi_packet[1] << 8) |
3841 (task->ata_task.atapi_packet[2] << 16) |
3842 (task->ata_task.atapi_packet[3] << 24)));
3843 sata_cmd.atapi_scsi_cdb[1] =
3844 cpu_to_le32(((task->ata_task.atapi_packet[4]) |
3845 (task->ata_task.atapi_packet[5] << 8) |
3846 (task->ata_task.atapi_packet[6] << 16) |
3847 (task->ata_task.atapi_packet[7] << 24)));
3848 sata_cmd.atapi_scsi_cdb[2] =
3849 cpu_to_le32(((task->ata_task.atapi_packet[8]) |
3850 (task->ata_task.atapi_packet[9] << 8) |
3851 (task->ata_task.atapi_packet[10] << 16) |
3852 (task->ata_task.atapi_packet[11] << 24)));
3853 sata_cmd.atapi_scsi_cdb[3] =
3854 cpu_to_le32(((task->ata_task.atapi_packet[12]) |
3855 (task->ata_task.atapi_packet[13] << 8) |
3856 (task->ata_task.atapi_packet[14] << 16) |
3857 (task->ata_task.atapi_packet[15] << 24)));
3858 }
3859
3860
3861 if (sata_cmd.sata_fis.command == 0x2f) {
3862 if (pm8001_ha_dev && ((pm8001_ha_dev->id & NCQ_READ_LOG_FLAG) ||
3863 (pm8001_ha_dev->id & NCQ_ABORT_ALL_FLAG) ||
3864 (pm8001_ha_dev->id & NCQ_2ND_RLE_FLAG))) {
3865 struct task_status_struct *ts;
3866
3867 pm8001_ha_dev->id &= 0xDFFFFFFF;
3868 ts = &task->task_status;
3869
3870 spin_lock_irqsave(&task->task_state_lock, flags);
3871 ts->resp = SAS_TASK_COMPLETE;
3872 ts->stat = SAM_STAT_GOOD;
3873 task->task_state_flags &= ~SAS_TASK_STATE_PENDING;
3874 task->task_state_flags &= ~SAS_TASK_AT_INITIATOR;
3875 task->task_state_flags |= SAS_TASK_STATE_DONE;
3876 if (unlikely((task->task_state_flags &
3877 SAS_TASK_STATE_ABORTED))) {
3878 spin_unlock_irqrestore(&task->task_state_lock,
3879 flags);
3880 PM8001_FAIL_DBG(pm8001_ha,
3881 pm8001_printk("task 0x%p resp 0x%x "
3882 " stat 0x%x but aborted by upper layer "
3883 "\n", task, ts->resp, ts->stat));
3884 pm8001_ccb_task_free(pm8001_ha, task, ccb, tag);
3885 return 0;
3886 } else if (task->uldd_task) {
3887 spin_unlock_irqrestore(&task->task_state_lock,
3888 flags);
3889 pm8001_ccb_task_free(pm8001_ha, task, ccb, tag);
3890 mb();
3891 spin_unlock_irq(&pm8001_ha->lock);
3892 task->task_done(task);
3893 spin_lock_irq(&pm8001_ha->lock);
3894 return 0;
3895 } else if (!task->uldd_task) {
3896 spin_unlock_irqrestore(&task->task_state_lock,
3897 flags);
3898 pm8001_ccb_task_free(pm8001_ha, task, ccb, tag);
3899 mb();
3900 spin_unlock_irq(&pm8001_ha->lock);
3901 task->task_done(task);
3902 spin_lock_irq(&pm8001_ha->lock);
3903 return 0;
3904 }
3905 }
3906 }
3907
3908 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc,
3909 &sata_cmd, outb++);
3910
3911
3912 outb = outb%PM8001_MAX_SPCV_OUTB_NUM;
3913 return ret;
3914}
3915
3916
3917
3918
3919
3920
3921
3922static int
3923pm80xx_chip_phy_start_req(struct pm8001_hba_info *pm8001_ha, u8 phy_id)
3924{
3925 struct phy_start_req payload;
3926 struct inbound_queue_table *circularQ;
3927 int ret;
3928 u32 tag = 0x01;
3929 u32 opcode = OPC_INB_PHYSTART;
3930 circularQ = &pm8001_ha->inbnd_q_tbl[0];
3931 memset(&payload, 0, sizeof(payload));
3932 payload.tag = cpu_to_le32(tag);
3933
3934 PM8001_INIT_DBG(pm8001_ha,
3935 pm8001_printk("PHY START REQ for phy_id %d\n", phy_id));
3936
3937
3938
3939
3940
3941
3942
3943 payload.ase_sh_lm_slr_phyid = cpu_to_le32(SPINHOLD_DISABLE |
3944 LINKMODE_AUTO | LINKRATE_15 |
3945 LINKRATE_30 | LINKRATE_60 | phy_id);
3946
3947
3948
3949
3950
3951
3952
3953
3954
3955 payload.sas_identify.dev_type = SAS_END_DEVICE;
3956 payload.sas_identify.initiator_bits = SAS_PROTOCOL_ALL;
3957 memcpy(payload.sas_identify.sas_addr,
3958 pm8001_ha->sas_addr, SAS_ADDR_SIZE);
3959 payload.sas_identify.phy_id = phy_id;
3960 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opcode, &payload, 0);
3961 return ret;
3962}
3963
3964
3965
3966
3967
3968
3969
3970static int pm80xx_chip_phy_stop_req(struct pm8001_hba_info *pm8001_ha,
3971 u8 phy_id)
3972{
3973 struct phy_stop_req payload;
3974 struct inbound_queue_table *circularQ;
3975 int ret;
3976 u32 tag = 0x01;
3977 u32 opcode = OPC_INB_PHYSTOP;
3978 circularQ = &pm8001_ha->inbnd_q_tbl[0];
3979 memset(&payload, 0, sizeof(payload));
3980 payload.tag = cpu_to_le32(tag);
3981 payload.phy_id = cpu_to_le32(phy_id);
3982 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opcode, &payload, 0);
3983 return ret;
3984}
3985
3986
3987
3988
3989static int pm80xx_chip_reg_dev_req(struct pm8001_hba_info *pm8001_ha,
3990 struct pm8001_device *pm8001_dev, u32 flag)
3991{
3992 struct reg_dev_req payload;
3993 u32 opc;
3994 u32 stp_sspsmp_sata = 0x4;
3995 struct inbound_queue_table *circularQ;
3996 u32 linkrate, phy_id;
3997 int rc, tag = 0xdeadbeef;
3998 struct pm8001_ccb_info *ccb;
3999 u8 retryFlag = 0x1;
4000 u16 firstBurstSize = 0;
4001 u16 ITNT = 2000;
4002 struct domain_device *dev = pm8001_dev->sas_device;
4003 struct domain_device *parent_dev = dev->parent;
4004 circularQ = &pm8001_ha->inbnd_q_tbl[0];
4005
4006 memset(&payload, 0, sizeof(payload));
4007 rc = pm8001_tag_alloc(pm8001_ha, &tag);
4008 if (rc)
4009 return rc;
4010 ccb = &pm8001_ha->ccb_info[tag];
4011 ccb->device = pm8001_dev;
4012 ccb->ccb_tag = tag;
4013 payload.tag = cpu_to_le32(tag);
4014
4015 if (flag == 1) {
4016 stp_sspsmp_sata = 0x02;
4017 } else {
4018 if (pm8001_dev->dev_type == SAS_SATA_DEV)
4019 stp_sspsmp_sata = 0x00;
4020 else if (pm8001_dev->dev_type == SAS_END_DEVICE ||
4021 pm8001_dev->dev_type == SAS_EDGE_EXPANDER_DEVICE ||
4022 pm8001_dev->dev_type == SAS_FANOUT_EXPANDER_DEVICE)
4023 stp_sspsmp_sata = 0x01;
4024 }
4025 if (parent_dev && DEV_IS_EXPANDER(parent_dev->dev_type))
4026 phy_id = parent_dev->ex_dev.ex_phy->phy_id;
4027 else
4028 phy_id = pm8001_dev->attached_phy;
4029
4030 opc = OPC_INB_REG_DEV;
4031
4032 linkrate = (pm8001_dev->sas_device->linkrate < dev->port->linkrate) ?
4033 pm8001_dev->sas_device->linkrate : dev->port->linkrate;
4034
4035 payload.phyid_portid =
4036 cpu_to_le32(((pm8001_dev->sas_device->port->id) & 0xFF) |
4037 ((phy_id & 0xFF) << 8));
4038
4039 payload.dtype_dlr_mcn_ir_retry = cpu_to_le32((retryFlag & 0x01) |
4040 ((linkrate & 0x0F) << 24) |
4041 ((stp_sspsmp_sata & 0x03) << 28));
4042 payload.firstburstsize_ITNexustimeout =
4043 cpu_to_le32(ITNT | (firstBurstSize * 0x10000));
4044
4045 memcpy(payload.sas_addr, pm8001_dev->sas_device->sas_addr,
4046 SAS_ADDR_SIZE);
4047
4048 rc = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
4049
4050 return rc;
4051}
4052
4053
4054
4055
4056
4057
4058
4059
4060static int pm80xx_chip_phy_ctl_req(struct pm8001_hba_info *pm8001_ha,
4061 u32 phyId, u32 phy_op)
4062{
4063 struct local_phy_ctl_req payload;
4064 struct inbound_queue_table *circularQ;
4065 int ret;
4066 u32 opc = OPC_INB_LOCAL_PHY_CONTROL;
4067 memset(&payload, 0, sizeof(payload));
4068 circularQ = &pm8001_ha->inbnd_q_tbl[0];
4069 payload.tag = cpu_to_le32(1);
4070 payload.phyop_phyid =
4071 cpu_to_le32(((phy_op & 0xFF) << 8) | (phyId & 0xFF));
4072 ret = pm8001_mpi_build_cmd(pm8001_ha, circularQ, opc, &payload, 0);
4073 return ret;
4074}
4075
4076static u32 pm80xx_chip_is_our_interupt(struct pm8001_hba_info *pm8001_ha)
4077{
4078 u32 value;
4079#ifdef PM8001_USE_MSIX
4080 return 1;
4081#endif
4082 value = pm8001_cr32(pm8001_ha, 0, MSGU_ODR);
4083 if (value)
4084 return 1;
4085 return 0;
4086
4087}
4088
4089
4090
4091
4092
4093
4094
4095static irqreturn_t
4096pm80xx_chip_isr(struct pm8001_hba_info *pm8001_ha, u8 vec)
4097{
4098 pm80xx_chip_interrupt_disable(pm8001_ha, vec);
4099 process_oq(pm8001_ha, vec);
4100 pm80xx_chip_interrupt_enable(pm8001_ha, vec);
4101 return IRQ_HANDLED;
4102}
4103
4104const struct pm8001_dispatch pm8001_80xx_dispatch = {
4105 .name = "pmc80xx",
4106 .chip_init = pm80xx_chip_init,
4107 .chip_soft_rst = pm80xx_chip_soft_rst,
4108 .chip_rst = pm80xx_hw_chip_rst,
4109 .chip_iounmap = pm8001_chip_iounmap,
4110 .isr = pm80xx_chip_isr,
4111 .is_our_interupt = pm80xx_chip_is_our_interupt,
4112 .isr_process_oq = process_oq,
4113 .interrupt_enable = pm80xx_chip_interrupt_enable,
4114 .interrupt_disable = pm80xx_chip_interrupt_disable,
4115 .make_prd = pm8001_chip_make_sg,
4116 .smp_req = pm80xx_chip_smp_req,
4117 .ssp_io_req = pm80xx_chip_ssp_io_req,
4118 .sata_req = pm80xx_chip_sata_req,
4119 .phy_start_req = pm80xx_chip_phy_start_req,
4120 .phy_stop_req = pm80xx_chip_phy_stop_req,
4121 .reg_dev_req = pm80xx_chip_reg_dev_req,
4122 .dereg_dev_req = pm8001_chip_dereg_dev_req,
4123 .phy_ctl_req = pm80xx_chip_phy_ctl_req,
4124 .task_abort = pm8001_chip_abort_task,
4125 .ssp_tm_req = pm8001_chip_ssp_tm_req,
4126 .get_nvmd_req = pm8001_chip_get_nvmd_req,
4127 .set_nvmd_req = pm8001_chip_set_nvmd_req,
4128 .fw_flash_update_req = pm8001_chip_fw_flash_update_req,
4129 .set_dev_state_req = pm8001_chip_set_dev_state_req,
4130};
4131
