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
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56#include "isci.h"
57#include "host.h"
58#include "phy.h"
59#include "scu_event_codes.h"
60#include "probe_roms.h"
61
62#undef C
63#define C(a) (#a)
64static const char *phy_state_name(enum sci_phy_states state)
65{
66 static const char * const strings[] = PHY_STATES;
67
68 return strings[state];
69}
70#undef C
71
72
73#define SCIC_SDS_PHY_MAX_ARBITRATION_WAIT_TIME (700)
74
75enum sas_linkrate sci_phy_linkrate(struct isci_phy *iphy)
76{
77 return iphy->max_negotiated_speed;
78}
79
80static struct isci_host *phy_to_host(struct isci_phy *iphy)
81{
82 struct isci_phy *table = iphy - iphy->phy_index;
83 struct isci_host *ihost = container_of(table, typeof(*ihost), phys[0]);
84
85 return ihost;
86}
87
88static struct device *sciphy_to_dev(struct isci_phy *iphy)
89{
90 return &phy_to_host(iphy)->pdev->dev;
91}
92
93static enum sci_status
94sci_phy_transport_layer_initialization(struct isci_phy *iphy,
95 struct scu_transport_layer_registers __iomem *reg)
96{
97 u32 tl_control;
98
99 iphy->transport_layer_registers = reg;
100
101 writel(SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX,
102 &iphy->transport_layer_registers->stp_rni);
103
104
105
106
107
108 tl_control = readl(&iphy->transport_layer_registers->control);
109 tl_control |= SCU_TLCR_GEN_BIT(STP_WRITE_DATA_PREFETCH);
110 writel(tl_control, &iphy->transport_layer_registers->control);
111
112 return SCI_SUCCESS;
113}
114
115static enum sci_status
116sci_phy_link_layer_initialization(struct isci_phy *iphy,
117 struct scu_link_layer_registers __iomem *llr)
118{
119 struct isci_host *ihost = iphy->owning_port->owning_controller;
120 struct sci_phy_user_params *phy_user;
121 struct sci_phy_oem_params *phy_oem;
122 int phy_idx = iphy->phy_index;
123 struct sci_phy_cap phy_cap;
124 u32 phy_configuration;
125 u32 parity_check = 0;
126 u32 parity_count = 0;
127 u32 llctl, link_rate;
128 u32 clksm_value = 0;
129 u32 sp_timeouts = 0;
130
131 phy_user = &ihost->user_parameters.phys[phy_idx];
132 phy_oem = &ihost->oem_parameters.phys[phy_idx];
133 iphy->link_layer_registers = llr;
134
135
136 #define SCI_END_DEVICE 0x01
137
138 writel(SCU_SAS_TIID_GEN_BIT(SMP_INITIATOR) |
139 SCU_SAS_TIID_GEN_BIT(SSP_INITIATOR) |
140 SCU_SAS_TIID_GEN_BIT(STP_INITIATOR) |
141 SCU_SAS_TIID_GEN_BIT(DA_SATA_HOST) |
142 SCU_SAS_TIID_GEN_VAL(DEVICE_TYPE, SCI_END_DEVICE),
143 &llr->transmit_identification);
144
145
146 writel(0xFEDCBA98, &llr->sas_device_name_high);
147 writel(phy_idx, &llr->sas_device_name_low);
148
149
150 writel(phy_oem->sas_address.high, &llr->source_sas_address_high);
151 writel(phy_oem->sas_address.low, &llr->source_sas_address_low);
152
153
154 writel(0, &llr->identify_frame_phy_id);
155 writel(SCU_SAS_TIPID_GEN_VALUE(ID, phy_idx), &llr->identify_frame_phy_id);
156
157
158 phy_configuration = readl(&llr->phy_configuration);
159
160
161 phy_configuration |= SCU_SAS_PCFG_GEN_BIT(OOB_RESET);
162 writel(phy_configuration, &llr->phy_configuration);
163
164
165 phy_cap.all = 0;
166 phy_cap.start = 1;
167 phy_cap.gen3_no_ssc = 1;
168 phy_cap.gen2_no_ssc = 1;
169 phy_cap.gen1_no_ssc = 1;
170 if (ihost->oem_parameters.controller.do_enable_ssc) {
171 struct scu_afe_registers __iomem *afe = &ihost->scu_registers->afe;
172 struct scu_afe_transceiver __iomem *xcvr = &afe->scu_afe_xcvr[phy_idx];
173 struct isci_pci_info *pci_info = to_pci_info(ihost->pdev);
174 bool en_sas = false;
175 bool en_sata = false;
176 u32 sas_type = 0;
177 u32 sata_spread = 0x2;
178 u32 sas_spread = 0x2;
179
180 phy_cap.gen3_ssc = 1;
181 phy_cap.gen2_ssc = 1;
182 phy_cap.gen1_ssc = 1;
183
184 if (pci_info->orom->hdr.version < ISCI_ROM_VER_1_1)
185 en_sas = en_sata = true;
186 else {
187 sata_spread = ihost->oem_parameters.controller.ssc_sata_tx_spread_level;
188 sas_spread = ihost->oem_parameters.controller.ssc_sas_tx_spread_level;
189
190 if (sata_spread)
191 en_sata = true;
192
193 if (sas_spread) {
194 en_sas = true;
195 sas_type = ihost->oem_parameters.controller.ssc_sas_tx_type;
196 }
197
198 }
199
200 if (en_sas) {
201 u32 reg;
202
203 reg = readl(&xcvr->afe_xcvr_control0);
204 reg |= (0x00100000 | (sas_type << 19));
205 writel(reg, &xcvr->afe_xcvr_control0);
206
207 reg = readl(&xcvr->afe_tx_ssc_control);
208 reg |= sas_spread << 8;
209 writel(reg, &xcvr->afe_tx_ssc_control);
210 }
211
212 if (en_sata) {
213 u32 reg;
214
215 reg = readl(&xcvr->afe_tx_ssc_control);
216 reg |= sata_spread;
217 writel(reg, &xcvr->afe_tx_ssc_control);
218
219 reg = readl(&llr->stp_control);
220 reg |= 1 << 12;
221 writel(reg, &llr->stp_control);
222 }
223 }
224
225
226
227
228 parity_check = phy_cap.all;
229 while (parity_check != 0) {
230 if (parity_check & 0x1)
231 parity_count++;
232 parity_check >>= 1;
233 }
234
235
236
237
238 if ((parity_count % 2) != 0)
239 phy_cap.parity = 1;
240
241 writel(phy_cap.all, &llr->phy_capabilities);
242
243
244
245
246 writel(SCU_ENSPINUP_GEN_VAL(COUNT,
247 phy_user->notify_enable_spin_up_insertion_frequency),
248 &llr->notify_enable_spinup_control);
249
250
251
252
253 clksm_value = SCU_ALIGN_INSERTION_FREQUENCY_GEN_VAL(CONNECTED,
254 phy_user->in_connection_align_insertion_frequency);
255
256 clksm_value |= SCU_ALIGN_INSERTION_FREQUENCY_GEN_VAL(GENERAL,
257 phy_user->align_insertion_frequency);
258
259 writel(clksm_value, &llr->clock_skew_management);
260
261 if (is_c0(ihost->pdev) || is_c1(ihost->pdev)) {
262 writel(0x04210400, &llr->afe_lookup_table_control);
263 writel(0x020A7C05, &llr->sas_primitive_timeout);
264 } else
265 writel(0x02108421, &llr->afe_lookup_table_control);
266
267 llctl = SCU_SAS_LLCTL_GEN_VAL(NO_OUTBOUND_TASK_TIMEOUT,
268 (u8)ihost->user_parameters.no_outbound_task_timeout);
269
270 switch (phy_user->max_speed_generation) {
271 case SCIC_SDS_PARM_GEN3_SPEED:
272 link_rate = SCU_SAS_LINK_LAYER_CONTROL_MAX_LINK_RATE_GEN3;
273 break;
274 case SCIC_SDS_PARM_GEN2_SPEED:
275 link_rate = SCU_SAS_LINK_LAYER_CONTROL_MAX_LINK_RATE_GEN2;
276 break;
277 default:
278 link_rate = SCU_SAS_LINK_LAYER_CONTROL_MAX_LINK_RATE_GEN1;
279 break;
280 }
281 llctl |= SCU_SAS_LLCTL_GEN_VAL(MAX_LINK_RATE, link_rate);
282 writel(llctl, &llr->link_layer_control);
283
284 sp_timeouts = readl(&llr->sas_phy_timeouts);
285
286
287 sp_timeouts &= ~SCU_SAS_PHYTOV_GEN_VAL(RATE_CHANGE, 0xFF);
288
289
290
291
292 sp_timeouts |= SCU_SAS_PHYTOV_GEN_VAL(RATE_CHANGE, 0x3B);
293
294 writel(sp_timeouts, &llr->sas_phy_timeouts);
295
296 if (is_a2(ihost->pdev)) {
297
298
299
300
301
302
303 writel(SCIC_SDS_PHY_MAX_ARBITRATION_WAIT_TIME,
304 &llr->maximum_arbitration_wait_timer_timeout);
305 }
306
307
308
309
310 writel(0, &llr->link_layer_hang_detection_timeout);
311
312
313 sci_change_state(&iphy->sm, SCI_PHY_STOPPED);
314
315 return SCI_SUCCESS;
316}
317
318static void phy_sata_timeout(struct timer_list *t)
319{
320 struct sci_timer *tmr = from_timer(tmr, t, timer);
321 struct isci_phy *iphy = container_of(tmr, typeof(*iphy), sata_timer);
322 struct isci_host *ihost = iphy->owning_port->owning_controller;
323 unsigned long flags;
324
325 spin_lock_irqsave(&ihost->scic_lock, flags);
326
327 if (tmr->cancel)
328 goto done;
329
330 dev_dbg(sciphy_to_dev(iphy),
331 "%s: SCIC SDS Phy 0x%p did not receive signature fis before "
332 "timeout.\n",
333 __func__,
334 iphy);
335
336 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
337done:
338 spin_unlock_irqrestore(&ihost->scic_lock, flags);
339}
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354struct isci_port *phy_get_non_dummy_port(struct isci_phy *iphy)
355{
356 struct isci_port *iport = iphy->owning_port;
357
358 if (iport->physical_port_index == SCIC_SDS_DUMMY_PORT)
359 return NULL;
360
361 return iphy->owning_port;
362}
363
364
365
366
367void sci_phy_set_port(
368 struct isci_phy *iphy,
369 struct isci_port *iport)
370{
371 iphy->owning_port = iport;
372
373 if (iphy->bcn_received_while_port_unassigned) {
374 iphy->bcn_received_while_port_unassigned = false;
375 sci_port_broadcast_change_received(iphy->owning_port, iphy);
376 }
377}
378
379enum sci_status sci_phy_initialize(struct isci_phy *iphy,
380 struct scu_transport_layer_registers __iomem *tl,
381 struct scu_link_layer_registers __iomem *ll)
382{
383
384 sci_phy_transport_layer_initialization(iphy, tl);
385
386
387 sci_phy_link_layer_initialization(iphy, ll);
388
389
390
391
392 sci_change_state(&iphy->sm, SCI_PHY_STOPPED);
393
394 return SCI_SUCCESS;
395}
396
397
398
399
400
401
402
403
404
405
406void sci_phy_setup_transport(struct isci_phy *iphy, u32 device_id)
407{
408 u32 tl_control;
409
410 writel(device_id, &iphy->transport_layer_registers->stp_rni);
411
412
413
414
415
416 tl_control = readl(&iphy->transport_layer_registers->control);
417 tl_control |= SCU_TLCR_GEN_BIT(CLEAR_TCI_NCQ_MAPPING_TABLE);
418 writel(tl_control, &iphy->transport_layer_registers->control);
419}
420
421static void sci_phy_suspend(struct isci_phy *iphy)
422{
423 u32 scu_sas_pcfg_value;
424
425 scu_sas_pcfg_value =
426 readl(&iphy->link_layer_registers->phy_configuration);
427 scu_sas_pcfg_value |= SCU_SAS_PCFG_GEN_BIT(SUSPEND_PROTOCOL_ENGINE);
428 writel(scu_sas_pcfg_value,
429 &iphy->link_layer_registers->phy_configuration);
430
431 sci_phy_setup_transport(iphy, SCIC_SDS_REMOTE_NODE_CONTEXT_INVALID_INDEX);
432}
433
434void sci_phy_resume(struct isci_phy *iphy)
435{
436 u32 scu_sas_pcfg_value;
437
438 scu_sas_pcfg_value =
439 readl(&iphy->link_layer_registers->phy_configuration);
440 scu_sas_pcfg_value &= ~SCU_SAS_PCFG_GEN_BIT(SUSPEND_PROTOCOL_ENGINE);
441 writel(scu_sas_pcfg_value,
442 &iphy->link_layer_registers->phy_configuration);
443}
444
445void sci_phy_get_sas_address(struct isci_phy *iphy, struct sci_sas_address *sas)
446{
447 sas->high = readl(&iphy->link_layer_registers->source_sas_address_high);
448 sas->low = readl(&iphy->link_layer_registers->source_sas_address_low);
449}
450
451void sci_phy_get_attached_sas_address(struct isci_phy *iphy, struct sci_sas_address *sas)
452{
453 struct sas_identify_frame *iaf;
454
455 iaf = &iphy->frame_rcvd.iaf;
456 memcpy(sas, iaf->sas_addr, SAS_ADDR_SIZE);
457}
458
459void sci_phy_get_protocols(struct isci_phy *iphy, struct sci_phy_proto *proto)
460{
461 proto->all = readl(&iphy->link_layer_registers->transmit_identification);
462}
463
464enum sci_status sci_phy_start(struct isci_phy *iphy)
465{
466 enum sci_phy_states state = iphy->sm.current_state_id;
467
468 if (state != SCI_PHY_STOPPED) {
469 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
470 __func__, phy_state_name(state));
471 return SCI_FAILURE_INVALID_STATE;
472 }
473
474 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
475 return SCI_SUCCESS;
476}
477
478enum sci_status sci_phy_stop(struct isci_phy *iphy)
479{
480 enum sci_phy_states state = iphy->sm.current_state_id;
481
482 switch (state) {
483 case SCI_PHY_SUB_INITIAL:
484 case SCI_PHY_SUB_AWAIT_OSSP_EN:
485 case SCI_PHY_SUB_AWAIT_SAS_SPEED_EN:
486 case SCI_PHY_SUB_AWAIT_SAS_POWER:
487 case SCI_PHY_SUB_AWAIT_SATA_POWER:
488 case SCI_PHY_SUB_AWAIT_SATA_PHY_EN:
489 case SCI_PHY_SUB_AWAIT_SATA_SPEED_EN:
490 case SCI_PHY_SUB_AWAIT_SIG_FIS_UF:
491 case SCI_PHY_SUB_FINAL:
492 case SCI_PHY_READY:
493 break;
494 default:
495 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
496 __func__, phy_state_name(state));
497 return SCI_FAILURE_INVALID_STATE;
498 }
499
500 sci_change_state(&iphy->sm, SCI_PHY_STOPPED);
501 return SCI_SUCCESS;
502}
503
504enum sci_status sci_phy_reset(struct isci_phy *iphy)
505{
506 enum sci_phy_states state = iphy->sm.current_state_id;
507
508 if (state != SCI_PHY_READY) {
509 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
510 __func__, phy_state_name(state));
511 return SCI_FAILURE_INVALID_STATE;
512 }
513
514 sci_change_state(&iphy->sm, SCI_PHY_RESETTING);
515 return SCI_SUCCESS;
516}
517
518enum sci_status sci_phy_consume_power_handler(struct isci_phy *iphy)
519{
520 enum sci_phy_states state = iphy->sm.current_state_id;
521
522 switch (state) {
523 case SCI_PHY_SUB_AWAIT_SAS_POWER: {
524 u32 enable_spinup;
525
526 enable_spinup = readl(&iphy->link_layer_registers->notify_enable_spinup_control);
527 enable_spinup |= SCU_ENSPINUP_GEN_BIT(ENABLE);
528 writel(enable_spinup, &iphy->link_layer_registers->notify_enable_spinup_control);
529
530
531 sci_change_state(&iphy->sm, SCI_PHY_SUB_FINAL);
532
533 return SCI_SUCCESS;
534 }
535 case SCI_PHY_SUB_AWAIT_SATA_POWER: {
536 u32 scu_sas_pcfg_value;
537
538
539 scu_sas_pcfg_value =
540 readl(&iphy->link_layer_registers->phy_configuration);
541 scu_sas_pcfg_value &=
542 ~(SCU_SAS_PCFG_GEN_BIT(SATA_SPINUP_HOLD) | SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE));
543 scu_sas_pcfg_value |= SCU_SAS_PCFG_GEN_BIT(OOB_RESET);
544 writel(scu_sas_pcfg_value,
545 &iphy->link_layer_registers->phy_configuration);
546
547
548 scu_sas_pcfg_value &= ~SCU_SAS_PCFG_GEN_BIT(OOB_RESET);
549 scu_sas_pcfg_value |= SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE);
550 writel(scu_sas_pcfg_value,
551 &iphy->link_layer_registers->phy_configuration);
552
553
554 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_SATA_PHY_EN);
555
556 return SCI_SUCCESS;
557 }
558 default:
559 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
560 __func__, phy_state_name(state));
561 return SCI_FAILURE_INVALID_STATE;
562 }
563}
564
565static void sci_phy_start_sas_link_training(struct isci_phy *iphy)
566{
567
568
569
570
571 u32 phy_control;
572
573 phy_control = readl(&iphy->link_layer_registers->phy_configuration);
574 phy_control |= SCU_SAS_PCFG_GEN_BIT(SATA_SPINUP_HOLD);
575 writel(phy_control,
576 &iphy->link_layer_registers->phy_configuration);
577
578 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_SAS_SPEED_EN);
579
580 iphy->protocol = SAS_PROTOCOL_SSP;
581}
582
583static void sci_phy_start_sata_link_training(struct isci_phy *iphy)
584{
585
586
587
588
589 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_SATA_POWER);
590
591 iphy->protocol = SAS_PROTOCOL_SATA;
592}
593
594
595
596
597
598
599
600
601
602
603
604
605static void sci_phy_complete_link_training(struct isci_phy *iphy,
606 enum sas_linkrate max_link_rate,
607 u32 next_state)
608{
609 iphy->max_negotiated_speed = max_link_rate;
610
611 sci_change_state(&iphy->sm, next_state);
612}
613
614static const char *phy_event_name(u32 event_code)
615{
616 switch (scu_get_event_code(event_code)) {
617 case SCU_EVENT_PORT_SELECTOR_DETECTED:
618 return "port selector";
619 case SCU_EVENT_SENT_PORT_SELECTION:
620 return "port selection";
621 case SCU_EVENT_HARD_RESET_TRANSMITTED:
622 return "tx hard reset";
623 case SCU_EVENT_HARD_RESET_RECEIVED:
624 return "rx hard reset";
625 case SCU_EVENT_RECEIVED_IDENTIFY_TIMEOUT:
626 return "identify timeout";
627 case SCU_EVENT_LINK_FAILURE:
628 return "link fail";
629 case SCU_EVENT_SATA_SPINUP_HOLD:
630 return "sata spinup hold";
631 case SCU_EVENT_SAS_15_SSC:
632 case SCU_EVENT_SAS_15:
633 return "sas 1.5";
634 case SCU_EVENT_SAS_30_SSC:
635 case SCU_EVENT_SAS_30:
636 return "sas 3.0";
637 case SCU_EVENT_SAS_60_SSC:
638 case SCU_EVENT_SAS_60:
639 return "sas 6.0";
640 case SCU_EVENT_SATA_15_SSC:
641 case SCU_EVENT_SATA_15:
642 return "sata 1.5";
643 case SCU_EVENT_SATA_30_SSC:
644 case SCU_EVENT_SATA_30:
645 return "sata 3.0";
646 case SCU_EVENT_SATA_60_SSC:
647 case SCU_EVENT_SATA_60:
648 return "sata 6.0";
649 case SCU_EVENT_SAS_PHY_DETECTED:
650 return "sas detect";
651 case SCU_EVENT_SATA_PHY_DETECTED:
652 return "sata detect";
653 default:
654 return "unknown";
655 }
656}
657
658#define phy_event_dbg(iphy, state, code) \
659 dev_dbg(sciphy_to_dev(iphy), "phy-%d:%d: %s event: %s (%x)\n", \
660 phy_to_host(iphy)->id, iphy->phy_index, \
661 phy_state_name(state), phy_event_name(code), code)
662
663#define phy_event_warn(iphy, state, code) \
664 dev_warn(sciphy_to_dev(iphy), "phy-%d:%d: %s event: %s (%x)\n", \
665 phy_to_host(iphy)->id, iphy->phy_index, \
666 phy_state_name(state), phy_event_name(code), code)
667
668
669static void scu_link_layer_set_txcomsas_timeout(struct isci_phy *iphy, u32 timeout)
670{
671 u32 val;
672
673
674 val = readl(&iphy->link_layer_registers->transmit_comsas_signal);
675 val &= ~SCU_SAS_LLTXCOMSAS_GEN_VAL(NEGTIME, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_MASK);
676 val |= SCU_SAS_LLTXCOMSAS_GEN_VAL(NEGTIME, timeout);
677
678 writel(val, &iphy->link_layer_registers->transmit_comsas_signal);
679}
680
681enum sci_status sci_phy_event_handler(struct isci_phy *iphy, u32 event_code)
682{
683 enum sci_phy_states state = iphy->sm.current_state_id;
684
685 switch (state) {
686 case SCI_PHY_SUB_AWAIT_OSSP_EN:
687 switch (scu_get_event_code(event_code)) {
688 case SCU_EVENT_SAS_PHY_DETECTED:
689 sci_phy_start_sas_link_training(iphy);
690 iphy->is_in_link_training = true;
691 break;
692 case SCU_EVENT_SATA_SPINUP_HOLD:
693 sci_phy_start_sata_link_training(iphy);
694 iphy->is_in_link_training = true;
695 break;
696 case SCU_EVENT_RECEIVED_IDENTIFY_TIMEOUT:
697
698 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_EXTENDED);
699
700
701 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
702 break;
703 default:
704 phy_event_dbg(iphy, state, event_code);
705 return SCI_FAILURE;
706 }
707 return SCI_SUCCESS;
708 case SCI_PHY_SUB_AWAIT_SAS_SPEED_EN:
709 switch (scu_get_event_code(event_code)) {
710 case SCU_EVENT_SAS_PHY_DETECTED:
711
712
713
714 break;
715 case SCU_EVENT_SAS_15:
716 case SCU_EVENT_SAS_15_SSC:
717 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_1_5_GBPS,
718 SCI_PHY_SUB_AWAIT_IAF_UF);
719 break;
720 case SCU_EVENT_SAS_30:
721 case SCU_EVENT_SAS_30_SSC:
722 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_3_0_GBPS,
723 SCI_PHY_SUB_AWAIT_IAF_UF);
724 break;
725 case SCU_EVENT_SAS_60:
726 case SCU_EVENT_SAS_60_SSC:
727 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_6_0_GBPS,
728 SCI_PHY_SUB_AWAIT_IAF_UF);
729 break;
730 case SCU_EVENT_SATA_SPINUP_HOLD:
731
732
733
734 sci_phy_start_sata_link_training(iphy);
735 break;
736 case SCU_EVENT_LINK_FAILURE:
737
738 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
739
740
741 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
742 break;
743 case SCU_EVENT_RECEIVED_IDENTIFY_TIMEOUT:
744
745 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_EXTENDED);
746
747
748 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
749 break;
750 default:
751 phy_event_warn(iphy, state, event_code);
752 return SCI_FAILURE;
753 }
754 return SCI_SUCCESS;
755 case SCI_PHY_SUB_AWAIT_IAF_UF:
756 switch (scu_get_event_code(event_code)) {
757 case SCU_EVENT_SAS_PHY_DETECTED:
758
759 sci_phy_start_sas_link_training(iphy);
760 break;
761 case SCU_EVENT_SATA_SPINUP_HOLD:
762
763
764
765
766 sci_phy_start_sata_link_training(iphy);
767 break;
768 case SCU_EVENT_RECEIVED_IDENTIFY_TIMEOUT:
769
770 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_EXTENDED);
771
772
773 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
774 break;
775 case SCU_EVENT_LINK_FAILURE:
776 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
777 fallthrough;
778 case SCU_EVENT_HARD_RESET_RECEIVED:
779
780 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
781 break;
782 default:
783 phy_event_warn(iphy, state, event_code);
784 return SCI_FAILURE;
785 }
786 return SCI_SUCCESS;
787 case SCI_PHY_SUB_AWAIT_SAS_POWER:
788 switch (scu_get_event_code(event_code)) {
789 case SCU_EVENT_LINK_FAILURE:
790
791 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
792
793
794 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
795 break;
796 default:
797 phy_event_warn(iphy, state, event_code);
798 return SCI_FAILURE;
799 }
800 return SCI_SUCCESS;
801 case SCI_PHY_SUB_AWAIT_SATA_POWER:
802 switch (scu_get_event_code(event_code)) {
803 case SCU_EVENT_LINK_FAILURE:
804
805 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
806
807
808 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
809 break;
810 case SCU_EVENT_SATA_SPINUP_HOLD:
811
812
813
814 break;
815
816 case SCU_EVENT_SAS_PHY_DETECTED:
817
818
819
820 sci_phy_start_sas_link_training(iphy);
821 break;
822
823 default:
824 phy_event_warn(iphy, state, event_code);
825 return SCI_FAILURE;
826 }
827 return SCI_SUCCESS;
828 case SCI_PHY_SUB_AWAIT_SATA_PHY_EN:
829 switch (scu_get_event_code(event_code)) {
830 case SCU_EVENT_LINK_FAILURE:
831
832 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
833
834
835 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
836 break;
837 case SCU_EVENT_SATA_SPINUP_HOLD:
838
839
840
841 break;
842 case SCU_EVENT_SATA_PHY_DETECTED:
843 iphy->protocol = SAS_PROTOCOL_SATA;
844
845
846 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_SATA_SPEED_EN);
847 break;
848 case SCU_EVENT_SAS_PHY_DETECTED:
849
850
851
852 sci_phy_start_sas_link_training(iphy);
853 break;
854 default:
855 phy_event_warn(iphy, state, event_code);
856 return SCI_FAILURE;
857 }
858 return SCI_SUCCESS;
859 case SCI_PHY_SUB_AWAIT_SATA_SPEED_EN:
860 switch (scu_get_event_code(event_code)) {
861 case SCU_EVENT_SATA_PHY_DETECTED:
862
863
864
865 break;
866 case SCU_EVENT_SATA_15:
867 case SCU_EVENT_SATA_15_SSC:
868 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_1_5_GBPS,
869 SCI_PHY_SUB_AWAIT_SIG_FIS_UF);
870 break;
871 case SCU_EVENT_SATA_30:
872 case SCU_EVENT_SATA_30_SSC:
873 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_3_0_GBPS,
874 SCI_PHY_SUB_AWAIT_SIG_FIS_UF);
875 break;
876 case SCU_EVENT_SATA_60:
877 case SCU_EVENT_SATA_60_SSC:
878 sci_phy_complete_link_training(iphy, SAS_LINK_RATE_6_0_GBPS,
879 SCI_PHY_SUB_AWAIT_SIG_FIS_UF);
880 break;
881 case SCU_EVENT_LINK_FAILURE:
882
883 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
884
885
886 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
887 break;
888 case SCU_EVENT_SAS_PHY_DETECTED:
889
890
891
892 sci_phy_start_sas_link_training(iphy);
893 break;
894 default:
895 phy_event_warn(iphy, state, event_code);
896 return SCI_FAILURE;
897 }
898
899 return SCI_SUCCESS;
900 case SCI_PHY_SUB_AWAIT_SIG_FIS_UF:
901 switch (scu_get_event_code(event_code)) {
902 case SCU_EVENT_SATA_PHY_DETECTED:
903
904 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_SATA_SPEED_EN);
905 break;
906
907 case SCU_EVENT_LINK_FAILURE:
908
909 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
910
911
912 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
913 break;
914
915 default:
916 phy_event_warn(iphy, state, event_code);
917 return SCI_FAILURE;
918 }
919 return SCI_SUCCESS;
920 case SCI_PHY_READY:
921 switch (scu_get_event_code(event_code)) {
922 case SCU_EVENT_LINK_FAILURE:
923
924 scu_link_layer_set_txcomsas_timeout(iphy, SCU_SAS_LINK_LAYER_TXCOMSAS_NEGTIME_DEFAULT);
925
926
927 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
928 break;
929 case SCU_EVENT_BROADCAST_CHANGE:
930 case SCU_EVENT_BROADCAST_SES:
931 case SCU_EVENT_BROADCAST_RESERVED0:
932 case SCU_EVENT_BROADCAST_RESERVED1:
933 case SCU_EVENT_BROADCAST_EXPANDER:
934 case SCU_EVENT_BROADCAST_AEN:
935
936 if (phy_get_non_dummy_port(iphy) != NULL)
937 sci_port_broadcast_change_received(iphy->owning_port, iphy);
938 else
939 iphy->bcn_received_while_port_unassigned = true;
940 break;
941 case SCU_EVENT_BROADCAST_RESERVED3:
942 case SCU_EVENT_BROADCAST_RESERVED4:
943 default:
944 phy_event_warn(iphy, state, event_code);
945 return SCI_FAILURE_INVALID_STATE;
946 }
947 return SCI_SUCCESS;
948 case SCI_PHY_RESETTING:
949 switch (scu_get_event_code(event_code)) {
950 case SCU_EVENT_HARD_RESET_TRANSMITTED:
951
952 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
953 break;
954 default:
955 phy_event_warn(iphy, state, event_code);
956 return SCI_FAILURE_INVALID_STATE;
957 }
958 return SCI_SUCCESS;
959 default:
960 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
961 __func__, phy_state_name(state));
962 return SCI_FAILURE_INVALID_STATE;
963 }
964}
965
966enum sci_status sci_phy_frame_handler(struct isci_phy *iphy, u32 frame_index)
967{
968 enum sci_phy_states state = iphy->sm.current_state_id;
969 struct isci_host *ihost = iphy->owning_port->owning_controller;
970 enum sci_status result;
971 unsigned long flags;
972
973 switch (state) {
974 case SCI_PHY_SUB_AWAIT_IAF_UF: {
975 u32 *frame_words;
976 struct sas_identify_frame iaf;
977
978 result = sci_unsolicited_frame_control_get_header(&ihost->uf_control,
979 frame_index,
980 (void **)&frame_words);
981
982 if (result != SCI_SUCCESS)
983 return result;
984
985 sci_swab32_cpy(&iaf, frame_words, sizeof(iaf) / sizeof(u32));
986 if (iaf.frame_type == 0) {
987 u32 state;
988
989 spin_lock_irqsave(&iphy->sas_phy.frame_rcvd_lock, flags);
990 memcpy(&iphy->frame_rcvd.iaf, &iaf, sizeof(iaf));
991 spin_unlock_irqrestore(&iphy->sas_phy.frame_rcvd_lock, flags);
992 if (iaf.smp_tport) {
993
994
995
996
997 state = SCI_PHY_SUB_FINAL;
998 } else {
999
1000
1001
1002 state = SCI_PHY_SUB_AWAIT_SAS_POWER;
1003 }
1004 sci_change_state(&iphy->sm, state);
1005 result = SCI_SUCCESS;
1006 } else
1007 dev_warn(sciphy_to_dev(iphy),
1008 "%s: PHY starting substate machine received "
1009 "unexpected frame id %x\n",
1010 __func__, frame_index);
1011
1012 sci_controller_release_frame(ihost, frame_index);
1013 return result;
1014 }
1015 case SCI_PHY_SUB_AWAIT_SIG_FIS_UF: {
1016 struct dev_to_host_fis *frame_header;
1017 u32 *fis_frame_data;
1018
1019 result = sci_unsolicited_frame_control_get_header(&ihost->uf_control,
1020 frame_index,
1021 (void **)&frame_header);
1022
1023 if (result != SCI_SUCCESS)
1024 return result;
1025
1026 if ((frame_header->fis_type == FIS_REGD2H) &&
1027 !(frame_header->status & ATA_BUSY)) {
1028 sci_unsolicited_frame_control_get_buffer(&ihost->uf_control,
1029 frame_index,
1030 (void **)&fis_frame_data);
1031
1032 spin_lock_irqsave(&iphy->sas_phy.frame_rcvd_lock, flags);
1033 sci_controller_copy_sata_response(&iphy->frame_rcvd.fis,
1034 frame_header,
1035 fis_frame_data);
1036 spin_unlock_irqrestore(&iphy->sas_phy.frame_rcvd_lock, flags);
1037
1038
1039 sci_change_state(&iphy->sm, SCI_PHY_SUB_FINAL);
1040
1041 result = SCI_SUCCESS;
1042 } else
1043 dev_warn(sciphy_to_dev(iphy),
1044 "%s: PHY starting substate machine received "
1045 "unexpected frame id %x\n",
1046 __func__, frame_index);
1047
1048
1049 sci_controller_release_frame(ihost, frame_index);
1050
1051 return result;
1052 }
1053 default:
1054 dev_dbg(sciphy_to_dev(iphy), "%s: in wrong state: %s\n",
1055 __func__, phy_state_name(state));
1056 return SCI_FAILURE_INVALID_STATE;
1057 }
1058
1059}
1060
1061static void sci_phy_starting_initial_substate_enter(struct sci_base_state_machine *sm)
1062{
1063 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1064
1065
1066 sci_change_state(&iphy->sm, SCI_PHY_SUB_AWAIT_OSSP_EN);
1067}
1068
1069static void sci_phy_starting_await_sas_power_substate_enter(struct sci_base_state_machine *sm)
1070{
1071 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1072 struct isci_host *ihost = iphy->owning_port->owning_controller;
1073
1074 sci_controller_power_control_queue_insert(ihost, iphy);
1075}
1076
1077static void sci_phy_starting_await_sas_power_substate_exit(struct sci_base_state_machine *sm)
1078{
1079 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1080 struct isci_host *ihost = iphy->owning_port->owning_controller;
1081
1082 sci_controller_power_control_queue_remove(ihost, iphy);
1083}
1084
1085static void sci_phy_starting_await_sata_power_substate_enter(struct sci_base_state_machine *sm)
1086{
1087 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1088 struct isci_host *ihost = iphy->owning_port->owning_controller;
1089
1090 sci_controller_power_control_queue_insert(ihost, iphy);
1091}
1092
1093static void sci_phy_starting_await_sata_power_substate_exit(struct sci_base_state_machine *sm)
1094{
1095 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1096 struct isci_host *ihost = iphy->owning_port->owning_controller;
1097
1098 sci_controller_power_control_queue_remove(ihost, iphy);
1099}
1100
1101static void sci_phy_starting_await_sata_phy_substate_enter(struct sci_base_state_machine *sm)
1102{
1103 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1104
1105 sci_mod_timer(&iphy->sata_timer, SCIC_SDS_SATA_LINK_TRAINING_TIMEOUT);
1106}
1107
1108static void sci_phy_starting_await_sata_phy_substate_exit(struct sci_base_state_machine *sm)
1109{
1110 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1111
1112 sci_del_timer(&iphy->sata_timer);
1113}
1114
1115static void sci_phy_starting_await_sata_speed_substate_enter(struct sci_base_state_machine *sm)
1116{
1117 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1118
1119 sci_mod_timer(&iphy->sata_timer, SCIC_SDS_SATA_LINK_TRAINING_TIMEOUT);
1120}
1121
1122static void sci_phy_starting_await_sata_speed_substate_exit(struct sci_base_state_machine *sm)
1123{
1124 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1125
1126 sci_del_timer(&iphy->sata_timer);
1127}
1128
1129static void sci_phy_starting_await_sig_fis_uf_substate_enter(struct sci_base_state_machine *sm)
1130{
1131 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1132
1133 if (sci_port_link_detected(iphy->owning_port, iphy)) {
1134
1135
1136
1137
1138
1139
1140
1141 sci_phy_resume(iphy);
1142
1143 sci_mod_timer(&iphy->sata_timer,
1144 SCIC_SDS_SIGNATURE_FIS_TIMEOUT);
1145 } else
1146 iphy->is_in_link_training = false;
1147}
1148
1149static void sci_phy_starting_await_sig_fis_uf_substate_exit(struct sci_base_state_machine *sm)
1150{
1151 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1152
1153 sci_del_timer(&iphy->sata_timer);
1154}
1155
1156static void sci_phy_starting_final_substate_enter(struct sci_base_state_machine *sm)
1157{
1158 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1159
1160
1161
1162
1163 sci_change_state(&iphy->sm, SCI_PHY_READY);
1164}
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174static void scu_link_layer_stop_protocol_engine(
1175 struct isci_phy *iphy)
1176{
1177 u32 scu_sas_pcfg_value;
1178 u32 enable_spinup_value;
1179
1180
1181 scu_sas_pcfg_value =
1182 readl(&iphy->link_layer_registers->phy_configuration);
1183 scu_sas_pcfg_value |=
1184 (SCU_SAS_PCFG_GEN_BIT(OOB_RESET) |
1185 SCU_SAS_PCFG_GEN_BIT(SUSPEND_PROTOCOL_ENGINE) |
1186 SCU_SAS_PCFG_GEN_BIT(SATA_SPINUP_HOLD));
1187 writel(scu_sas_pcfg_value,
1188 &iphy->link_layer_registers->phy_configuration);
1189
1190
1191 enable_spinup_value = readl(&iphy->link_layer_registers->notify_enable_spinup_control);
1192 enable_spinup_value &= ~SCU_ENSPINUP_GEN_BIT(ENABLE);
1193 writel(enable_spinup_value, &iphy->link_layer_registers->notify_enable_spinup_control);
1194}
1195
1196static void scu_link_layer_start_oob(struct isci_phy *iphy)
1197{
1198 struct scu_link_layer_registers __iomem *ll = iphy->link_layer_registers;
1199 u32 val;
1200
1201
1202 val = readl(&ll->phy_configuration);
1203 val &= ~(SCU_SAS_PCFG_GEN_BIT(OOB_RESET) |
1204 SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE) |
1205 SCU_SAS_PCFG_GEN_BIT(HARD_RESET));
1206 writel(val, &ll->phy_configuration);
1207 readl(&ll->phy_configuration);
1208
1209
1210
1211 val = readl(&ll->phy_configuration);
1212 val |= SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE);
1213 writel(val, &ll->phy_configuration);
1214 readl(&ll->phy_configuration);
1215
1216}
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227static void scu_link_layer_tx_hard_reset(
1228 struct isci_phy *iphy)
1229{
1230 u32 phy_configuration_value;
1231
1232
1233
1234
1235 phy_configuration_value =
1236 readl(&iphy->link_layer_registers->phy_configuration);
1237 phy_configuration_value &= ~(SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE));
1238 phy_configuration_value |=
1239 (SCU_SAS_PCFG_GEN_BIT(HARD_RESET) |
1240 SCU_SAS_PCFG_GEN_BIT(OOB_RESET));
1241 writel(phy_configuration_value,
1242 &iphy->link_layer_registers->phy_configuration);
1243
1244
1245 phy_configuration_value |= SCU_SAS_PCFG_GEN_BIT(OOB_ENABLE);
1246 phy_configuration_value &= ~SCU_SAS_PCFG_GEN_BIT(OOB_RESET);
1247 writel(phy_configuration_value,
1248 &iphy->link_layer_registers->phy_configuration);
1249}
1250
1251static void sci_phy_stopped_state_enter(struct sci_base_state_machine *sm)
1252{
1253 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1254 struct isci_port *iport = iphy->owning_port;
1255 struct isci_host *ihost = iport->owning_controller;
1256
1257
1258
1259
1260
1261 sci_del_timer(&iphy->sata_timer);
1262
1263 scu_link_layer_stop_protocol_engine(iphy);
1264
1265 if (iphy->sm.previous_state_id != SCI_PHY_INITIAL)
1266 sci_controller_link_down(ihost, phy_get_non_dummy_port(iphy), iphy);
1267}
1268
1269static void sci_phy_starting_state_enter(struct sci_base_state_machine *sm)
1270{
1271 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1272 struct isci_port *iport = iphy->owning_port;
1273 struct isci_host *ihost = iport->owning_controller;
1274
1275 scu_link_layer_stop_protocol_engine(iphy);
1276 scu_link_layer_start_oob(iphy);
1277
1278
1279 iphy->protocol = SAS_PROTOCOL_NONE;
1280 iphy->bcn_received_while_port_unassigned = false;
1281
1282 if (iphy->sm.previous_state_id == SCI_PHY_READY)
1283 sci_controller_link_down(ihost, phy_get_non_dummy_port(iphy), iphy);
1284
1285 sci_change_state(&iphy->sm, SCI_PHY_SUB_INITIAL);
1286}
1287
1288static void sci_phy_ready_state_enter(struct sci_base_state_machine *sm)
1289{
1290 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1291 struct isci_port *iport = iphy->owning_port;
1292 struct isci_host *ihost = iport->owning_controller;
1293
1294 sci_controller_link_up(ihost, phy_get_non_dummy_port(iphy), iphy);
1295}
1296
1297static void sci_phy_ready_state_exit(struct sci_base_state_machine *sm)
1298{
1299 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1300
1301 sci_phy_suspend(iphy);
1302}
1303
1304static void sci_phy_resetting_state_enter(struct sci_base_state_machine *sm)
1305{
1306 struct isci_phy *iphy = container_of(sm, typeof(*iphy), sm);
1307
1308
1309
1310
1311
1312 sci_port_deactivate_phy(iphy->owning_port, iphy, false);
1313
1314 if (iphy->protocol == SAS_PROTOCOL_SSP) {
1315 scu_link_layer_tx_hard_reset(iphy);
1316 } else {
1317
1318
1319
1320 sci_change_state(&iphy->sm, SCI_PHY_STARTING);
1321 }
1322}
1323
1324static const struct sci_base_state sci_phy_state_table[] = {
1325 [SCI_PHY_INITIAL] = { },
1326 [SCI_PHY_STOPPED] = {
1327 .enter_state = sci_phy_stopped_state_enter,
1328 },
1329 [SCI_PHY_STARTING] = {
1330 .enter_state = sci_phy_starting_state_enter,
1331 },
1332 [SCI_PHY_SUB_INITIAL] = {
1333 .enter_state = sci_phy_starting_initial_substate_enter,
1334 },
1335 [SCI_PHY_SUB_AWAIT_OSSP_EN] = { },
1336 [SCI_PHY_SUB_AWAIT_SAS_SPEED_EN] = { },
1337 [SCI_PHY_SUB_AWAIT_IAF_UF] = { },
1338 [SCI_PHY_SUB_AWAIT_SAS_POWER] = {
1339 .enter_state = sci_phy_starting_await_sas_power_substate_enter,
1340 .exit_state = sci_phy_starting_await_sas_power_substate_exit,
1341 },
1342 [SCI_PHY_SUB_AWAIT_SATA_POWER] = {
1343 .enter_state = sci_phy_starting_await_sata_power_substate_enter,
1344 .exit_state = sci_phy_starting_await_sata_power_substate_exit
1345 },
1346 [SCI_PHY_SUB_AWAIT_SATA_PHY_EN] = {
1347 .enter_state = sci_phy_starting_await_sata_phy_substate_enter,
1348 .exit_state = sci_phy_starting_await_sata_phy_substate_exit
1349 },
1350 [SCI_PHY_SUB_AWAIT_SATA_SPEED_EN] = {
1351 .enter_state = sci_phy_starting_await_sata_speed_substate_enter,
1352 .exit_state = sci_phy_starting_await_sata_speed_substate_exit
1353 },
1354 [SCI_PHY_SUB_AWAIT_SIG_FIS_UF] = {
1355 .enter_state = sci_phy_starting_await_sig_fis_uf_substate_enter,
1356 .exit_state = sci_phy_starting_await_sig_fis_uf_substate_exit
1357 },
1358 [SCI_PHY_SUB_FINAL] = {
1359 .enter_state = sci_phy_starting_final_substate_enter,
1360 },
1361 [SCI_PHY_READY] = {
1362 .enter_state = sci_phy_ready_state_enter,
1363 .exit_state = sci_phy_ready_state_exit,
1364 },
1365 [SCI_PHY_RESETTING] = {
1366 .enter_state = sci_phy_resetting_state_enter,
1367 },
1368 [SCI_PHY_FINAL] = { },
1369};
1370
1371void sci_phy_construct(struct isci_phy *iphy,
1372 struct isci_port *iport, u8 phy_index)
1373{
1374 sci_init_sm(&iphy->sm, sci_phy_state_table, SCI_PHY_INITIAL);
1375
1376
1377 iphy->owning_port = iport;
1378 iphy->phy_index = phy_index;
1379 iphy->bcn_received_while_port_unassigned = false;
1380 iphy->protocol = SAS_PROTOCOL_NONE;
1381 iphy->link_layer_registers = NULL;
1382 iphy->max_negotiated_speed = SAS_LINK_RATE_UNKNOWN;
1383
1384
1385 sci_init_timer(&iphy->sata_timer, phy_sata_timeout);
1386}
1387
1388void isci_phy_init(struct isci_phy *iphy, struct isci_host *ihost, int index)
1389{
1390 struct sci_oem_params *oem = &ihost->oem_parameters;
1391 u64 sci_sas_addr;
1392 __be64 sas_addr;
1393
1394 sci_sas_addr = oem->phys[index].sas_address.high;
1395 sci_sas_addr <<= 32;
1396 sci_sas_addr |= oem->phys[index].sas_address.low;
1397 sas_addr = cpu_to_be64(sci_sas_addr);
1398 memcpy(iphy->sas_addr, &sas_addr, sizeof(sas_addr));
1399
1400 iphy->sas_phy.enabled = 0;
1401 iphy->sas_phy.id = index;
1402 iphy->sas_phy.sas_addr = &iphy->sas_addr[0];
1403 iphy->sas_phy.frame_rcvd = (u8 *)&iphy->frame_rcvd;
1404 iphy->sas_phy.ha = &ihost->sas_ha;
1405 iphy->sas_phy.lldd_phy = iphy;
1406 iphy->sas_phy.enabled = 1;
1407 iphy->sas_phy.class = SAS;
1408 iphy->sas_phy.iproto = SAS_PROTOCOL_ALL;
1409 iphy->sas_phy.tproto = 0;
1410 iphy->sas_phy.type = PHY_TYPE_PHYSICAL;
1411 iphy->sas_phy.role = PHY_ROLE_INITIATOR;
1412 iphy->sas_phy.oob_mode = OOB_NOT_CONNECTED;
1413 iphy->sas_phy.linkrate = SAS_LINK_RATE_UNKNOWN;
1414 memset(&iphy->frame_rcvd, 0, sizeof(iphy->frame_rcvd));
1415}
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427int isci_phy_control(struct asd_sas_phy *sas_phy,
1428 enum phy_func func,
1429 void *buf)
1430{
1431 int ret = 0;
1432 struct isci_phy *iphy = sas_phy->lldd_phy;
1433 struct asd_sas_port *port = sas_phy->port;
1434 struct isci_host *ihost = sas_phy->ha->lldd_ha;
1435 unsigned long flags;
1436
1437 dev_dbg(&ihost->pdev->dev,
1438 "%s: phy %p; func %d; buf %p; isci phy %p, port %p\n",
1439 __func__, sas_phy, func, buf, iphy, port);
1440
1441 switch (func) {
1442 case PHY_FUNC_DISABLE:
1443 spin_lock_irqsave(&ihost->scic_lock, flags);
1444 scu_link_layer_start_oob(iphy);
1445 sci_phy_stop(iphy);
1446 spin_unlock_irqrestore(&ihost->scic_lock, flags);
1447 break;
1448
1449 case PHY_FUNC_LINK_RESET:
1450 spin_lock_irqsave(&ihost->scic_lock, flags);
1451 scu_link_layer_start_oob(iphy);
1452 sci_phy_stop(iphy);
1453 sci_phy_start(iphy);
1454 spin_unlock_irqrestore(&ihost->scic_lock, flags);
1455 break;
1456
1457 case PHY_FUNC_HARD_RESET:
1458 if (!port)
1459 return -ENODEV;
1460
1461 ret = isci_port_perform_hard_reset(ihost, port->lldd_port, iphy);
1462
1463 break;
1464 case PHY_FUNC_GET_EVENTS: {
1465 struct scu_link_layer_registers __iomem *r;
1466 struct sas_phy *phy = sas_phy->phy;
1467
1468 r = iphy->link_layer_registers;
1469 phy->running_disparity_error_count = readl(&r->running_disparity_error_count);
1470 phy->loss_of_dword_sync_count = readl(&r->loss_of_sync_error_count);
1471 phy->phy_reset_problem_count = readl(&r->phy_reset_problem_count);
1472 phy->invalid_dword_count = readl(&r->invalid_dword_counter);
1473 break;
1474 }
1475
1476 default:
1477 dev_dbg(&ihost->pdev->dev,
1478 "%s: phy %p; func %d NOT IMPLEMENTED!\n",
1479 __func__, sas_phy, func);
1480 ret = -ENOSYS;
1481 break;
1482 }
1483 return ret;
1484}
1485