]> git.kernelconcepts.de Git - karo-tx-linux.git/blob - drivers/scsi/isci/port.c
64559e8e568d5a4d35930719f5a9265112b8c614
[karo-tx-linux.git] / drivers / scsi / isci / port.c
1 /*
2  * This file is provided under a dual BSD/GPLv2 license.  When using or
3  * redistributing this file, you may do so under either license.
4  *
5  * GPL LICENSE SUMMARY
6  *
7  * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of version 2 of the GNU General Public License as
11  * published by the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful, but
14  * WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
21  * The full GNU General Public License is included in this distribution
22  * in the file called LICENSE.GPL.
23  *
24  * BSD LICENSE
25  *
26  * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
27  * All rights reserved.
28  *
29  * Redistribution and use in source and binary forms, with or without
30  * modification, are permitted provided that the following conditions
31  * are met:
32  *
33  *   * Redistributions of source code must retain the above copyright
34  *     notice, this list of conditions and the following disclaimer.
35  *   * Redistributions in binary form must reproduce the above copyright
36  *     notice, this list of conditions and the following disclaimer in
37  *     the documentation and/or other materials provided with the
38  *     distribution.
39  *   * Neither the name of Intel Corporation nor the names of its
40  *     contributors may be used to endorse or promote products derived
41  *     from this software without specific prior written permission.
42  *
43  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
44  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
45  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
46  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
47  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
48  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
49  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
50  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
51  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
52  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
53  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
54  */
55
56 #include "isci.h"
57 #include "port.h"
58 #include "request.h"
59 #include "timers.h"
60
61 #define SCIC_SDS_PORT_HARD_RESET_TIMEOUT  (1000)
62 #define SCU_DUMMY_INDEX    (0xFFFF)
63
64 static struct scic_sds_port_state_handler scic_sds_port_state_handler_table[];
65
66 static void isci_port_change_state(struct isci_port *iport, enum isci_status status)
67 {
68         unsigned long flags;
69
70         dev_dbg(&iport->isci_host->pdev->dev,
71                 "%s: iport = %p, state = 0x%x\n",
72                 __func__, iport, status);
73
74         /* XXX pointless lock */
75         spin_lock_irqsave(&iport->state_lock, flags);
76         iport->status = status;
77         spin_unlock_irqrestore(&iport->state_lock, flags);
78 }
79
80 /*
81  * This function will indicate which protocols are supported by this port.
82  * @sci_port: a handle corresponding to the SAS port for which to return the
83  *    supported protocols.
84  * @protocols: This parameter specifies a pointer to a data structure
85  *    which the core will copy the protocol values for the port from the
86  *    transmit_identification register.
87  */
88 static void
89 scic_sds_port_get_protocols(struct scic_sds_port *sci_port,
90                             struct scic_phy_proto *protocols)
91 {
92         u8 index;
93
94         protocols->all = 0;
95
96         for (index = 0; index < SCI_MAX_PHYS; index++) {
97                 if (sci_port->phy_table[index] != NULL) {
98                         scic_sds_phy_get_protocols(sci_port->phy_table[index],
99                                                    protocols);
100                 }
101         }
102 }
103
104 /**
105  * This method requests a list (mask) of the phys contained in the supplied SAS
106  *    port.
107  * @sci_port: a handle corresponding to the SAS port for which to return the
108  *    phy mask.
109  *
110  * Return a bit mask indicating which phys are a part of this port. Each bit
111  * corresponds to a phy identifier (e.g. bit 0 = phy id 0).
112  */
113 static u32 scic_sds_port_get_phys(struct scic_sds_port *sci_port)
114 {
115         u32 index;
116         u32 mask;
117
118         mask = 0;
119
120         for (index = 0; index < SCI_MAX_PHYS; index++) {
121                 if (sci_port->phy_table[index] != NULL) {
122                         mask |= (1 << index);
123                 }
124         }
125
126         return mask;
127 }
128
129 /**
130  * scic_port_get_properties() - This method simply returns the properties
131  *    regarding the port, such as: physical index, protocols, sas address, etc.
132  * @port: this parameter specifies the port for which to retrieve the physical
133  *    index.
134  * @properties: This parameter specifies the properties structure into which to
135  *    copy the requested information.
136  *
137  * Indicate if the user specified a valid port. SCI_SUCCESS This value is
138  * returned if the specified port was valid. SCI_FAILURE_INVALID_PORT This
139  * value is returned if the specified port is not valid.  When this value is
140  * returned, no data is copied to the properties output parameter.
141  */
142 static enum sci_status scic_port_get_properties(struct scic_sds_port *port,
143                                                 struct scic_port_properties *prop)
144 {
145         if ((port == NULL) ||
146             (port->logical_port_index == SCIC_SDS_DUMMY_PORT))
147                 return SCI_FAILURE_INVALID_PORT;
148
149         prop->index    = port->logical_port_index;
150         prop->phy_mask = scic_sds_port_get_phys(port);
151         scic_sds_port_get_sas_address(port, &prop->local.sas_address);
152         scic_sds_port_get_protocols(port, &prop->local.protocols);
153         scic_sds_port_get_attached_sas_address(port, &prop->remote.sas_address);
154
155         return SCI_SUCCESS;
156 }
157
158 static void isci_port_link_up(struct isci_host *isci_host,
159                               struct scic_sds_port *port,
160                               struct scic_sds_phy *phy)
161 {
162         unsigned long flags;
163         struct scic_port_properties properties;
164         struct isci_phy *isci_phy = sci_phy_to_iphy(phy);
165         struct isci_port *isci_port = sci_port_to_iport(port);
166         unsigned long success = true;
167
168         BUG_ON(isci_phy->isci_port != NULL);
169
170         isci_phy->isci_port = isci_port;
171
172         dev_dbg(&isci_host->pdev->dev,
173                 "%s: isci_port = %p\n",
174                 __func__, isci_port);
175
176         spin_lock_irqsave(&isci_phy->sas_phy.frame_rcvd_lock, flags);
177
178         isci_port_change_state(isci_phy->isci_port, isci_starting);
179
180         scic_port_get_properties(port, &properties);
181
182         if (phy->protocol == SCIC_SDS_PHY_PROTOCOL_SATA) {
183                 u64 attached_sas_address;
184
185                 isci_phy->sas_phy.oob_mode = SATA_OOB_MODE;
186                 isci_phy->sas_phy.frame_rcvd_size = sizeof(struct dev_to_host_fis);
187
188                 /*
189                  * For direct-attached SATA devices, the SCI core will
190                  * automagically assign a SAS address to the end device
191                  * for the purpose of creating a port. This SAS address
192                  * will not be the same as assigned to the PHY and needs
193                  * to be obtained from struct scic_port_properties properties.
194                  */
195                 attached_sas_address = properties.remote.sas_address.high;
196                 attached_sas_address <<= 32;
197                 attached_sas_address |= properties.remote.sas_address.low;
198                 swab64s(&attached_sas_address);
199
200                 memcpy(&isci_phy->sas_phy.attached_sas_addr,
201                        &attached_sas_address, sizeof(attached_sas_address));
202         } else if (phy->protocol == SCIC_SDS_PHY_PROTOCOL_SAS) {
203                 isci_phy->sas_phy.oob_mode = SAS_OOB_MODE;
204                 isci_phy->sas_phy.frame_rcvd_size = sizeof(struct sas_identify_frame);
205
206                 /* Copy the attached SAS address from the IAF */
207                 memcpy(isci_phy->sas_phy.attached_sas_addr,
208                        isci_phy->frame_rcvd.iaf.sas_addr, SAS_ADDR_SIZE);
209         } else {
210                 dev_err(&isci_host->pdev->dev, "%s: unkown target\n", __func__);
211                 success = false;
212         }
213
214         isci_phy->sas_phy.phy->negotiated_linkrate = sci_phy_linkrate(phy);
215
216         spin_unlock_irqrestore(&isci_phy->sas_phy.frame_rcvd_lock, flags);
217
218         /* Notify libsas that we have an address frame, if indeed
219          * we've found an SSP, SMP, or STP target */
220         if (success)
221                 isci_host->sas_ha.notify_port_event(&isci_phy->sas_phy,
222                                                     PORTE_BYTES_DMAED);
223 }
224
225
226 /**
227  * isci_port_link_down() - This function is called by the sci core when a link
228  *    becomes inactive.
229  * @isci_host: This parameter specifies the isci host object.
230  * @phy: This parameter specifies the isci phy with the active link.
231  * @port: This parameter specifies the isci port with the active link.
232  *
233  */
234 static void isci_port_link_down(struct isci_host *isci_host,
235                                 struct isci_phy *isci_phy,
236                                 struct isci_port *isci_port)
237 {
238         struct isci_remote_device *isci_device;
239
240         dev_dbg(&isci_host->pdev->dev,
241                 "%s: isci_port = %p\n", __func__, isci_port);
242
243         if (isci_port) {
244
245                 /* check to see if this is the last phy on this port. */
246                 if (isci_phy->sas_phy.port
247                     && isci_phy->sas_phy.port->num_phys == 1) {
248
249                         /* change the state for all devices on this port.
250                          * The next task sent to this device will be returned
251                          * as SAS_TASK_UNDELIVERED, and the scsi mid layer
252                          * will remove the target
253                          */
254                         list_for_each_entry(isci_device,
255                                             &isci_port->remote_dev_list,
256                                             node) {
257                                 dev_dbg(&isci_host->pdev->dev,
258                                         "%s: isci_device = %p\n",
259                                         __func__, isci_device);
260                                 isci_remote_device_change_state(isci_device,
261                                                                 isci_stopping);
262                         }
263                 }
264                 isci_port_change_state(isci_port, isci_stopping);
265         }
266
267         /* Notify libsas of the borken link, this will trigger calls to our
268          * isci_port_deformed and isci_dev_gone functions.
269          */
270         sas_phy_disconnected(&isci_phy->sas_phy);
271         isci_host->sas_ha.notify_phy_event(&isci_phy->sas_phy,
272                                            PHYE_LOSS_OF_SIGNAL);
273
274         isci_phy->isci_port = NULL;
275
276         dev_dbg(&isci_host->pdev->dev,
277                 "%s: isci_port = %p - Done\n", __func__, isci_port);
278 }
279
280
281 /**
282  * isci_port_ready() - This function is called by the sci core when a link
283  *    becomes ready.
284  * @isci_host: This parameter specifies the isci host object.
285  * @port: This parameter specifies the sci port with the active link.
286  *
287  */
288 static void isci_port_ready(struct isci_host *isci_host, struct isci_port *isci_port)
289 {
290         dev_dbg(&isci_host->pdev->dev,
291                 "%s: isci_port = %p\n", __func__, isci_port);
292
293         complete_all(&isci_port->start_complete);
294         isci_port_change_state(isci_port, isci_ready);
295         return;
296 }
297
298 /**
299  * isci_port_not_ready() - This function is called by the sci core when a link
300  *    is not ready. All remote devices on this link will be removed if they are
301  *    in the stopping state.
302  * @isci_host: This parameter specifies the isci host object.
303  * @port: This parameter specifies the sci port with the active link.
304  *
305  */
306 static void isci_port_not_ready(struct isci_host *isci_host, struct isci_port *isci_port)
307 {
308         dev_dbg(&isci_host->pdev->dev,
309                 "%s: isci_port = %p\n", __func__, isci_port);
310 }
311
312 static void isci_port_stop_complete(struct scic_sds_controller *scic,
313                                     struct scic_sds_port *sci_port,
314                                     enum sci_status completion_status)
315 {
316         dev_dbg(&scic_to_ihost(scic)->pdev->dev, "Port stop complete\n");
317 }
318
319 /**
320  * isci_port_hard_reset_complete() - This function is called by the sci core
321  *    when the hard reset complete notification has been received.
322  * @port: This parameter specifies the sci port with the active link.
323  * @completion_status: This parameter specifies the core status for the reset
324  *    process.
325  *
326  */
327 static void isci_port_hard_reset_complete(struct isci_port *isci_port,
328                                           enum sci_status completion_status)
329 {
330         dev_dbg(&isci_port->isci_host->pdev->dev,
331                 "%s: isci_port = %p, completion_status=%x\n",
332                      __func__, isci_port, completion_status);
333
334         /* Save the status of the hard reset from the port. */
335         isci_port->hard_reset_status = completion_status;
336
337         complete_all(&isci_port->hard_reset_complete);
338 }
339
340 /* This method will return a true value if the specified phy can be assigned to
341  * this port The following is a list of phys for each port that are allowed: -
342  * Port 0 - 3 2 1 0 - Port 1 -     1 - Port 2 - 3 2 - Port 3 - 3 This method
343  * doesn't preclude all configurations.  It merely ensures that a phy is part
344  * of the allowable set of phy identifiers for that port.  For example, one
345  * could assign phy 3 to port 0 and no other phys.  Please refer to
346  * scic_sds_port_is_phy_mask_valid() for information regarding whether the
347  * phy_mask for a port can be supported. bool true if this is a valid phy
348  * assignment for the port false if this is not a valid phy assignment for the
349  * port
350  */
351 bool scic_sds_port_is_valid_phy_assignment(struct scic_sds_port *sci_port,
352                                            u32 phy_index)
353 {
354         /* Initialize to invalid value. */
355         u32 existing_phy_index = SCI_MAX_PHYS;
356         u32 index;
357
358         if ((sci_port->physical_port_index == 1) && (phy_index != 1)) {
359                 return false;
360         }
361
362         if (sci_port->physical_port_index == 3 && phy_index != 3) {
363                 return false;
364         }
365
366         if (
367                 (sci_port->physical_port_index == 2)
368                 && ((phy_index == 0) || (phy_index == 1))
369                 ) {
370                 return false;
371         }
372
373         for (index = 0; index < SCI_MAX_PHYS; index++) {
374                 if ((sci_port->phy_table[index] != NULL)
375                     && (index != phy_index)) {
376                         existing_phy_index = index;
377                 }
378         }
379
380         /*
381          * Ensure that all of the phys in the port are capable of
382          * operating at the same maximum link rate. */
383         if (
384                 (existing_phy_index < SCI_MAX_PHYS)
385                 && (sci_port->owning_controller->user_parameters.sds1.phys[
386                             phy_index].max_speed_generation !=
387                     sci_port->owning_controller->user_parameters.sds1.phys[
388                             existing_phy_index].max_speed_generation)
389                 )
390                 return false;
391
392         return true;
393 }
394
395 /**
396  *
397  * @sci_port: This is the port object for which to determine if the phy mask
398  *    can be supported.
399  *
400  * This method will return a true value if the port's phy mask can be supported
401  * by the SCU. The following is a list of valid PHY mask configurations for
402  * each port: - Port 0 - [[3  2] 1] 0 - Port 1 -        [1] - Port 2 - [[3] 2]
403  * - Port 3 -  [3] This method returns a boolean indication specifying if the
404  * phy mask can be supported. true if this is a valid phy assignment for the
405  * port false if this is not a valid phy assignment for the port
406  */
407 static bool scic_sds_port_is_phy_mask_valid(
408         struct scic_sds_port *sci_port,
409         u32 phy_mask)
410 {
411         if (sci_port->physical_port_index == 0) {
412                 if (((phy_mask & 0x0F) == 0x0F)
413                     || ((phy_mask & 0x03) == 0x03)
414                     || ((phy_mask & 0x01) == 0x01)
415                     || (phy_mask == 0))
416                         return true;
417         } else if (sci_port->physical_port_index == 1) {
418                 if (((phy_mask & 0x02) == 0x02)
419                     || (phy_mask == 0))
420                         return true;
421         } else if (sci_port->physical_port_index == 2) {
422                 if (((phy_mask & 0x0C) == 0x0C)
423                     || ((phy_mask & 0x04) == 0x04)
424                     || (phy_mask == 0))
425                         return true;
426         } else if (sci_port->physical_port_index == 3) {
427                 if (((phy_mask & 0x08) == 0x08)
428                     || (phy_mask == 0))
429                         return true;
430         }
431
432         return false;
433 }
434
435 /**
436  *
437  * @sci_port: This parameter specifies the port from which to return a
438  *    connected phy.
439  *
440  * This method retrieves a currently active (i.e. connected) phy contained in
441  * the port.  Currently, the lowest order phy that is connected is returned.
442  * This method returns a pointer to a SCIS_SDS_PHY object. NULL This value is
443  * returned if there are no currently active (i.e. connected to a remote end
444  * point) phys contained in the port. All other values specify a struct scic_sds_phy
445  * object that is active in the port.
446  */
447 static struct scic_sds_phy *scic_sds_port_get_a_connected_phy(
448         struct scic_sds_port *sci_port
449         ) {
450         u32 index;
451         struct scic_sds_phy *phy;
452
453         for (index = 0; index < SCI_MAX_PHYS; index++) {
454                 /*
455                  * Ensure that the phy is both part of the port and currently
456                  * connected to the remote end-point. */
457                 phy = sci_port->phy_table[index];
458                 if (
459                         (phy != NULL)
460                         && scic_sds_port_active_phy(sci_port, phy)
461                         ) {
462                         return phy;
463                 }
464         }
465
466         return NULL;
467 }
468
469 /**
470  * scic_sds_port_set_phy() -
471  * @out]: port The port object to which the phy assignement is being made.
472  * @out]: phy The phy which is being assigned to the port.
473  *
474  * This method attempts to make the assignment of the phy to the port. If
475  * successful the phy is assigned to the ports phy table. bool true if the phy
476  * assignment can be made. false if the phy assignement can not be made. This
477  * is a functional test that only fails if the phy is currently assigned to a
478  * different port.
479  */
480 static enum sci_status scic_sds_port_set_phy(
481         struct scic_sds_port *port,
482         struct scic_sds_phy *phy)
483 {
484         /*
485          * Check to see if we can add this phy to a port
486          * that means that the phy is not part of a port and that the port does
487          * not already have a phy assinged to the phy index. */
488         if (
489                 (port->phy_table[phy->phy_index] == NULL)
490                 && (phy_get_non_dummy_port(phy) == NULL)
491                 && scic_sds_port_is_valid_phy_assignment(port, phy->phy_index)
492                 ) {
493                 /*
494                  * Phy is being added in the stopped state so we are in MPC mode
495                  * make logical port index = physical port index */
496                 port->logical_port_index = port->physical_port_index;
497                 port->phy_table[phy->phy_index] = phy;
498                 scic_sds_phy_set_port(phy, port);
499
500                 return SCI_SUCCESS;
501         }
502
503         return SCI_FAILURE;
504 }
505
506 /**
507  * scic_sds_port_clear_phy() -
508  * @out]: port The port from which the phy is being cleared.
509  * @out]: phy The phy being cleared from the port.
510  *
511  * This method will clear the phy assigned to this port.  This method fails if
512  * this phy is not currently assinged to this port. bool true if the phy is
513  * removed from the port. false if this phy is not assined to this port.
514  */
515 static enum sci_status scic_sds_port_clear_phy(
516         struct scic_sds_port *port,
517         struct scic_sds_phy *phy)
518 {
519         /* Make sure that this phy is part of this port */
520         if (port->phy_table[phy->phy_index] == phy &&
521             phy_get_non_dummy_port(phy) == port) {
522                 struct scic_sds_controller *scic = port->owning_controller;
523                 struct isci_host *ihost = scic_to_ihost(scic);
524
525                 /* Yep it is assigned to this port so remove it */
526                 scic_sds_phy_set_port(phy, &ihost->ports[SCI_MAX_PORTS].sci);
527                 port->phy_table[phy->phy_index] = NULL;
528                 return SCI_SUCCESS;
529         }
530
531         return SCI_FAILURE;
532 }
533
534 /**
535  * scic_sds_port_add_phy() -
536  * @sci_port: This parameter specifies the port in which the phy will be added.
537  * @sci_phy: This parameter is the phy which is to be added to the port.
538  *
539  * This method will add a PHY to the selected port. This method returns an
540  * enum sci_status. SCI_SUCCESS the phy has been added to the port. Any other status
541  * is failre to add the phy to the port.
542  */
543 enum sci_status scic_sds_port_add_phy(
544         struct scic_sds_port *sci_port,
545         struct scic_sds_phy *sci_phy)
546 {
547         return sci_port->state_handlers->add_phy_handler(
548                        sci_port, sci_phy);
549 }
550
551
552 /**
553  * scic_sds_port_remove_phy() -
554  * @sci_port: This parameter specifies the port in which the phy will be added.
555  * @sci_phy: This parameter is the phy which is to be added to the port.
556  *
557  * This method will remove the PHY from the selected PORT. This method returns
558  * an enum sci_status. SCI_SUCCESS the phy has been removed from the port. Any other
559  * status is failre to add the phy to the port.
560  */
561 enum sci_status scic_sds_port_remove_phy(
562         struct scic_sds_port *sci_port,
563         struct scic_sds_phy *sci_phy)
564 {
565         return sci_port->state_handlers->remove_phy_handler(
566                        sci_port, sci_phy);
567 }
568
569 /**
570  * This method requests the SAS address for the supplied SAS port from the SCI
571  *    implementation.
572  * @sci_port: a handle corresponding to the SAS port for which to return the
573  *    SAS address.
574  * @sas_address: This parameter specifies a pointer to a SAS address structure
575  *    into which the core will copy the SAS address for the port.
576  *
577  */
578 void scic_sds_port_get_sas_address(
579         struct scic_sds_port *sci_port,
580         struct sci_sas_address *sas_address)
581 {
582         u32 index;
583
584         sas_address->high = 0;
585         sas_address->low  = 0;
586
587         for (index = 0; index < SCI_MAX_PHYS; index++) {
588                 if (sci_port->phy_table[index] != NULL) {
589                         scic_sds_phy_get_sas_address(sci_port->phy_table[index], sas_address);
590                 }
591         }
592 }
593
594 /*
595  * This function requests the SAS address for the device directly attached to
596  *    this SAS port.
597  * @sci_port: a handle corresponding to the SAS port for which to return the
598  *    SAS address.
599  * @sas_address: This parameter specifies a pointer to a SAS address structure
600  *    into which the core will copy the SAS address for the device directly
601  *    attached to the port.
602  *
603  */
604 void scic_sds_port_get_attached_sas_address(
605         struct scic_sds_port *sci_port,
606         struct sci_sas_address *sas_address)
607 {
608         struct scic_sds_phy *sci_phy;
609
610         /*
611          * Ensure that the phy is both part of the port and currently
612          * connected to the remote end-point.
613          */
614         sci_phy = scic_sds_port_get_a_connected_phy(sci_port);
615         if (sci_phy) {
616                 if (sci_phy->protocol != SCIC_SDS_PHY_PROTOCOL_SATA) {
617                         scic_sds_phy_get_attached_sas_address(sci_phy,
618                                                               sas_address);
619                 } else {
620                         scic_sds_phy_get_sas_address(sci_phy, sas_address);
621                         sas_address->low += sci_phy->phy_index;
622                 }
623         } else {
624                 sas_address->high = 0;
625                 sas_address->low  = 0;
626         }
627 }
628
629 /**
630  * scic_sds_port_construct_dummy_rnc() - create dummy rnc for si workaround
631  *
632  * @sci_port: logical port on which we need to create the remote node context
633  * @rni: remote node index for this remote node context.
634  *
635  * This routine will construct a dummy remote node context data structure
636  * This structure will be posted to the hardware to work around a scheduler
637  * error in the hardware.
638  */
639 static void scic_sds_port_construct_dummy_rnc(struct scic_sds_port *sci_port, u16 rni)
640 {
641         union scu_remote_node_context *rnc;
642
643         rnc = &sci_port->owning_controller->remote_node_context_table[rni];
644
645         memset(rnc, 0, sizeof(union scu_remote_node_context));
646
647         rnc->ssp.remote_sas_address_hi = 0;
648         rnc->ssp.remote_sas_address_lo = 0;
649
650         rnc->ssp.remote_node_index = rni;
651         rnc->ssp.remote_node_port_width = 1;
652         rnc->ssp.logical_port_index = sci_port->physical_port_index;
653
654         rnc->ssp.nexus_loss_timer_enable = false;
655         rnc->ssp.check_bit = false;
656         rnc->ssp.is_valid = true;
657         rnc->ssp.is_remote_node_context = true;
658         rnc->ssp.function_number = 0;
659         rnc->ssp.arbitration_wait_time = 0;
660 }
661
662 /**
663  * scic_sds_port_construct_dummy_task() - create dummy task for si workaround
664  * @sci_port The logical port on which we need to create the
665  *            remote node context.
666  *            context.
667  * @tci The remote node index for this remote node context.
668  *
669  * This routine will construct a dummy task context data structure.  This
670  * structure will be posted to the hardwre to work around a scheduler error
671  * in the hardware.
672  *
673  */
674 static void scic_sds_port_construct_dummy_task(struct scic_sds_port *sci_port, u16 tci)
675 {
676         struct scu_task_context *task_context;
677
678         task_context = scic_sds_controller_get_task_context_buffer(sci_port->owning_controller, tci);
679
680         memset(task_context, 0, sizeof(struct scu_task_context));
681
682         task_context->abort = 0;
683         task_context->priority = 0;
684         task_context->initiator_request = 1;
685         task_context->connection_rate = 1;
686         task_context->protocol_engine_index = 0;
687         task_context->logical_port_index = sci_port->physical_port_index;
688         task_context->protocol_type = SCU_TASK_CONTEXT_PROTOCOL_SSP;
689         task_context->task_index = scic_sds_io_tag_get_index(tci);
690         task_context->valid = SCU_TASK_CONTEXT_VALID;
691         task_context->context_type = SCU_TASK_CONTEXT_TYPE;
692
693         task_context->remote_node_index = sci_port->reserved_rni;
694         task_context->command_code = 0;
695
696         task_context->link_layer_control = 0;
697         task_context->do_not_dma_ssp_good_response = 1;
698         task_context->strict_ordering = 0;
699         task_context->control_frame = 0;
700         task_context->timeout_enable = 0;
701         task_context->block_guard_enable = 0;
702
703         task_context->address_modifier = 0;
704
705         task_context->task_phase = 0x01;
706 }
707
708 static void scic_sds_port_destroy_dummy_resources(struct scic_sds_port *sci_port)
709 {
710         struct scic_sds_controller *scic = sci_port->owning_controller;
711
712         if (sci_port->reserved_tci != SCU_DUMMY_INDEX)
713                 scic_controller_free_io_tag(scic, sci_port->reserved_tci);
714
715         if (sci_port->reserved_rni != SCU_DUMMY_INDEX)
716                 scic_sds_remote_node_table_release_remote_node_index(&scic->available_remote_nodes,
717                                                                      1, sci_port->reserved_rni);
718
719         sci_port->reserved_rni = SCU_DUMMY_INDEX;
720         sci_port->reserved_tci = SCU_DUMMY_INDEX;
721 }
722
723 /**
724  * This method performs initialization of the supplied port. Initialization
725  *    includes: - state machine initialization - member variable initialization
726  *    - configuring the phy_mask
727  * @sci_port:
728  * @transport_layer_registers:
729  * @port_task_scheduler_registers:
730  * @port_configuration_regsiter:
731  *
732  * enum sci_status SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION This value is returned
733  * if the phy being added to the port
734  */
735 enum sci_status scic_sds_port_initialize(
736         struct scic_sds_port *sci_port,
737         void __iomem *port_task_scheduler_registers,
738         void __iomem *port_configuration_regsiter,
739         void __iomem *viit_registers)
740 {
741         sci_port->port_task_scheduler_registers  = port_task_scheduler_registers;
742         sci_port->port_pe_configuration_register = port_configuration_regsiter;
743         sci_port->viit_registers                 = viit_registers;
744
745         return SCI_SUCCESS;
746 }
747
748 /**
749  * scic_port_hard_reset() - perform port hard reset
750  * @port: a handle corresponding to the SAS port to be hard reset.
751  * @reset_timeout: This parameter specifies the number of milliseconds in which
752  *    the port reset operation should complete.
753  *
754  * The SCI User callback in scic_user_callbacks_t will only be called once for
755  * each phy in the SAS Port at completion of the hard reset sequence. Return a
756  * status indicating whether the hard reset started successfully. SCI_SUCCESS
757  * This value is returned if the hard reset operation started successfully.
758  */
759 static enum sci_status scic_port_hard_reset(struct scic_sds_port *port,
760                                             u32 reset_timeout)
761 {
762         return port->state_handlers->reset_handler(
763                        port, reset_timeout);
764 }
765
766 /**
767  * This method assigns the direct attached device ID for this port.
768  *
769  * @param[in] sci_port The port for which the direct attached device id is to
770  *       be assigned.
771  * @param[in] device_id The direct attached device ID to assign to the port.
772  *       This will be the RNi for the device
773  */
774 void scic_sds_port_setup_transports(
775         struct scic_sds_port *sci_port,
776         u32 device_id)
777 {
778         u8 index;
779
780         for (index = 0; index < SCI_MAX_PHYS; index++) {
781                 if (sci_port->active_phy_mask & (1 << index))
782                         scic_sds_phy_setup_transport(sci_port->phy_table[index], device_id);
783         }
784 }
785
786 /**
787  *
788  * @sci_port: This is the port on which the phy should be enabled.
789  * @sci_phy: This is the specific phy which to enable.
790  * @do_notify_user: This parameter specifies whether to inform the user (via
791  *    scic_cb_port_link_up()) as to the fact that a new phy as become ready.
792  *
793  * This function will activate the phy in the port.
794  * Activation includes: - adding
795  * the phy to the port - enabling the Protocol Engine in the silicon. -
796  * notifying the user that the link is up. none
797  */
798 static void scic_sds_port_activate_phy(struct scic_sds_port *sci_port,
799                                        struct scic_sds_phy *sci_phy,
800                                        bool do_notify_user)
801 {
802         struct scic_sds_controller *scic = sci_port->owning_controller;
803         struct isci_host *ihost = scic_to_ihost(scic);
804
805         if (sci_phy->protocol != SCIC_SDS_PHY_PROTOCOL_SATA)
806                 scic_sds_phy_resume(sci_phy);
807
808         sci_port->active_phy_mask |= 1 << sci_phy->phy_index;
809
810         scic_sds_controller_clear_invalid_phy(scic, sci_phy);
811
812         if (do_notify_user == true)
813                 isci_port_link_up(ihost, sci_port, sci_phy);
814 }
815
816 void scic_sds_port_deactivate_phy(struct scic_sds_port *sci_port,
817                                   struct scic_sds_phy *sci_phy,
818                                   bool do_notify_user)
819 {
820         struct scic_sds_controller *scic = scic_sds_port_get_controller(sci_port);
821         struct isci_port *iport = sci_port_to_iport(sci_port);
822         struct isci_host *ihost = scic_to_ihost(scic);
823         struct isci_phy *iphy = sci_phy_to_iphy(sci_phy);
824
825         sci_port->active_phy_mask &= ~(1 << sci_phy->phy_index);
826
827         sci_phy->max_negotiated_speed = SAS_LINK_RATE_UNKNOWN;
828
829         /* Re-assign the phy back to the LP as if it were a narrow port */
830         writel(sci_phy->phy_index,
831                 &sci_port->port_pe_configuration_register[sci_phy->phy_index]);
832
833         if (do_notify_user == true)
834                 isci_port_link_down(ihost, iphy, iport);
835 }
836
837 /**
838  *
839  * @sci_port: This is the port on which the phy should be disabled.
840  * @sci_phy: This is the specific phy which to disabled.
841  *
842  * This function will disable the phy and report that the phy is not valid for
843  * this port object. None
844  */
845 static void scic_sds_port_invalid_link_up(struct scic_sds_port *sci_port,
846                                           struct scic_sds_phy *sci_phy)
847 {
848         struct scic_sds_controller *scic = sci_port->owning_controller;
849
850         /*
851          * Check to see if we have alreay reported this link as bad and if
852          * not go ahead and tell the SCI_USER that we have discovered an
853          * invalid link.
854          */
855         if ((scic->invalid_phy_mask & (1 << sci_phy->phy_index)) == 0) {
856                 scic_sds_controller_set_invalid_phy(scic, sci_phy);
857                 dev_warn(&scic_to_ihost(scic)->pdev->dev, "Invalid link up!\n");
858         }
859 }
860
861 static bool is_port_ready_state(enum scic_sds_port_states state)
862 {
863         switch (state) {
864         case SCI_BASE_PORT_STATE_READY:
865         case SCIC_SDS_PORT_READY_SUBSTATE_WAITING:
866         case SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL:
867         case SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING:
868                 return true;
869         default:
870                 return false;
871         }
872 }
873
874 /* flag dummy rnc hanling when exiting a ready state */
875 static void port_state_machine_change(struct scic_sds_port *sci_port,
876                                       enum scic_sds_port_states state)
877 {
878         struct sci_base_state_machine *sm = &sci_port->state_machine;
879         enum scic_sds_port_states old_state = sm->current_state_id;
880
881         if (is_port_ready_state(old_state) && !is_port_ready_state(state))
882                 sci_port->ready_exit = true;
883
884         sci_base_state_machine_change_state(sm, state);
885         sci_port->ready_exit = false;
886 }
887
888 static void port_state_machine_stop(struct scic_sds_port *sci_port)
889 {
890         sci_port->ready_exit = true;
891         sci_base_state_machine_stop(&sci_port->state_machine);
892         sci_port->ready_exit = false;
893 }
894
895 /**
896  * scic_sds_port_general_link_up_handler - phy can be assigned to port?
897  * @sci_port: scic_sds_port object for which has a phy that has gone link up.
898  * @sci_phy: This is the struct scic_sds_phy object that has gone link up.
899  * @do_notify_user: This parameter specifies whether to inform the user (via
900  *    scic_cb_port_link_up()) as to the fact that a new phy as become ready.
901  *
902  * Determine if this phy can be assigned to this
903  * port . If the phy is not a valid PHY for
904  * this port then the function will notify the user. A PHY can only be
905  * part of a port if it's attached SAS ADDRESS is the same as all other PHYs in
906  * the same port. none
907  */
908 static void scic_sds_port_general_link_up_handler(struct scic_sds_port *sci_port,
909                                                   struct scic_sds_phy *sci_phy,
910                                                   bool do_notify_user)
911 {
912         struct sci_sas_address port_sas_address;
913         struct sci_sas_address phy_sas_address;
914
915         scic_sds_port_get_attached_sas_address(sci_port, &port_sas_address);
916         scic_sds_phy_get_attached_sas_address(sci_phy, &phy_sas_address);
917
918         /* If the SAS address of the new phy matches the SAS address of
919          * other phys in the port OR this is the first phy in the port,
920          * then activate the phy and allow it to be used for operations
921          * in this port.
922          */
923         if ((phy_sas_address.high == port_sas_address.high &&
924              phy_sas_address.low  == port_sas_address.low) ||
925             sci_port->active_phy_mask == 0) {
926                 struct sci_base_state_machine *sm = &sci_port->state_machine;
927
928                 scic_sds_port_activate_phy(sci_port, sci_phy, do_notify_user);
929                 if (sm->current_state_id == SCI_BASE_PORT_STATE_RESETTING)
930                         port_state_machine_change(sci_port, SCI_BASE_PORT_STATE_READY);
931         } else
932                 scic_sds_port_invalid_link_up(sci_port, sci_phy);
933 }
934
935
936
937 /**
938  * This method returns false if the port only has a single phy object assigned.
939  *     If there are no phys or more than one phy then the method will return
940  *    true.
941  * @sci_port: The port for which the wide port condition is to be checked.
942  *
943  * bool true Is returned if this is a wide ported port. false Is returned if
944  * this is a narrow port.
945  */
946 static bool scic_sds_port_is_wide(struct scic_sds_port *sci_port)
947 {
948         u32 index;
949         u32 phy_count = 0;
950
951         for (index = 0; index < SCI_MAX_PHYS; index++) {
952                 if (sci_port->phy_table[index] != NULL) {
953                         phy_count++;
954                 }
955         }
956
957         return phy_count != 1;
958 }
959
960 /**
961  * This method is called by the PHY object when the link is detected. if the
962  *    port wants the PHY to continue on to the link up state then the port
963  *    layer must return true.  If the port object returns false the phy object
964  *    must halt its attempt to go link up.
965  * @sci_port: The port associated with the phy object.
966  * @sci_phy: The phy object that is trying to go link up.
967  *
968  * true if the phy object can continue to the link up condition. true Is
969  * returned if this phy can continue to the ready state. false Is returned if
970  * can not continue on to the ready state. This notification is in place for
971  * wide ports and direct attached phys.  Since there are no wide ported SATA
972  * devices this could become an invalid port configuration.
973  */
974 bool scic_sds_port_link_detected(
975         struct scic_sds_port *sci_port,
976         struct scic_sds_phy *sci_phy)
977 {
978         if ((sci_port->logical_port_index != SCIC_SDS_DUMMY_PORT) &&
979             (sci_phy->protocol == SCIC_SDS_PHY_PROTOCOL_SATA) &&
980             scic_sds_port_is_wide(sci_port)) {
981                 scic_sds_port_invalid_link_up(sci_port, sci_phy);
982
983                 return false;
984         }
985
986         return true;
987 }
988
989 /**
990  * This method is the entry point for the phy to inform the port that it is now
991  *    in a ready state
992  * @sci_port:
993  *
994  *
995  */
996 void scic_sds_port_link_up(
997         struct scic_sds_port *sci_port,
998         struct scic_sds_phy *sci_phy)
999 {
1000         sci_phy->is_in_link_training = false;
1001
1002         sci_port->state_handlers->link_up_handler(sci_port, sci_phy);
1003 }
1004
1005 /**
1006  * This method is the entry point for the phy to inform the port that it is no
1007  *    longer in a ready state
1008  * @sci_port:
1009  *
1010  *
1011  */
1012 void scic_sds_port_link_down(
1013         struct scic_sds_port *sci_port,
1014         struct scic_sds_phy *sci_phy)
1015 {
1016         sci_port->state_handlers->link_down_handler(sci_port, sci_phy);
1017 }
1018
1019 /**
1020  * This method is called to start an IO request on this port.
1021  * @sci_port:
1022  * @sci_dev:
1023  * @sci_req:
1024  *
1025  * enum sci_status
1026  */
1027 enum sci_status scic_sds_port_start_io(
1028         struct scic_sds_port *sci_port,
1029         struct scic_sds_remote_device *sci_dev,
1030         struct scic_sds_request *sci_req)
1031 {
1032         return sci_port->state_handlers->start_io_handler(
1033                        sci_port, sci_dev, sci_req);
1034 }
1035
1036 /**
1037  * This method is called to complete an IO request to the port.
1038  * @sci_port:
1039  * @sci_dev:
1040  * @sci_req:
1041  *
1042  * enum sci_status
1043  */
1044 enum sci_status scic_sds_port_complete_io(
1045         struct scic_sds_port *sci_port,
1046         struct scic_sds_remote_device *sci_dev,
1047         struct scic_sds_request *sci_req)
1048 {
1049         return sci_port->state_handlers->complete_io_handler(
1050                        sci_port, sci_dev, sci_req);
1051 }
1052
1053 /**
1054  * This method is provided to timeout requests for port operations. Mostly its
1055  *    for the port reset operation.
1056  *
1057  *
1058  */
1059 static void scic_sds_port_timeout_handler(void *port)
1060 {
1061         struct scic_sds_port *sci_port = port;
1062         u32 current_state;
1063
1064         current_state = sci_base_state_machine_get_state(&sci_port->state_machine);
1065
1066         if (current_state == SCI_BASE_PORT_STATE_RESETTING) {
1067                 /* if the port is still in the resetting state then the timeout
1068                  * fired before the reset completed.
1069                  */
1070                 port_state_machine_change(sci_port, SCI_BASE_PORT_STATE_FAILED);
1071         } else if (current_state == SCI_BASE_PORT_STATE_STOPPED) {
1072                 /* if the port is stopped then the start request failed In this
1073                  * case stay in the stopped state.
1074                  */
1075                 dev_err(sciport_to_dev(sci_port),
1076                         "%s: SCIC Port 0x%p failed to stop before tiemout.\n",
1077                         __func__,
1078                         sci_port);
1079         } else if (current_state == SCI_BASE_PORT_STATE_STOPPING) {
1080                 /* if the port is still stopping then the stop has not completed */
1081                 isci_port_stop_complete(sci_port->owning_controller,
1082                                         sci_port,
1083                                         SCI_FAILURE_TIMEOUT);
1084         } else {
1085                 /* The port is in the ready state and we have a timer
1086                  * reporting a timeout this should not happen.
1087                  */
1088                 dev_err(sciport_to_dev(sci_port),
1089                         "%s: SCIC Port 0x%p is processing a timeout operation "
1090                         "in state %d.\n", __func__, sci_port, current_state);
1091         }
1092 }
1093
1094 /* --------------------------------------------------------------------------- */
1095
1096 /**
1097  * This function updates the hardwares VIIT entry for this port.
1098  *
1099  *
1100  */
1101 static void scic_sds_port_update_viit_entry(struct scic_sds_port *sci_port)
1102 {
1103         struct sci_sas_address sas_address;
1104
1105         scic_sds_port_get_sas_address(sci_port, &sas_address);
1106
1107         writel(sas_address.high,
1108                 &sci_port->viit_registers->initiator_sas_address_hi);
1109         writel(sas_address.low,
1110                 &sci_port->viit_registers->initiator_sas_address_lo);
1111
1112         /* This value get cleared just in case its not already cleared */
1113         writel(0, &sci_port->viit_registers->reserved);
1114
1115         /* We are required to update the status register last */
1116         writel(SCU_VIIT_ENTRY_ID_VIIT |
1117                SCU_VIIT_IPPT_INITIATOR |
1118                ((1 << sci_port->physical_port_index) << SCU_VIIT_ENTRY_LPVIE_SHIFT) |
1119                SCU_VIIT_STATUS_ALL_VALID,
1120                &sci_port->viit_registers->status);
1121 }
1122
1123 /**
1124  * This method returns the maximum allowed speed for data transfers on this
1125  *    port.  This maximum allowed speed evaluates to the maximum speed of the
1126  *    slowest phy in the port.
1127  * @sci_port: This parameter specifies the port for which to retrieve the
1128  *    maximum allowed speed.
1129  *
1130  * This method returns the maximum negotiated speed of the slowest phy in the
1131  * port.
1132  */
1133 enum sas_linkrate scic_sds_port_get_max_allowed_speed(
1134         struct scic_sds_port *sci_port)
1135 {
1136         u16 index;
1137         enum sas_linkrate max_allowed_speed = SAS_LINK_RATE_6_0_GBPS;
1138         struct scic_sds_phy *phy = NULL;
1139
1140         /*
1141          * Loop through all of the phys in this port and find the phy with the
1142          * lowest maximum link rate. */
1143         for (index = 0; index < SCI_MAX_PHYS; index++) {
1144                 phy = sci_port->phy_table[index];
1145                 if (
1146                         (phy != NULL)
1147                         && (scic_sds_port_active_phy(sci_port, phy) == true)
1148                         && (phy->max_negotiated_speed < max_allowed_speed)
1149                         )
1150                         max_allowed_speed = phy->max_negotiated_speed;
1151         }
1152
1153         return max_allowed_speed;
1154 }
1155
1156 static void scic_port_enable_broadcast_change_notification(struct scic_sds_port *port)
1157 {
1158         struct scic_sds_phy *phy;
1159         u32 register_value;
1160         u8 index;
1161
1162         /* Loop through all of the phys to enable BCN. */
1163         for (index = 0; index < SCI_MAX_PHYS; index++) {
1164                 phy = port->phy_table[index];
1165                 if (phy != NULL) {
1166                         register_value =
1167                                 readl(&phy->link_layer_registers->link_layer_control);
1168
1169                         /* clear the bit by writing 1. */
1170                         writel(register_value,
1171                                 &phy->link_layer_registers->link_layer_control);
1172                 }
1173         }
1174 }
1175
1176 /*
1177  * ****************************************************************************
1178  * *  READY SUBSTATE HANDLERS
1179  * **************************************************************************** */
1180
1181 /*
1182  * This method is the general ready state stop handler for the struct scic_sds_port
1183  * object.  This function will transition the ready substate machine to its
1184  * final state. enum sci_status SCI_SUCCESS
1185  */
1186 static enum sci_status scic_sds_port_ready_substate_stop_handler(struct scic_sds_port *sci_port)
1187 {
1188         port_state_machine_change(sci_port, SCI_BASE_PORT_STATE_STOPPING);
1189         return SCI_SUCCESS;
1190 }
1191
1192 /*
1193  * This method is the general ready substate complete io handler for the
1194  * struct scic_sds_port object.  This function decrments the outstanding request count
1195  * for this port object. enum sci_status SCI_SUCCESS
1196  */
1197 static enum sci_status scic_sds_port_ready_substate_complete_io_handler(
1198         struct scic_sds_port *port,
1199         struct scic_sds_remote_device *device,
1200         struct scic_sds_request *io_request)
1201 {
1202         scic_sds_port_decrement_request_count(port);
1203
1204         return SCI_SUCCESS;
1205 }
1206
1207 static enum sci_status scic_sds_port_ready_substate_add_phy_handler(struct scic_sds_port *sci_port,
1208                                                                     struct scic_sds_phy *sci_phy)
1209 {
1210         enum sci_status status;
1211
1212         status = scic_sds_port_set_phy(sci_port, sci_phy);
1213
1214         if (status != SCI_SUCCESS)
1215                 return status;
1216
1217         scic_sds_port_general_link_up_handler(sci_port, sci_phy, true);
1218         sci_port->not_ready_reason = SCIC_PORT_NOT_READY_RECONFIGURING;
1219         port_state_machine_change(sci_port, SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING);
1220
1221         return status;
1222 }
1223
1224
1225 static enum sci_status scic_sds_port_ready_substate_remove_phy_handler(struct scic_sds_port *port,
1226                                                                        struct scic_sds_phy *phy)
1227 {
1228         enum sci_status status;
1229
1230         status = scic_sds_port_clear_phy(port, phy);
1231
1232         if (status != SCI_SUCCESS)
1233                 return status;
1234
1235         scic_sds_port_deactivate_phy(port, phy, true);
1236
1237         port->not_ready_reason = SCIC_PORT_NOT_READY_RECONFIGURING;
1238
1239         port_state_machine_change(port,
1240                                   SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING);
1241         return status;
1242 }
1243
1244 /*
1245  * ****************************************************************************
1246  * *  READY SUBSTATE WAITING HANDLERS
1247  * **************************************************************************** */
1248
1249 /**
1250  *
1251  * @sci_port: This is the struct scic_sds_port object that which has a phy that has
1252  *    gone link up.
1253  * @sci_phy: This is the struct scic_sds_phy object that has gone link up.
1254  *
1255  * This method is the ready waiting substate link up handler for the
1256  * struct scic_sds_port object.  This methos will report the link up condition for
1257  * this port and will transition to the ready operational substate. none
1258  */
1259 static void scic_sds_port_ready_waiting_substate_link_up_handler(
1260         struct scic_sds_port *sci_port,
1261         struct scic_sds_phy *sci_phy)
1262 {
1263         /*
1264          * Since this is the first phy going link up for the port we can just enable
1265          * it and continue. */
1266         scic_sds_port_activate_phy(sci_port, sci_phy, true);
1267
1268         port_state_machine_change(sci_port,
1269                                   SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL);
1270 }
1271
1272 /*
1273  * This method is the ready waiting substate start io handler for the
1274  * struct scic_sds_port object. The port object can not accept new requests so the
1275  * request is failed. enum sci_status SCI_FAILURE_INVALID_STATE
1276  */
1277 static enum sci_status scic_sds_port_ready_waiting_substate_start_io_handler(
1278         struct scic_sds_port *port,
1279         struct scic_sds_remote_device *device,
1280         struct scic_sds_request *io_request)
1281 {
1282         return SCI_FAILURE_INVALID_STATE;
1283 }
1284
1285 /*
1286  * ****************************************************************************
1287  * *  READY SUBSTATE OPERATIONAL HANDLERS
1288  * **************************************************************************** */
1289
1290 /*
1291  * This method will casue the port to reset. enum sci_status SCI_SUCCESS
1292  */
1293 static enum
1294 sci_status scic_sds_port_ready_operational_substate_reset_handler(
1295                 struct scic_sds_port *port,
1296                 u32 timeout)
1297 {
1298         enum sci_status status = SCI_FAILURE_INVALID_PHY;
1299         u32 phy_index;
1300         struct scic_sds_phy *selected_phy = NULL;
1301
1302
1303         /* Select a phy on which we can send the hard reset request. */
1304         for (phy_index = 0;
1305              (phy_index < SCI_MAX_PHYS) && (selected_phy == NULL);
1306              phy_index++) {
1307                 selected_phy = port->phy_table[phy_index];
1308
1309                 if ((selected_phy != NULL) &&
1310                     !scic_sds_port_active_phy(port, selected_phy)) {
1311                         /*
1312                          * We found a phy but it is not ready select
1313                          * different phy
1314                          */
1315                         selected_phy = NULL;
1316                 }
1317         }
1318
1319         /* If we have a phy then go ahead and start the reset procedure */
1320         if (selected_phy != NULL) {
1321                 status = scic_sds_phy_reset(selected_phy);
1322
1323                 if (status == SCI_SUCCESS) {
1324                         isci_timer_start(port->timer_handle, timeout);
1325                         port->not_ready_reason =
1326                                 SCIC_PORT_NOT_READY_HARD_RESET_REQUESTED;
1327
1328                         port_state_machine_change(port,
1329                                                   SCI_BASE_PORT_STATE_RESETTING);
1330                 }
1331         }
1332
1333         return status;
1334 }
1335
1336 /**
1337  * scic_sds_port_ready_operational_substate_link_up_handler() -
1338  * @sci_port: This is the struct scic_sds_port object that which has a phy that has
1339  *    gone link up.
1340  * @sci_phy: This is the struct scic_sds_phy object that has gone link up.
1341  *
1342  * This method is the ready operational substate link up handler for the
1343  * struct scic_sds_port object. This function notifies the SCI User that the phy has
1344  * gone link up. none
1345  */
1346 static void scic_sds_port_ready_operational_substate_link_up_handler(
1347         struct scic_sds_port *sci_port,
1348         struct scic_sds_phy *sci_phy)
1349 {
1350         scic_sds_port_general_link_up_handler(sci_port, sci_phy, true);
1351 }
1352
1353 /**
1354  * scic_sds_port_ready_operational_substate_link_down_handler() -
1355  * @sci_port: This is the struct scic_sds_port object that which has a phy that has
1356  *    gone link down.
1357  * @sci_phy: This is the struct scic_sds_phy object that has gone link down.
1358  *
1359  * This method is the ready operational substate link down handler for the
1360  * struct scic_sds_port object. This function notifies the SCI User that the phy has
1361  * gone link down and if this is the last phy in the port the port will change
1362  * state to the ready waiting substate. none
1363  */
1364 static void scic_sds_port_ready_operational_substate_link_down_handler(
1365         struct scic_sds_port *sci_port,
1366         struct scic_sds_phy *sci_phy)
1367 {
1368         scic_sds_port_deactivate_phy(sci_port, sci_phy, true);
1369
1370         /*
1371          * If there are no active phys left in the port, then transition
1372          * the port to the WAITING state until such time as a phy goes
1373          * link up. */
1374         if (sci_port->active_phy_mask == 0)
1375                 port_state_machine_change(sci_port,
1376                                           SCIC_SDS_PORT_READY_SUBSTATE_WAITING);
1377 }
1378
1379 /*
1380  * This method is the ready operational substate start io handler for the
1381  * struct scic_sds_port object.  This function incremetns the outstanding request
1382  * count for this port object. enum sci_status SCI_SUCCESS
1383  */
1384 static enum sci_status scic_sds_port_ready_operational_substate_start_io_handler(
1385         struct scic_sds_port *port,
1386         struct scic_sds_remote_device *device,
1387         struct scic_sds_request *io_request)
1388 {
1389         port->started_request_count++;
1390         return SCI_SUCCESS;
1391 }
1392
1393 /*
1394  * ****************************************************************************
1395  * *  READY SUBSTATE OPERATIONAL HANDLERS
1396  * **************************************************************************** */
1397
1398 /*
1399  * This is the default method for a port add phy request.  It will report a
1400  * warning and exit. enum sci_status SCI_FAILURE_INVALID_STATE
1401  */
1402 static enum sci_status scic_sds_port_ready_configuring_substate_add_phy_handler(
1403         struct scic_sds_port *port,
1404         struct scic_sds_phy *phy)
1405 {
1406         enum sci_status status;
1407
1408         status = scic_sds_port_set_phy(port, phy);
1409
1410         if (status == SCI_SUCCESS) {
1411                 scic_sds_port_general_link_up_handler(port, phy, true);
1412
1413                 /*
1414                  * Re-enter the configuring state since this may be the last phy in
1415                  * the port. */
1416                 port_state_machine_change(port,
1417                                           SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING);
1418         }
1419
1420         return status;
1421 }
1422
1423 /*
1424  * This is the default method for a port remove phy request.  It will report a
1425  * warning and exit. enum sci_status SCI_FAILURE_INVALID_STATE
1426  */
1427 static enum sci_status scic_sds_port_ready_configuring_substate_remove_phy_handler(
1428         struct scic_sds_port *port,
1429         struct scic_sds_phy *phy)
1430 {
1431         enum sci_status status;
1432
1433         status = scic_sds_port_clear_phy(port, phy);
1434
1435         if (status != SCI_SUCCESS)
1436                 return status;
1437         scic_sds_port_deactivate_phy(port, phy, true);
1438
1439         /* Re-enter the configuring state since this may be the last phy in
1440          * the port
1441          */
1442         port_state_machine_change(port,
1443                                   SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING);
1444
1445         return status;
1446 }
1447
1448 /**
1449  * scic_sds_port_ready_configuring_substate_complete_io_handler() -
1450  * @port: This is the port that is being requested to complete the io request.
1451  * @device: This is the device on which the io is completing.
1452  *
1453  * This method will decrement the outstanding request count for this port. If
1454  * the request count goes to 0 then the port can be reprogrammed with its new
1455  * phy data.
1456  */
1457 static enum sci_status
1458 scic_sds_port_ready_configuring_substate_complete_io_handler(
1459         struct scic_sds_port *port,
1460         struct scic_sds_remote_device *device,
1461         struct scic_sds_request *io_request)
1462 {
1463         scic_sds_port_decrement_request_count(port);
1464
1465         if (port->started_request_count == 0) {
1466                 port_state_machine_change(port,
1467                                           SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL);
1468         }
1469
1470         return SCI_SUCCESS;
1471 }
1472
1473 static enum sci_status default_port_handler(struct scic_sds_port *sci_port,
1474                                             const char *func)
1475 {
1476         dev_warn(sciport_to_dev(sci_port),
1477                  "%s: in wrong state: %d\n", func,
1478                  sci_base_state_machine_get_state(&sci_port->state_machine));
1479         return SCI_FAILURE_INVALID_STATE;
1480 }
1481
1482 static enum sci_status
1483 scic_sds_port_default_stop_handler(struct scic_sds_port *sci_port)
1484 {
1485         return default_port_handler(sci_port, __func__);
1486 }
1487
1488 static enum sci_status
1489 scic_sds_port_default_destruct_handler(struct scic_sds_port *sci_port)
1490 {
1491         return default_port_handler(sci_port, __func__);
1492 }
1493
1494 static enum sci_status
1495 scic_sds_port_default_reset_handler(struct scic_sds_port *sci_port,
1496                                     u32 timeout)
1497 {
1498         return default_port_handler(sci_port, __func__);
1499 }
1500
1501 static enum sci_status
1502 scic_sds_port_default_add_phy_handler(struct scic_sds_port *sci_port,
1503                                       struct scic_sds_phy *base_phy)
1504 {
1505         return default_port_handler(sci_port, __func__);
1506 }
1507
1508 static enum sci_status
1509 scic_sds_port_default_remove_phy_handler(struct scic_sds_port *sci_port,
1510                                          struct scic_sds_phy *base_phy)
1511 {
1512         return default_port_handler(sci_port, __func__);
1513 }
1514
1515 /*
1516  * This is the default method for a port unsolicited frame request.  It will
1517  * report a warning and exit. enum sci_status SCI_FAILURE_INVALID_STATE Is it even
1518  * possible to receive an unsolicited frame directed to a port object?  It
1519  * seems possible if we implementing virtual functions but until then?
1520  */
1521 static enum sci_status
1522 scic_sds_port_default_frame_handler(struct scic_sds_port *sci_port,
1523                                     u32 frame_index)
1524 {
1525         struct scic_sds_controller *scic = scic_sds_port_get_controller(sci_port);
1526
1527         default_port_handler(sci_port, __func__);
1528         scic_sds_controller_release_frame(scic, frame_index);
1529
1530         return SCI_FAILURE_INVALID_STATE;
1531 }
1532
1533 static enum sci_status scic_sds_port_default_event_handler(struct scic_sds_port *sci_port,
1534                                                     u32 event_code)
1535 {
1536         return default_port_handler(sci_port, __func__);
1537 }
1538
1539 static void scic_sds_port_default_link_up_handler(struct scic_sds_port *sci_port,
1540                                            struct scic_sds_phy *sci_phy)
1541 {
1542         default_port_handler(sci_port, __func__);
1543 }
1544
1545 static void scic_sds_port_default_link_down_handler(struct scic_sds_port *sci_port,
1546                                              struct scic_sds_phy *sci_phy)
1547 {
1548         default_port_handler(sci_port, __func__);
1549 }
1550
1551 static enum sci_status scic_sds_port_default_start_io_handler(struct scic_sds_port *sci_port,
1552                                                        struct scic_sds_remote_device *sci_dev,
1553                                                        struct scic_sds_request *sci_req)
1554 {
1555         return default_port_handler(sci_port, __func__);
1556 }
1557
1558 static enum sci_status scic_sds_port_default_complete_io_handler(struct scic_sds_port *sci_port,
1559                                                                  struct scic_sds_remote_device *sci_dev,
1560                                                                  struct scic_sds_request *sci_req)
1561 {
1562         return default_port_handler(sci_port, __func__);
1563 }
1564
1565 /*
1566  * ******************************************************************************
1567  * *  PORT STATE PRIVATE METHODS
1568  * ****************************************************************************** */
1569
1570 /**
1571  *
1572  * @sci_port: This is the struct scic_sds_port object to suspend.
1573  *
1574  * This method will susped the port task scheduler for this port object. none
1575  */
1576 static void
1577 scic_sds_port_suspend_port_task_scheduler(struct scic_sds_port *port)
1578 {
1579         u32 pts_control_value;
1580
1581         pts_control_value = readl(&port->port_task_scheduler_registers->control);
1582         pts_control_value |= SCU_PTSxCR_GEN_BIT(SUSPEND);
1583         writel(pts_control_value, &port->port_task_scheduler_registers->control);
1584 }
1585
1586 /**
1587  * scic_sds_port_post_dummy_request() - post dummy/workaround request
1588  * @sci_port: port to post task
1589  *
1590  * Prevent the hardware scheduler from posting new requests to the front
1591  * of the scheduler queue causing a starvation problem for currently
1592  * ongoing requests.
1593  *
1594  */
1595 static void scic_sds_port_post_dummy_request(struct scic_sds_port *sci_port)
1596 {
1597         u32 command;
1598         struct scu_task_context *task_context;
1599         struct scic_sds_controller *scic = sci_port->owning_controller;
1600         u16 tci = sci_port->reserved_tci;
1601
1602         task_context = scic_sds_controller_get_task_context_buffer(scic, tci);
1603
1604         task_context->abort = 0;
1605
1606         command = SCU_CONTEXT_COMMAND_REQUEST_TYPE_POST_TC |
1607                   sci_port->physical_port_index << SCU_CONTEXT_COMMAND_LOGICAL_PORT_SHIFT |
1608                   tci;
1609
1610         scic_sds_controller_post_request(scic, command);
1611 }
1612
1613 /**
1614  * This routine will abort the dummy request.  This will alow the hardware to
1615  * power down parts of the silicon to save power.
1616  *
1617  * @sci_port: The port on which the task must be aborted.
1618  *
1619  */
1620 static void scic_sds_port_abort_dummy_request(struct scic_sds_port *sci_port)
1621 {
1622         struct scic_sds_controller *scic = sci_port->owning_controller;
1623         u16 tci = sci_port->reserved_tci;
1624         struct scu_task_context *tc;
1625         u32 command;
1626
1627         tc = scic_sds_controller_get_task_context_buffer(scic, tci);
1628
1629         tc->abort = 1;
1630
1631         command = SCU_CONTEXT_COMMAND_REQUEST_POST_TC_ABORT |
1632                   sci_port->physical_port_index << SCU_CONTEXT_COMMAND_LOGICAL_PORT_SHIFT |
1633                   tci;
1634
1635         scic_sds_controller_post_request(scic, command);
1636 }
1637
1638 /**
1639  *
1640  * @sci_port: This is the struct scic_sds_port object to resume.
1641  *
1642  * This method will resume the port task scheduler for this port object. none
1643  */
1644 static void
1645 scic_sds_port_resume_port_task_scheduler(struct scic_sds_port *port)
1646 {
1647         u32 pts_control_value;
1648
1649         pts_control_value = readl(&port->port_task_scheduler_registers->control);
1650         pts_control_value &= ~SCU_PTSxCR_GEN_BIT(SUSPEND);
1651         writel(pts_control_value, &port->port_task_scheduler_registers->control);
1652 }
1653
1654 /*
1655  * ******************************************************************************
1656  * *  PORT READY SUBSTATE METHODS
1657  * ****************************************************************************** */
1658
1659 /**
1660  *
1661  * @object: This is the object which is cast to a struct scic_sds_port object.
1662  *
1663  * This method will perform the actions required by the struct scic_sds_port on
1664  * entering the SCIC_SDS_PORT_READY_SUBSTATE_WAITING. This function checks the
1665  * port for any ready phys.  If there is at least one phy in a ready state then
1666  * the port transitions to the ready operational substate. none
1667  */
1668 static void scic_sds_port_ready_substate_waiting_enter(void *object)
1669 {
1670         struct scic_sds_port *sci_port = object;
1671
1672         scic_sds_port_set_base_state_handlers(
1673                 sci_port, SCIC_SDS_PORT_READY_SUBSTATE_WAITING
1674                 );
1675
1676         scic_sds_port_suspend_port_task_scheduler(sci_port);
1677
1678         sci_port->not_ready_reason = SCIC_PORT_NOT_READY_NO_ACTIVE_PHYS;
1679
1680         if (sci_port->active_phy_mask != 0) {
1681                 /* At least one of the phys on the port is ready */
1682                 port_state_machine_change(sci_port,
1683                                           SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL);
1684         }
1685 }
1686
1687 /**
1688  *
1689  * @object: This is the object which is cast to a struct scic_sds_port object.
1690  *
1691  * This function will perform the actions required by the struct scic_sds_port
1692  * on entering the SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL. This function sets
1693  * the state handlers for the port object, notifies the SCI User that the port
1694  * is ready, and resumes port operations. none
1695  */
1696 static void scic_sds_port_ready_substate_operational_enter(void *object)
1697 {
1698         u32 index;
1699         struct scic_sds_port *sci_port = object;
1700         struct scic_sds_controller *scic = sci_port->owning_controller;
1701         struct isci_host *ihost = scic_to_ihost(scic);
1702         struct isci_port *iport = sci_port_to_iport(sci_port);
1703
1704         scic_sds_port_set_base_state_handlers(
1705                         sci_port,
1706                         SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL);
1707
1708         isci_port_ready(ihost, iport);
1709
1710         for (index = 0; index < SCI_MAX_PHYS; index++) {
1711                 if (sci_port->phy_table[index]) {
1712                         writel(sci_port->physical_port_index,
1713                                 &sci_port->port_pe_configuration_register[
1714                                         sci_port->phy_table[index]->phy_index]);
1715                 }
1716         }
1717
1718         scic_sds_port_update_viit_entry(sci_port);
1719
1720         scic_sds_port_resume_port_task_scheduler(sci_port);
1721
1722         /*
1723          * Post the dummy task for the port so the hardware can schedule
1724          * io correctly
1725          */
1726         scic_sds_port_post_dummy_request(sci_port);
1727 }
1728
1729 static void scic_sds_port_invalidate_dummy_remote_node(struct scic_sds_port *sci_port)
1730 {
1731         struct scic_sds_controller *scic = sci_port->owning_controller;
1732         u8 phys_index = sci_port->physical_port_index;
1733         union scu_remote_node_context *rnc;
1734         u16 rni = sci_port->reserved_rni;
1735         u32 command;
1736
1737         rnc = &scic->remote_node_context_table[rni];
1738
1739         rnc->ssp.is_valid = false;
1740
1741         /* ensure the preceding tc abort request has reached the
1742          * controller and give it ample time to act before posting the rnc
1743          * invalidate
1744          */
1745         readl(&scic->smu_registers->interrupt_status); /* flush */
1746         udelay(10);
1747
1748         command = SCU_CONTEXT_COMMAND_POST_RNC_INVALIDATE |
1749                   phys_index << SCU_CONTEXT_COMMAND_LOGICAL_PORT_SHIFT | rni;
1750
1751         scic_sds_controller_post_request(scic, command);
1752 }
1753
1754 /**
1755  *
1756  * @object: This is the object which is cast to a struct scic_sds_port object.
1757  *
1758  * This method will perform the actions required by the struct scic_sds_port on
1759  * exiting the SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL. This function reports
1760  * the port not ready and suspends the port task scheduler. none
1761  */
1762 static void scic_sds_port_ready_substate_operational_exit(void *object)
1763 {
1764         struct scic_sds_port *sci_port = object;
1765         struct scic_sds_controller *scic = sci_port->owning_controller;
1766         struct isci_host *ihost = scic_to_ihost(scic);
1767         struct isci_port *iport = sci_port_to_iport(sci_port);
1768
1769         /*
1770          * Kill the dummy task for this port if it has not yet posted
1771          * the hardware will treat this as a NOP and just return abort
1772          * complete.
1773          */
1774         scic_sds_port_abort_dummy_request(sci_port);
1775
1776         isci_port_not_ready(ihost, iport);
1777
1778         if (sci_port->ready_exit)
1779                 scic_sds_port_invalidate_dummy_remote_node(sci_port);
1780 }
1781
1782 /*
1783  * ******************************************************************************
1784  * *  PORT READY CONFIGURING METHODS
1785  * ****************************************************************************** */
1786
1787 /**
1788  * scic_sds_port_ready_substate_configuring_enter() -
1789  * @object: This is the object which is cast to a struct scic_sds_port object.
1790  *
1791  * This method will perform the actions required by the struct scic_sds_port on
1792  * exiting the SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL. This function reports
1793  * the port not ready and suspends the port task scheduler. none
1794  */
1795 static void scic_sds_port_ready_substate_configuring_enter(void *object)
1796 {
1797         struct scic_sds_port *sci_port = object;
1798         struct scic_sds_controller *scic = sci_port->owning_controller;
1799         struct isci_host *ihost = scic_to_ihost(scic);
1800         struct isci_port *iport = sci_port_to_iport(sci_port);
1801
1802         scic_sds_port_set_base_state_handlers(
1803                         sci_port,
1804                         SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING);
1805
1806         if (sci_port->active_phy_mask == 0) {
1807                 isci_port_not_ready(ihost, iport);
1808
1809                 port_state_machine_change(sci_port,
1810                                           SCIC_SDS_PORT_READY_SUBSTATE_WAITING);
1811         } else if (sci_port->started_request_count == 0)
1812                 port_state_machine_change(sci_port,
1813                                           SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL);
1814 }
1815
1816 static void scic_sds_port_ready_substate_configuring_exit(void *object)
1817 {
1818         struct scic_sds_port *sci_port = object;
1819
1820         scic_sds_port_suspend_port_task_scheduler(sci_port);
1821         if (sci_port->ready_exit)
1822                 scic_sds_port_invalidate_dummy_remote_node(sci_port);
1823 }
1824
1825 /* --------------------------------------------------------------------------- */
1826
1827 /**
1828  *
1829  * @port: This is the struct scic_sds_port object on which the io request count will
1830  *    be decremented.
1831  * @device: This is the struct scic_sds_remote_device object to which the io request
1832  *    is being directed.  This parameter is not required to complete this
1833  *    operation.
1834  * @io_request: This is the request that is being completed on this port
1835  *    object.  This parameter is not required to complete this operation.
1836  *
1837  * This is a general complete io request handler for the struct scic_sds_port object.
1838  * enum sci_status SCI_SUCCESS
1839  */
1840 static enum sci_status scic_sds_port_general_complete_io_handler(
1841         struct scic_sds_port *port,
1842         struct scic_sds_remote_device *device,
1843         struct scic_sds_request *io_request)
1844 {
1845         scic_sds_port_decrement_request_count(port);
1846
1847         return SCI_SUCCESS;
1848 }
1849
1850 /*
1851  * This method takes the struct scic_sds_port that is in a stopped state and handles a
1852  * stop request.  This function takes no action. enum sci_status SCI_SUCCESS the
1853  * stop request is successful as the struct scic_sds_port object is already stopped.
1854  */
1855 static enum sci_status scic_sds_port_stopped_state_stop_handler(
1856         struct scic_sds_port *port)
1857 {
1858         /* We are already stopped so there is nothing to do here */
1859         return SCI_SUCCESS;
1860 }
1861
1862 /*
1863  * This method takes the struct scic_sds_port that is in a stopped state and handles
1864  * the destruct request.  The stopped state is the only state in which the
1865  * struct scic_sds_port can be destroyed.  This function causes the port object to
1866  * transition to the SCI_BASE_PORT_STATE_FINAL. enum sci_status SCI_SUCCESS
1867  */
1868 static enum sci_status scic_sds_port_stopped_state_destruct_handler(struct scic_sds_port *port)
1869 {
1870         port_state_machine_stop(port);
1871
1872         return SCI_SUCCESS;
1873 }
1874
1875 /*
1876  * This method takes the struct scic_sds_port that is in a stopped state and handles
1877  * the add phy request.  In MPC mode the only time a phy can be added to a port
1878  * is in the SCI_BASE_PORT_STATE_STOPPED. enum sci_status
1879  * SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION is returned when the phy can not
1880  * be added to the port. SCI_SUCCESS if the phy is added to the port.
1881  */
1882 static enum sci_status scic_sds_port_stopped_state_add_phy_handler(
1883         struct scic_sds_port *port,
1884         struct scic_sds_phy *phy)
1885 {
1886         struct sci_sas_address port_sas_address;
1887
1888         /* Read the port assigned SAS Address if there is one */
1889         scic_sds_port_get_sas_address(port, &port_sas_address);
1890
1891         if (port_sas_address.high != 0 && port_sas_address.low != 0) {
1892                 struct sci_sas_address phy_sas_address;
1893
1894                 /*
1895                  * Make sure that the PHY SAS Address matches the SAS Address
1896                  * for this port. */
1897                 scic_sds_phy_get_sas_address(phy, &phy_sas_address);
1898
1899                 if (
1900                         (port_sas_address.high != phy_sas_address.high)
1901                         || (port_sas_address.low  != phy_sas_address.low)
1902                         ) {
1903                         return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
1904                 }
1905         }
1906
1907         return scic_sds_port_set_phy(port, phy);
1908 }
1909
1910 /*
1911  * This method takes the struct scic_sds_port that is in a stopped state and handles
1912  * the remove phy request.  In MPC mode the only time a phy can be removed from
1913  * a port is in the SCI_BASE_PORT_STATE_STOPPED. enum sci_status
1914  * SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION is returned when the phy can not
1915  * be added to the port. SCI_SUCCESS if the phy is added to the port.
1916  */
1917 static enum sci_status scic_sds_port_stopped_state_remove_phy_handler(
1918         struct scic_sds_port *port,
1919         struct scic_sds_phy *phy)
1920 {
1921         return scic_sds_port_clear_phy(port, phy);
1922 }
1923
1924 /*
1925  * ****************************************************************************
1926  * *  READY STATE HANDLERS
1927  * **************************************************************************** */
1928
1929 /*
1930  * ****************************************************************************
1931  * *  RESETTING STATE HANDLERS
1932  * **************************************************************************** */
1933
1934 /*
1935  * ****************************************************************************
1936  * *  STOPPING STATE HANDLERS
1937  * **************************************************************************** */
1938
1939 /*
1940  * This method takes the struct scic_sds_port that is in a stopping state and handles
1941  * the complete io request. Should the request count reach 0 then the port
1942  * object will transition to the stopped state. enum sci_status SCI_SUCCESS
1943  */
1944 static enum sci_status scic_sds_port_stopping_state_complete_io_handler(
1945         struct scic_sds_port *sci_port,
1946         struct scic_sds_remote_device *device,
1947         struct scic_sds_request *io_request)
1948 {
1949         scic_sds_port_decrement_request_count(sci_port);
1950
1951         if (sci_port->started_request_count == 0)
1952                 port_state_machine_change(sci_port,
1953                                           SCI_BASE_PORT_STATE_STOPPED);
1954
1955         return SCI_SUCCESS;
1956 }
1957
1958 /*
1959  * ****************************************************************************
1960  * *  RESETTING STATE HANDLERS
1961  * **************************************************************************** */
1962
1963 /**
1964  *
1965  * @port: This is the port object which is being requested to stop.
1966  *
1967  * This method will stop a failed port.  This causes a transition to the
1968  * stopping state. enum sci_status SCI_SUCCESS
1969  */
1970 static enum sci_status scic_sds_port_reset_state_stop_handler(
1971         struct scic_sds_port *port)
1972 {
1973         port_state_machine_change(port,
1974                                   SCI_BASE_PORT_STATE_STOPPING);
1975
1976         return SCI_SUCCESS;
1977 }
1978
1979 /*
1980  * This method will transition a failed port to its ready state.  The port
1981  * failed because a hard reset request timed out but at some time later one or
1982  * more phys in the port became ready. enum sci_status SCI_SUCCESS
1983  */
1984 static void scic_sds_port_reset_state_link_up_handler(
1985         struct scic_sds_port *port,
1986         struct scic_sds_phy *phy)
1987 {
1988         /*
1989          * / @todo We should make sure that the phy that has gone link up is the same
1990          * /       one on which we sent the reset.  It is possible that the phy on
1991          * /       which we sent the reset is not the one that has gone link up and we
1992          * /       want to make sure that phy being reset comes back.  Consider the
1993          * /       case where a reset is sent but before the hardware processes the
1994          * /       reset it get a link up on the port because of a hot plug event.
1995          * /       because of the reset request this phy will go link down almost
1996          * /       immediately. */
1997
1998         /*
1999          * In the resetting state we don't notify the user regarding
2000          * link up and link down notifications. */
2001         scic_sds_port_general_link_up_handler(port, phy, false);
2002 }
2003
2004 /*
2005  * This method process link down notifications that occur during a port reset
2006  * operation. Link downs can occur during the reset operation. enum sci_status
2007  * SCI_SUCCESS
2008  */
2009 static void scic_sds_port_reset_state_link_down_handler(
2010         struct scic_sds_port *port,
2011         struct scic_sds_phy *phy)
2012 {
2013         /*
2014          * In the resetting state we don't notify the user regarding
2015          * link up and link down notifications. */
2016         scic_sds_port_deactivate_phy(port, phy, false);
2017 }
2018
2019 enum sci_status scic_sds_port_start(struct scic_sds_port *sci_port)
2020 {
2021         struct scic_sds_controller *scic = sci_port->owning_controller;
2022         struct isci_host *ihost = scic_to_ihost(scic);
2023         enum sci_status status = SCI_SUCCESS;
2024         enum scic_sds_port_states state;
2025         u32 phy_mask;
2026
2027         state = sci_port->state_machine.current_state_id;
2028         if (state != SCI_BASE_PORT_STATE_STOPPED) {
2029                 dev_warn(sciport_to_dev(sci_port),
2030                          "%s: in wrong state: %d\n", __func__, state);
2031                 return SCI_FAILURE_INVALID_STATE;
2032         }
2033
2034         if (sci_port->assigned_device_count > 0) {
2035                 /* TODO This is a start failure operation because
2036                  * there are still devices assigned to this port.
2037                  * There must be no devices assigned to a port on a
2038                  * start operation.
2039                  */
2040                 return SCI_FAILURE_UNSUPPORTED_PORT_CONFIGURATION;
2041         }
2042
2043         sci_port->timer_handle =
2044                 isci_timer_create(ihost,
2045                                   sci_port,
2046                                   scic_sds_port_timeout_handler);
2047
2048         if (!sci_port->timer_handle)
2049                 return SCI_FAILURE_INSUFFICIENT_RESOURCES;
2050
2051         if (sci_port->reserved_rni == SCU_DUMMY_INDEX) {
2052                 u16 rni = scic_sds_remote_node_table_allocate_remote_node(
2053                                 &scic->available_remote_nodes, 1);
2054
2055                 if (rni != SCU_DUMMY_INDEX)
2056                         scic_sds_port_construct_dummy_rnc(sci_port, rni);
2057                 else
2058                         status = SCI_FAILURE_INSUFFICIENT_RESOURCES;
2059                 sci_port->reserved_rni = rni;
2060         }
2061
2062         if (sci_port->reserved_tci == SCU_DUMMY_INDEX) {
2063                 /* Allocate a TCI and remove the sequence nibble */
2064                 u16 tci = scic_controller_allocate_io_tag(scic);
2065
2066                 if (tci != SCU_DUMMY_INDEX)
2067                         scic_sds_port_construct_dummy_task(sci_port, tci);
2068                 else
2069                         status = SCI_FAILURE_INSUFFICIENT_RESOURCES;
2070                 sci_port->reserved_tci = tci;
2071         }
2072
2073         if (status == SCI_SUCCESS) {
2074                 phy_mask = scic_sds_port_get_phys(sci_port);
2075
2076                 /*
2077                  * There are one or more phys assigned to this port.  Make sure
2078                  * the port's phy mask is in fact legal and supported by the
2079                  * silicon.
2080                  */
2081                 if (scic_sds_port_is_phy_mask_valid(sci_port, phy_mask) == true) {
2082                         port_state_machine_change(sci_port,
2083                                                   SCI_BASE_PORT_STATE_READY);
2084
2085                         return SCI_SUCCESS;
2086                 }
2087                 status = SCI_FAILURE;
2088         }
2089
2090         if (status != SCI_SUCCESS)
2091                 scic_sds_port_destroy_dummy_resources(sci_port);
2092
2093         return status;
2094 }
2095
2096 static struct scic_sds_port_state_handler scic_sds_port_state_handler_table[] = {
2097         [SCI_BASE_PORT_STATE_STOPPED] = {
2098                 .stop_handler           = scic_sds_port_stopped_state_stop_handler,
2099                 .destruct_handler       = scic_sds_port_stopped_state_destruct_handler,
2100                 .reset_handler          = scic_sds_port_default_reset_handler,
2101                 .add_phy_handler        = scic_sds_port_stopped_state_add_phy_handler,
2102                 .remove_phy_handler     = scic_sds_port_stopped_state_remove_phy_handler,
2103                 .frame_handler          = scic_sds_port_default_frame_handler,
2104                 .event_handler          = scic_sds_port_default_event_handler,
2105                 .link_up_handler        = scic_sds_port_default_link_up_handler,
2106                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2107                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2108                 .complete_io_handler    = scic_sds_port_default_complete_io_handler
2109         },
2110         [SCI_BASE_PORT_STATE_STOPPING] = {
2111                 .stop_handler           = scic_sds_port_default_stop_handler,
2112                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2113                 .reset_handler          = scic_sds_port_default_reset_handler,
2114                 .add_phy_handler        = scic_sds_port_default_add_phy_handler,
2115                 .remove_phy_handler     = scic_sds_port_default_remove_phy_handler,
2116                 .frame_handler          = scic_sds_port_default_frame_handler,
2117                 .event_handler          = scic_sds_port_default_event_handler,
2118                 .link_up_handler        = scic_sds_port_default_link_up_handler,
2119                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2120                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2121                 .complete_io_handler    = scic_sds_port_stopping_state_complete_io_handler
2122         },
2123         [SCI_BASE_PORT_STATE_READY] = {
2124                 .stop_handler           = scic_sds_port_default_stop_handler,
2125                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2126                 .reset_handler          = scic_sds_port_default_reset_handler,
2127                 .add_phy_handler        = scic_sds_port_default_add_phy_handler,
2128                 .remove_phy_handler     = scic_sds_port_default_remove_phy_handler,
2129                 .frame_handler          = scic_sds_port_default_frame_handler,
2130                 .event_handler          = scic_sds_port_default_event_handler,
2131                 .link_up_handler        = scic_sds_port_default_link_up_handler,
2132                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2133                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2134                 .complete_io_handler    = scic_sds_port_general_complete_io_handler
2135         },
2136         [SCIC_SDS_PORT_READY_SUBSTATE_WAITING] = {
2137                 .stop_handler           = scic_sds_port_ready_substate_stop_handler,
2138                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2139                 .reset_handler          = scic_sds_port_default_reset_handler,
2140                 .add_phy_handler        = scic_sds_port_ready_substate_add_phy_handler,
2141                 .remove_phy_handler     = scic_sds_port_default_remove_phy_handler,
2142                 .frame_handler          = scic_sds_port_default_frame_handler,
2143                 .event_handler          = scic_sds_port_default_event_handler,
2144                 .link_up_handler        = scic_sds_port_ready_waiting_substate_link_up_handler,
2145                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2146                 .start_io_handler       = scic_sds_port_ready_waiting_substate_start_io_handler,
2147                 .complete_io_handler    = scic_sds_port_ready_substate_complete_io_handler,
2148         },
2149         [SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL] = {
2150                 .stop_handler           = scic_sds_port_ready_substate_stop_handler,
2151                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2152                 .reset_handler          = scic_sds_port_ready_operational_substate_reset_handler,
2153                 .add_phy_handler        = scic_sds_port_ready_substate_add_phy_handler,
2154                 .remove_phy_handler     = scic_sds_port_ready_substate_remove_phy_handler,
2155                 .frame_handler          = scic_sds_port_default_frame_handler,
2156                 .event_handler          = scic_sds_port_default_event_handler,
2157                 .link_up_handler        = scic_sds_port_ready_operational_substate_link_up_handler,
2158                 .link_down_handler      = scic_sds_port_ready_operational_substate_link_down_handler,
2159                 .start_io_handler       = scic_sds_port_ready_operational_substate_start_io_handler,
2160                 .complete_io_handler    = scic_sds_port_ready_substate_complete_io_handler,
2161         },
2162         [SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING] = {
2163                 .stop_handler           = scic_sds_port_ready_substate_stop_handler,
2164                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2165                 .reset_handler          = scic_sds_port_default_reset_handler,
2166                 .add_phy_handler        = scic_sds_port_ready_configuring_substate_add_phy_handler,
2167                 .remove_phy_handler     = scic_sds_port_ready_configuring_substate_remove_phy_handler,
2168                 .frame_handler          = scic_sds_port_default_frame_handler,
2169                 .event_handler          = scic_sds_port_default_event_handler,
2170                 .link_up_handler        = scic_sds_port_default_link_up_handler,
2171                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2172                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2173                 .complete_io_handler    = scic_sds_port_ready_configuring_substate_complete_io_handler
2174         },
2175         [SCI_BASE_PORT_STATE_RESETTING] = {
2176                 .stop_handler           = scic_sds_port_reset_state_stop_handler,
2177                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2178                 .reset_handler          = scic_sds_port_default_reset_handler,
2179                 .add_phy_handler        = scic_sds_port_default_add_phy_handler,
2180                 .remove_phy_handler     = scic_sds_port_default_remove_phy_handler,
2181                 .frame_handler          = scic_sds_port_default_frame_handler,
2182                 .event_handler          = scic_sds_port_default_event_handler,
2183                 .link_up_handler        = scic_sds_port_reset_state_link_up_handler,
2184                 .link_down_handler      = scic_sds_port_reset_state_link_down_handler,
2185                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2186                 .complete_io_handler    = scic_sds_port_general_complete_io_handler
2187         },
2188         [SCI_BASE_PORT_STATE_FAILED] = {
2189                 .stop_handler           = scic_sds_port_default_stop_handler,
2190                 .destruct_handler       = scic_sds_port_default_destruct_handler,
2191                 .reset_handler          = scic_sds_port_default_reset_handler,
2192                 .add_phy_handler        = scic_sds_port_default_add_phy_handler,
2193                 .remove_phy_handler     = scic_sds_port_default_remove_phy_handler,
2194                 .frame_handler          = scic_sds_port_default_frame_handler,
2195                 .event_handler          = scic_sds_port_default_event_handler,
2196                 .link_up_handler        = scic_sds_port_default_link_up_handler,
2197                 .link_down_handler      = scic_sds_port_default_link_down_handler,
2198                 .start_io_handler       = scic_sds_port_default_start_io_handler,
2199                 .complete_io_handler    = scic_sds_port_general_complete_io_handler
2200         }
2201 };
2202
2203 /*
2204  * ******************************************************************************
2205  * *  PORT STATE PRIVATE METHODS
2206  * ****************************************************************************** */
2207
2208 /**
2209  *
2210  * @sci_port: This is the port object which to suspend.
2211  *
2212  * This method will enable the SCU Port Task Scheduler for this port object but
2213  * will leave the port task scheduler in a suspended state. none
2214  */
2215 static void
2216 scic_sds_port_enable_port_task_scheduler(struct scic_sds_port *port)
2217 {
2218         u32 pts_control_value;
2219
2220         pts_control_value = readl(&port->port_task_scheduler_registers->control);
2221         pts_control_value |= SCU_PTSxCR_GEN_BIT(ENABLE) | SCU_PTSxCR_GEN_BIT(SUSPEND);
2222         writel(pts_control_value, &port->port_task_scheduler_registers->control);
2223 }
2224
2225 /**
2226  *
2227  * @sci_port: This is the port object which to resume.
2228  *
2229  * This method will disable the SCU port task scheduler for this port object.
2230  * none
2231  */
2232 static void
2233 scic_sds_port_disable_port_task_scheduler(struct scic_sds_port *port)
2234 {
2235         u32 pts_control_value;
2236
2237         pts_control_value = readl(&port->port_task_scheduler_registers->control);
2238         pts_control_value &=
2239                 ~(SCU_PTSxCR_GEN_BIT(ENABLE) | SCU_PTSxCR_GEN_BIT(SUSPEND));
2240         writel(pts_control_value, &port->port_task_scheduler_registers->control);
2241 }
2242
2243 static void scic_sds_port_post_dummy_remote_node(struct scic_sds_port *sci_port)
2244 {
2245         struct scic_sds_controller *scic = sci_port->owning_controller;
2246         u8 phys_index = sci_port->physical_port_index;
2247         union scu_remote_node_context *rnc;
2248         u16 rni = sci_port->reserved_rni;
2249         u32 command;
2250
2251         rnc = &scic->remote_node_context_table[rni];
2252         rnc->ssp.is_valid = true;
2253
2254         command = SCU_CONTEXT_COMMAND_POST_RNC_32 |
2255                   phys_index << SCU_CONTEXT_COMMAND_LOGICAL_PORT_SHIFT | rni;
2256
2257         scic_sds_controller_post_request(scic, command);
2258
2259         /* ensure hardware has seen the post rnc command and give it
2260          * ample time to act before sending the suspend
2261          */
2262         readl(&scic->smu_registers->interrupt_status); /* flush */
2263         udelay(10);
2264
2265         command = SCU_CONTEXT_COMMAND_POST_RNC_SUSPEND_TX_RX |
2266                   phys_index << SCU_CONTEXT_COMMAND_LOGICAL_PORT_SHIFT | rni;
2267
2268         scic_sds_controller_post_request(scic, command);
2269 }
2270
2271 /*
2272  * ******************************************************************************
2273  * *  PORT STATE METHODS
2274  * ****************************************************************************** */
2275
2276 /**
2277  *
2278  * @object: This is the object which is cast to a struct scic_sds_port object.
2279  *
2280  * This method will perform the actions required by the struct scic_sds_port on
2281  * entering the SCI_BASE_PORT_STATE_STOPPED. This function sets the stopped
2282  * state handlers for the struct scic_sds_port object and disables the port task
2283  * scheduler in the hardware. none
2284  */
2285 static void scic_sds_port_stopped_state_enter(void *object)
2286 {
2287         struct scic_sds_port *sci_port = object;
2288
2289         scic_sds_port_set_base_state_handlers(
2290                 sci_port, SCI_BASE_PORT_STATE_STOPPED
2291                 );
2292
2293         if (
2294                 SCI_BASE_PORT_STATE_STOPPING
2295                 == sci_port->state_machine.previous_state_id
2296                 ) {
2297                 /*
2298                  * If we enter this state becasuse of a request to stop
2299                  * the port then we want to disable the hardwares port
2300                  * task scheduler. */
2301                 scic_sds_port_disable_port_task_scheduler(sci_port);
2302         }
2303 }
2304
2305 /**
2306  *
2307  * @object: This is the object which is cast to a struct scic_sds_port object.
2308  *
2309  * This method will perform the actions required by the struct scic_sds_port on
2310  * exiting the SCI_BASE_STATE_STOPPED. This function enables the SCU hardware
2311  * port task scheduler. none
2312  */
2313 static void scic_sds_port_stopped_state_exit(void *object)
2314 {
2315         struct scic_sds_port *sci_port = object;
2316
2317         /* Enable and suspend the port task scheduler */
2318         scic_sds_port_enable_port_task_scheduler(sci_port);
2319 }
2320
2321 /**
2322  * scic_sds_port_ready_state_enter -
2323  * @object: This is the object which is cast to a struct scic_sds_port object.
2324  *
2325  * This method will perform the actions required by the struct scic_sds_port on
2326  * entering the SCI_BASE_PORT_STATE_READY. This function sets the ready state
2327  * handlers for the struct scic_sds_port object, reports the port object as
2328  * not ready and starts the ready substate machine. none
2329  */
2330 static void scic_sds_port_ready_state_enter(void *object)
2331 {
2332         struct scic_sds_port *sci_port = object;
2333         struct scic_sds_controller *scic = sci_port->owning_controller;
2334         struct isci_host *ihost = scic_to_ihost(scic);
2335         struct isci_port *iport = sci_port_to_iport(sci_port);
2336         u32 prev_state;
2337
2338         /* Put the ready state handlers in place though they will not be there long */
2339         scic_sds_port_set_base_state_handlers(sci_port, SCI_BASE_PORT_STATE_READY);
2340
2341         prev_state = sci_port->state_machine.previous_state_id;
2342         if (prev_state  == SCI_BASE_PORT_STATE_RESETTING)
2343                 isci_port_hard_reset_complete(iport, SCI_SUCCESS);
2344         else
2345                 isci_port_not_ready(ihost, iport);
2346
2347         /* Post and suspend the dummy remote node context for this port. */
2348         scic_sds_port_post_dummy_remote_node(sci_port);
2349
2350         /* Start the ready substate machine */
2351         port_state_machine_change(sci_port,
2352                                   SCIC_SDS_PORT_READY_SUBSTATE_WAITING);
2353 }
2354
2355 /**
2356  *
2357  * @object: This is the object which is cast to a struct scic_sds_port object.
2358  *
2359  * This method will perform the actions required by the struct scic_sds_port on
2360  * entering the SCI_BASE_PORT_STATE_RESETTING. This function sets the resetting
2361  * state handlers for the struct scic_sds_port object. none
2362  */
2363 static void scic_sds_port_resetting_state_enter(void *object)
2364 {
2365         struct scic_sds_port *sci_port = object;
2366
2367         scic_sds_port_set_base_state_handlers(
2368                 sci_port, SCI_BASE_PORT_STATE_RESETTING
2369                 );
2370 }
2371
2372 /**
2373  *
2374  * @object: This is the object which is cast to a struct scic_sds_port object.
2375  *
2376  * This function will perform the actions required by the
2377  * struct scic_sds_port on
2378  * exiting the SCI_BASE_STATE_RESETTING. This function does nothing. none
2379  */
2380 static inline void scic_sds_port_resetting_state_exit(void *object)
2381 {
2382         struct scic_sds_port *sci_port = object;
2383
2384         isci_timer_stop(sci_port->timer_handle);
2385 }
2386
2387 /**
2388  *
2389  * @object: This is the void object which is cast to a
2390  * struct scic_sds_port object.
2391  *
2392  * This method will perform the actions required by the struct scic_sds_port on
2393  * entering the SCI_BASE_PORT_STATE_STOPPING. This function sets the stopping
2394  * state handlers for the struct scic_sds_port object. none
2395  */
2396 static void scic_sds_port_stopping_state_enter(void *object)
2397 {
2398         struct scic_sds_port *sci_port = object;
2399
2400         scic_sds_port_set_base_state_handlers(
2401                 sci_port, SCI_BASE_PORT_STATE_STOPPING
2402                 );
2403 }
2404
2405 /**
2406  *
2407  * @object: This is the object which is cast to a struct scic_sds_port object.
2408  *
2409  * This function will perform the actions required by the
2410  * struct scic_sds_port on
2411  * exiting the SCI_BASE_STATE_STOPPING. This function does nothing. none
2412  */
2413 static inline void
2414 scic_sds_port_stopping_state_exit(void *object)
2415 {
2416         struct scic_sds_port *sci_port = object;
2417
2418         isci_timer_stop(sci_port->timer_handle);
2419
2420         scic_sds_port_destroy_dummy_resources(sci_port);
2421 }
2422
2423 /**
2424  *
2425  * @object: This is the object which is cast to a struct scic_sds_port object.
2426  *
2427  * This function will perform the actions required by the
2428  * struct scic_sds_port on
2429  * entering the SCI_BASE_PORT_STATE_STOPPING. This function sets the stopping
2430  * state handlers for the struct scic_sds_port object. none
2431  */
2432 static void scic_sds_port_failed_state_enter(void *object)
2433 {
2434         struct scic_sds_port *sci_port = object;
2435         struct isci_port *iport = sci_port_to_iport(sci_port);
2436
2437         scic_sds_port_set_base_state_handlers(sci_port,
2438                                               SCI_BASE_PORT_STATE_FAILED);
2439
2440         isci_port_hard_reset_complete(iport, SCI_FAILURE_TIMEOUT);
2441 }
2442
2443 /* --------------------------------------------------------------------------- */
2444
2445 static const struct sci_base_state scic_sds_port_state_table[] = {
2446         [SCI_BASE_PORT_STATE_STOPPED] = {
2447                 .enter_state = scic_sds_port_stopped_state_enter,
2448                 .exit_state  = scic_sds_port_stopped_state_exit
2449         },
2450         [SCI_BASE_PORT_STATE_STOPPING] = {
2451                 .enter_state = scic_sds_port_stopping_state_enter,
2452                 .exit_state  = scic_sds_port_stopping_state_exit
2453         },
2454         [SCI_BASE_PORT_STATE_READY] = {
2455                 .enter_state = scic_sds_port_ready_state_enter,
2456         },
2457         [SCIC_SDS_PORT_READY_SUBSTATE_WAITING] = {
2458                 .enter_state = scic_sds_port_ready_substate_waiting_enter,
2459         },
2460         [SCIC_SDS_PORT_READY_SUBSTATE_OPERATIONAL] = {
2461                 .enter_state = scic_sds_port_ready_substate_operational_enter,
2462                 .exit_state  = scic_sds_port_ready_substate_operational_exit
2463         },
2464         [SCIC_SDS_PORT_READY_SUBSTATE_CONFIGURING] = {
2465                 .enter_state = scic_sds_port_ready_substate_configuring_enter,
2466                 .exit_state  = scic_sds_port_ready_substate_configuring_exit
2467         },
2468         [SCI_BASE_PORT_STATE_RESETTING] = {
2469                 .enter_state = scic_sds_port_resetting_state_enter,
2470                 .exit_state  = scic_sds_port_resetting_state_exit
2471         },
2472         [SCI_BASE_PORT_STATE_FAILED] = {
2473                 .enter_state = scic_sds_port_failed_state_enter,
2474         }
2475 };
2476
2477 void scic_sds_port_construct(struct scic_sds_port *sci_port, u8 index,
2478                              struct scic_sds_controller *scic)
2479 {
2480         sci_base_state_machine_construct(&sci_port->state_machine,
2481                                          sci_port,
2482                                          scic_sds_port_state_table,
2483                                          SCI_BASE_PORT_STATE_STOPPED);
2484
2485         sci_base_state_machine_start(&sci_port->state_machine);
2486
2487         sci_port->logical_port_index  = SCIC_SDS_DUMMY_PORT;
2488         sci_port->physical_port_index = index;
2489         sci_port->active_phy_mask     = 0;
2490         sci_port->ready_exit          = false;
2491
2492         sci_port->owning_controller = scic;
2493
2494         sci_port->started_request_count = 0;
2495         sci_port->assigned_device_count = 0;
2496
2497         sci_port->reserved_rni = SCU_DUMMY_INDEX;
2498         sci_port->reserved_tci = SCU_DUMMY_INDEX;
2499
2500         sci_port->timer_handle = NULL;
2501         sci_port->port_task_scheduler_registers = NULL;
2502
2503         for (index = 0; index < SCI_MAX_PHYS; index++)
2504                 sci_port->phy_table[index] = NULL;
2505 }
2506
2507 void isci_port_init(struct isci_port *iport, struct isci_host *ihost, int index)
2508 {
2509         INIT_LIST_HEAD(&iport->remote_dev_list);
2510         INIT_LIST_HEAD(&iport->domain_dev_list);
2511         spin_lock_init(&iport->state_lock);
2512         init_completion(&iport->start_complete);
2513         iport->isci_host = ihost;
2514         isci_port_change_state(iport, isci_freed);
2515 }
2516
2517 /**
2518  * isci_port_get_state() - This function gets the status of the port object.
2519  * @isci_port: This parameter points to the isci_port object
2520  *
2521  * status of the object as a isci_status enum.
2522  */
2523 enum isci_status isci_port_get_state(
2524         struct isci_port *isci_port)
2525 {
2526         return isci_port->status;
2527 }
2528
2529 static void isci_port_bc_change_received(struct isci_host *ihost,
2530                                          struct scic_sds_port *sci_port,
2531                                          struct scic_sds_phy *sci_phy)
2532 {
2533         struct isci_phy *iphy = sci_phy_to_iphy(sci_phy);
2534
2535         dev_dbg(&ihost->pdev->dev, "%s: iphy = %p, sas_phy = %p\n",
2536                 __func__, iphy, &iphy->sas_phy);
2537
2538         ihost->sas_ha.notify_port_event(&iphy->sas_phy, PORTE_BROADCAST_RCVD);
2539         scic_port_enable_broadcast_change_notification(sci_port);
2540 }
2541
2542 void scic_sds_port_broadcast_change_received(
2543         struct scic_sds_port *sci_port,
2544         struct scic_sds_phy *sci_phy)
2545 {
2546         struct scic_sds_controller *scic = sci_port->owning_controller;
2547         struct isci_host *ihost = scic_to_ihost(scic);
2548
2549         /* notify the user. */
2550         isci_port_bc_change_received(ihost, sci_port, sci_phy);
2551 }
2552
2553 int isci_port_perform_hard_reset(struct isci_host *ihost, struct isci_port *iport,
2554                                  struct isci_phy *iphy)
2555 {
2556         unsigned long flags;
2557         enum sci_status status;
2558         int ret = TMF_RESP_FUNC_COMPLETE;
2559
2560         dev_dbg(&ihost->pdev->dev, "%s: iport = %p\n",
2561                 __func__, iport);
2562
2563         init_completion(&iport->hard_reset_complete);
2564
2565         spin_lock_irqsave(&ihost->scic_lock, flags);
2566
2567         #define ISCI_PORT_RESET_TIMEOUT SCIC_SDS_SIGNATURE_FIS_TIMEOUT
2568         status = scic_port_hard_reset(&iport->sci, ISCI_PORT_RESET_TIMEOUT);
2569
2570         spin_unlock_irqrestore(&ihost->scic_lock, flags);
2571
2572         if (status == SCI_SUCCESS) {
2573                 wait_for_completion(&iport->hard_reset_complete);
2574
2575                 dev_dbg(&ihost->pdev->dev,
2576                         "%s: iport = %p; hard reset completion\n",
2577                         __func__, iport);
2578
2579                 if (iport->hard_reset_status != SCI_SUCCESS)
2580                         ret = TMF_RESP_FUNC_FAILED;
2581         } else {
2582                 ret = TMF_RESP_FUNC_FAILED;
2583
2584                 dev_err(&ihost->pdev->dev,
2585                         "%s: iport = %p; scic_port_hard_reset call"
2586                         " failed 0x%x\n",
2587                         __func__, iport, status);
2588
2589         }
2590
2591         /* If the hard reset for the port has failed, consider this
2592          * the same as link failures on all phys in the port.
2593          */
2594         if (ret != TMF_RESP_FUNC_COMPLETE) {
2595                 dev_err(&ihost->pdev->dev,
2596                         "%s: iport = %p; hard reset failed "
2597                         "(0x%x) - sending link down to libsas for phy %p\n",
2598                         __func__, iport, iport->hard_reset_status, iphy);
2599
2600                 isci_port_link_down(ihost, iphy, iport);
2601         }
2602
2603         return ret;
2604 }
2605
2606 /**
2607  * isci_port_deformed() - This function is called by libsas when a port becomes
2608  *    inactive.
2609  * @phy: This parameter specifies the libsas phy with the inactive port.
2610  *
2611  */
2612 void isci_port_deformed(struct asd_sas_phy *phy)
2613 {
2614         pr_debug("%s: sas_phy = %p\n", __func__, phy);
2615 }
2616
2617 /**
2618  * isci_port_formed() - This function is called by libsas when a port becomes
2619  *    active.
2620  * @phy: This parameter specifies the libsas phy with the active port.
2621  *
2622  */
2623 void isci_port_formed(struct asd_sas_phy *phy)
2624 {
2625         pr_debug("%s: sas_phy = %p, sas_port = %p\n", __func__, phy, phy->port);
2626 }