This source file includes following definitions.
- sci_sas_address_compare
- sci_port_configuration_agent_find_port
- sci_port_configuration_agent_validate_ports
- sci_mpc_agent_validate_phy_configuration
- mpc_agent_timeout
- sci_mpc_agent_link_up
- sci_mpc_agent_link_down
- sci_apc_agent_validate_phy_configuration
- sci_apc_agent_start_timer
- sci_apc_agent_configure_ports
- sci_apc_agent_link_up
- sci_apc_agent_link_down
- apc_agent_timeout
- sci_port_configuration_agent_construct
- is_port_config_apc
- sci_port_configuration_agent_initialize
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 "host.h"
57
58 #define SCIC_SDS_MPC_RECONFIGURATION_TIMEOUT (10)
59 #define SCIC_SDS_APC_RECONFIGURATION_TIMEOUT (10)
60 #define SCIC_SDS_APC_WAIT_LINK_UP_NOTIFICATION (1000)
61
62 enum SCIC_SDS_APC_ACTIVITY {
63 SCIC_SDS_APC_SKIP_PHY,
64 SCIC_SDS_APC_ADD_PHY,
65 SCIC_SDS_APC_START_TIMER,
66
67 SCIC_SDS_APC_ACTIVITY_MAX
68 };
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86 static s32 sci_sas_address_compare(
87 struct sci_sas_address address_one,
88 struct sci_sas_address address_two)
89 {
90 if (address_one.high > address_two.high) {
91 return 1;
92 } else if (address_one.high < address_two.high) {
93 return -1;
94 } else if (address_one.low > address_two.low) {
95 return 1;
96 } else if (address_one.low < address_two.low) {
97 return -1;
98 }
99
100
101 return 0;
102 }
103
104
105
106
107
108
109
110
111
112
113
114
115 static struct isci_port *sci_port_configuration_agent_find_port(
116 struct isci_host *ihost,
117 struct isci_phy *iphy)
118 {
119 u8 i;
120 struct sci_sas_address port_sas_address;
121 struct sci_sas_address port_attached_device_address;
122 struct sci_sas_address phy_sas_address;
123 struct sci_sas_address phy_attached_device_address;
124
125
126
127
128
129
130 sci_phy_get_sas_address(iphy, &phy_sas_address);
131 sci_phy_get_attached_sas_address(iphy, &phy_attached_device_address);
132
133 for (i = 0; i < ihost->logical_port_entries; i++) {
134 struct isci_port *iport = &ihost->ports[i];
135
136 sci_port_get_sas_address(iport, &port_sas_address);
137 sci_port_get_attached_sas_address(iport, &port_attached_device_address);
138
139 if (sci_sas_address_compare(port_sas_address, phy_sas_address) == 0 &&
140 sci_sas_address_compare(port_attached_device_address, phy_attached_device_address) == 0)
141 return iport;
142 }
143
144 return NULL;
145 }
146
147
148
149
150
151
152
153
154
155
156
157
158
159 static enum sci_status sci_port_configuration_agent_validate_ports(
160 struct isci_host *ihost,
161 struct sci_port_configuration_agent *port_agent)
162 {
163 struct sci_sas_address first_address;
164 struct sci_sas_address second_address;
165
166
167
168
169 if (port_agent->phy_valid_port_range[0].max_index != 0 ||
170 port_agent->phy_valid_port_range[1].max_index != 1 ||
171 port_agent->phy_valid_port_range[2].max_index != 2 ||
172 port_agent->phy_valid_port_range[3].max_index != 3)
173 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
174
175
176
177
178 if (port_agent->phy_valid_port_range[0].min_index == 0 &&
179 port_agent->phy_valid_port_range[1].min_index == 0 &&
180 port_agent->phy_valid_port_range[2].min_index == 0 &&
181 port_agent->phy_valid_port_range[3].min_index == 0)
182 return SCI_SUCCESS;
183
184
185
186
187
188
189 if (port_agent->phy_valid_port_range[2].min_index == 1) {
190 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
191 }
192
193
194
195
196
197 sci_phy_get_sas_address(&ihost->phys[0], &first_address);
198 sci_phy_get_sas_address(&ihost->phys[3], &second_address);
199
200 if (sci_sas_address_compare(first_address, second_address) == 0) {
201 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
202 }
203
204
205
206
207
208 if (port_agent->phy_valid_port_range[0].min_index == 0 &&
209 port_agent->phy_valid_port_range[1].min_index == 1) {
210 sci_phy_get_sas_address(&ihost->phys[0], &first_address);
211 sci_phy_get_sas_address(&ihost->phys[2], &second_address);
212
213 if (sci_sas_address_compare(first_address, second_address) == 0) {
214 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
215 }
216 }
217
218
219
220
221
222 if (port_agent->phy_valid_port_range[2].min_index == 2 &&
223 port_agent->phy_valid_port_range[3].min_index == 3) {
224 sci_phy_get_sas_address(&ihost->phys[1], &first_address);
225 sci_phy_get_sas_address(&ihost->phys[3], &second_address);
226
227 if (sci_sas_address_compare(first_address, second_address) == 0) {
228 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
229 }
230 }
231
232 return SCI_SUCCESS;
233 }
234
235
236
237
238
239
240
241 static enum sci_status
242 sci_mpc_agent_validate_phy_configuration(struct isci_host *ihost,
243 struct sci_port_configuration_agent *port_agent)
244 {
245 u32 phy_mask;
246 u32 assigned_phy_mask;
247 struct sci_sas_address sas_address;
248 struct sci_sas_address phy_assigned_address;
249 u8 port_index;
250 u8 phy_index;
251
252 assigned_phy_mask = 0;
253 sas_address.high = 0;
254 sas_address.low = 0;
255
256 for (port_index = 0; port_index < SCI_MAX_PORTS; port_index++) {
257 phy_mask = ihost->oem_parameters.ports[port_index].phy_mask;
258
259 if (!phy_mask)
260 continue;
261
262
263
264 if ((phy_mask & ~assigned_phy_mask) == 0) {
265 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
266 }
267
268
269 for (phy_index = 0; phy_index < SCI_MAX_PHYS; phy_index++) {
270 if ((phy_mask & (1 << phy_index)) == 0)
271 continue;
272 sci_phy_get_sas_address(&ihost->phys[phy_index],
273 &sas_address);
274
275
276
277
278
279 port_agent->phy_valid_port_range[phy_index].min_index = port_index;
280 port_agent->phy_valid_port_range[phy_index].max_index = phy_index;
281
282 if (phy_index != port_index) {
283 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
284 }
285
286 break;
287 }
288
289
290
291
292
293
294 for (; phy_index < SCI_MAX_PHYS; phy_index++) {
295 if ((phy_mask & (1 << phy_index)) == 0)
296 continue;
297 sci_phy_get_sas_address(&ihost->phys[phy_index],
298 &phy_assigned_address);
299
300 if (sci_sas_address_compare(sas_address, phy_assigned_address) != 0) {
301
302
303
304 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
305 }
306
307 port_agent->phy_valid_port_range[phy_index].min_index = port_index;
308 port_agent->phy_valid_port_range[phy_index].max_index = phy_index;
309
310 sci_port_add_phy(&ihost->ports[port_index],
311 &ihost->phys[phy_index]);
312
313 assigned_phy_mask |= (1 << phy_index);
314 }
315
316 }
317
318 return sci_port_configuration_agent_validate_ports(ihost, port_agent);
319 }
320
321 static void mpc_agent_timeout(struct timer_list *t)
322 {
323 u8 index;
324 struct sci_timer *tmr = from_timer(tmr, t, timer);
325 struct sci_port_configuration_agent *port_agent;
326 struct isci_host *ihost;
327 unsigned long flags;
328 u16 configure_phy_mask;
329
330 port_agent = container_of(tmr, typeof(*port_agent), timer);
331 ihost = container_of(port_agent, typeof(*ihost), port_agent);
332
333 spin_lock_irqsave(&ihost->scic_lock, flags);
334
335 if (tmr->cancel)
336 goto done;
337
338 port_agent->timer_pending = false;
339
340
341 configure_phy_mask = ~port_agent->phy_configured_mask & port_agent->phy_ready_mask;
342
343 for (index = 0; index < SCI_MAX_PHYS; index++) {
344 struct isci_phy *iphy = &ihost->phys[index];
345
346 if (configure_phy_mask & (1 << index)) {
347 port_agent->link_up_handler(ihost, port_agent,
348 phy_get_non_dummy_port(iphy),
349 iphy);
350 }
351 }
352
353 done:
354 spin_unlock_irqrestore(&ihost->scic_lock, flags);
355 }
356
357 static void sci_mpc_agent_link_up(struct isci_host *ihost,
358 struct sci_port_configuration_agent *port_agent,
359 struct isci_port *iport,
360 struct isci_phy *iphy)
361 {
362
363
364
365
366 if (!iport)
367 return;
368
369 port_agent->phy_ready_mask |= (1 << iphy->phy_index);
370 sci_port_link_up(iport, iphy);
371 if ((iport->active_phy_mask & (1 << iphy->phy_index)))
372 port_agent->phy_configured_mask |= (1 << iphy->phy_index);
373 }
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392 static void sci_mpc_agent_link_down(
393 struct isci_host *ihost,
394 struct sci_port_configuration_agent *port_agent,
395 struct isci_port *iport,
396 struct isci_phy *iphy)
397 {
398 if (iport != NULL) {
399
400
401
402
403
404
405
406 port_agent->phy_ready_mask &= ~(1 << iphy->phy_index);
407 port_agent->phy_configured_mask &= ~(1 << iphy->phy_index);
408
409
410
411
412
413
414
415 if ((port_agent->phy_configured_mask == 0x0000) &&
416 (port_agent->phy_ready_mask != 0x0000) &&
417 !port_agent->timer_pending) {
418 port_agent->timer_pending = true;
419
420 sci_mod_timer(&port_agent->timer,
421 SCIC_SDS_MPC_RECONFIGURATION_TIMEOUT);
422 }
423
424 sci_port_link_down(iport, iphy);
425 }
426 }
427
428
429
430
431 static enum sci_status
432 sci_apc_agent_validate_phy_configuration(struct isci_host *ihost,
433 struct sci_port_configuration_agent *port_agent)
434 {
435 u8 phy_index;
436 u8 port_index;
437 struct sci_sas_address sas_address;
438 struct sci_sas_address phy_assigned_address;
439
440 phy_index = 0;
441
442 while (phy_index < SCI_MAX_PHYS) {
443 port_index = phy_index;
444
445
446 sci_phy_get_sas_address(&ihost->phys[phy_index],
447 &sas_address);
448
449 while (++phy_index < SCI_MAX_PHYS) {
450 sci_phy_get_sas_address(&ihost->phys[phy_index],
451 &phy_assigned_address);
452
453
454 if (sci_sas_address_compare(sas_address, phy_assigned_address) == 0) {
455 port_agent->phy_valid_port_range[phy_index].min_index = port_index;
456 port_agent->phy_valid_port_range[phy_index].max_index = phy_index;
457 } else {
458 port_agent->phy_valid_port_range[phy_index].min_index = phy_index;
459 port_agent->phy_valid_port_range[phy_index].max_index = phy_index;
460 break;
461 }
462 }
463 }
464
465 return sci_port_configuration_agent_validate_ports(ihost, port_agent);
466 }
467
468
469
470
471
472
473
474 static void sci_apc_agent_start_timer(struct sci_port_configuration_agent *port_agent,
475 u32 timeout)
476 {
477 port_agent->timer_pending = true;
478 sci_mod_timer(&port_agent->timer, timeout);
479 }
480
481 static void sci_apc_agent_configure_ports(struct isci_host *ihost,
482 struct sci_port_configuration_agent *port_agent,
483 struct isci_phy *iphy,
484 bool start_timer)
485 {
486 u8 port_index;
487 enum sci_status status;
488 struct isci_port *iport;
489 enum SCIC_SDS_APC_ACTIVITY apc_activity = SCIC_SDS_APC_SKIP_PHY;
490
491 iport = sci_port_configuration_agent_find_port(ihost, iphy);
492
493 if (iport) {
494 if (sci_port_is_valid_phy_assignment(iport, iphy->phy_index))
495 apc_activity = SCIC_SDS_APC_ADD_PHY;
496 else
497 apc_activity = SCIC_SDS_APC_SKIP_PHY;
498 } else {
499
500
501
502
503
504
505 for (port_index = port_agent->phy_valid_port_range[iphy->phy_index].min_index;
506 port_index <= port_agent->phy_valid_port_range[iphy->phy_index].max_index;
507 port_index++) {
508
509 iport = &ihost->ports[port_index];
510
511
512 if (sci_port_is_valid_phy_assignment(iport, iphy->phy_index)) {
513
514
515
516
517 if (iport->active_phy_mask > (1 << iphy->phy_index)) {
518 apc_activity = SCIC_SDS_APC_SKIP_PHY;
519 break;
520 }
521
522
523
524
525
526 if (iport->physical_port_index == iphy->phy_index) {
527
528
529
530
531
532 if (apc_activity != SCIC_SDS_APC_START_TIMER) {
533 apc_activity = SCIC_SDS_APC_ADD_PHY;
534 }
535
536 break;
537 }
538
539
540
541
542
543 if (iport->active_phy_mask == 0) {
544 apc_activity = SCIC_SDS_APC_START_TIMER;
545 }
546 } else if (iport->active_phy_mask != 0) {
547
548
549
550
551 apc_activity = SCIC_SDS_APC_SKIP_PHY;
552 }
553 }
554 }
555
556
557
558
559
560
561
562
563 if (
564 (start_timer == false)
565 && (apc_activity == SCIC_SDS_APC_START_TIMER)
566 ) {
567 apc_activity = SCIC_SDS_APC_ADD_PHY;
568 }
569
570 switch (apc_activity) {
571 case SCIC_SDS_APC_ADD_PHY:
572 status = sci_port_add_phy(iport, iphy);
573
574 if (status == SCI_SUCCESS) {
575 port_agent->phy_configured_mask |= (1 << iphy->phy_index);
576 }
577 break;
578
579 case SCIC_SDS_APC_START_TIMER:
580 sci_apc_agent_start_timer(port_agent,
581 SCIC_SDS_APC_WAIT_LINK_UP_NOTIFICATION);
582 break;
583
584 case SCIC_SDS_APC_SKIP_PHY:
585 default:
586
587 break;
588 }
589 }
590
591
592
593
594
595
596
597
598
599
600
601
602
603 static void sci_apc_agent_link_up(struct isci_host *ihost,
604 struct sci_port_configuration_agent *port_agent,
605 struct isci_port *iport,
606 struct isci_phy *iphy)
607 {
608 u8 phy_index = iphy->phy_index;
609
610 if (!iport) {
611
612 port_agent->phy_ready_mask |= 1 << phy_index;
613 sci_apc_agent_start_timer(port_agent,
614 SCIC_SDS_APC_WAIT_LINK_UP_NOTIFICATION);
615 } else {
616
617 port_agent->phy_ready_mask |= 1 << phy_index;
618 sci_port_link_up(iport, iphy);
619 }
620 }
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635 static void sci_apc_agent_link_down(
636 struct isci_host *ihost,
637 struct sci_port_configuration_agent *port_agent,
638 struct isci_port *iport,
639 struct isci_phy *iphy)
640 {
641 port_agent->phy_ready_mask &= ~(1 << iphy->phy_index);
642
643 if (!iport)
644 return;
645 if (port_agent->phy_configured_mask & (1 << iphy->phy_index)) {
646 enum sci_status status;
647
648 status = sci_port_remove_phy(iport, iphy);
649
650 if (status == SCI_SUCCESS)
651 port_agent->phy_configured_mask &= ~(1 << iphy->phy_index);
652 }
653 }
654
655
656 static void apc_agent_timeout(struct timer_list *t)
657 {
658 u32 index;
659 struct sci_timer *tmr = from_timer(tmr, t, timer);
660 struct sci_port_configuration_agent *port_agent;
661 struct isci_host *ihost;
662 unsigned long flags;
663 u16 configure_phy_mask;
664
665 port_agent = container_of(tmr, typeof(*port_agent), timer);
666 ihost = container_of(port_agent, typeof(*ihost), port_agent);
667
668 spin_lock_irqsave(&ihost->scic_lock, flags);
669
670 if (tmr->cancel)
671 goto done;
672
673 port_agent->timer_pending = false;
674
675 configure_phy_mask = ~port_agent->phy_configured_mask & port_agent->phy_ready_mask;
676
677 if (!configure_phy_mask)
678 goto done;
679
680 for (index = 0; index < SCI_MAX_PHYS; index++) {
681 if ((configure_phy_mask & (1 << index)) == 0)
682 continue;
683
684 sci_apc_agent_configure_ports(ihost, port_agent,
685 &ihost->phys[index], false);
686 }
687
688 if (is_controller_start_complete(ihost))
689 sci_controller_transition_to_ready(ihost, SCI_SUCCESS);
690
691 done:
692 spin_unlock_irqrestore(&ihost->scic_lock, flags);
693 }
694
695
696
697
698
699
700
701
702
703
704
705
706
707 void sci_port_configuration_agent_construct(
708 struct sci_port_configuration_agent *port_agent)
709 {
710 u32 index;
711
712 port_agent->phy_configured_mask = 0x00;
713 port_agent->phy_ready_mask = 0x00;
714
715 port_agent->link_up_handler = NULL;
716 port_agent->link_down_handler = NULL;
717
718 port_agent->timer_pending = false;
719
720 for (index = 0; index < SCI_MAX_PORTS; index++) {
721 port_agent->phy_valid_port_range[index].min_index = 0;
722 port_agent->phy_valid_port_range[index].max_index = 0;
723 }
724 }
725
726 bool is_port_config_apc(struct isci_host *ihost)
727 {
728 return ihost->port_agent.link_up_handler == sci_apc_agent_link_up;
729 }
730
731 enum sci_status sci_port_configuration_agent_initialize(
732 struct isci_host *ihost,
733 struct sci_port_configuration_agent *port_agent)
734 {
735 enum sci_status status;
736 enum sci_port_configuration_mode mode;
737
738 mode = ihost->oem_parameters.controller.mode_type;
739
740 if (mode == SCIC_PORT_MANUAL_CONFIGURATION_MODE) {
741 status = sci_mpc_agent_validate_phy_configuration(
742 ihost, port_agent);
743
744 port_agent->link_up_handler = sci_mpc_agent_link_up;
745 port_agent->link_down_handler = sci_mpc_agent_link_down;
746
747 sci_init_timer(&port_agent->timer, mpc_agent_timeout);
748 } else {
749 status = sci_apc_agent_validate_phy_configuration(
750 ihost, port_agent);
751
752 port_agent->link_up_handler = sci_apc_agent_link_up;
753 port_agent->link_down_handler = sci_apc_agent_link_down;
754
755 sci_init_timer(&port_agent->timer, apc_agent_timeout);
756 }
757
758 return status;
759 }