drivers/ufs/host/ufshcd-dwc.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * UFS Host driver for Synopsys Designware Core
   4  *
   5  * Copyright (C) 2015-2016 Synopsys, Inc. (www.synopsys.com)
   6  *
   7  * Authors: Joao Pinto <[email protected]>
   8  */
   9
  10 #include <linux/module.h>
  11
  12 #include <ufs/ufshcd.h>
  13 #include <ufs/unipro.h>
  14
  15 #include "ufshcd-dwc.h"
  16 #include "ufshci-dwc.h"
  17
  18 int ufshcd_dwc_dme_set_attrs(struct ufs_hba *hba,
  19                                 const struct ufshcd_dme_attr_val *v, int n)
  20 {
  21         int ret = 0;
  22         int attr_node = 0;
  23
  24         for (attr_node = 0; attr_node < n; attr_node++) {
  25                 ret = ufshcd_dme_set_attr(hba, v[attr_node].attr_sel,
  26                         ATTR_SET_NOR, v[attr_node].mib_val, v[attr_node].peer);
  27
  28                 if (ret)
  29                         return ret;
  30         }
  31
  32         return 0;
  33 }
  34 EXPORT_SYMBOL(ufshcd_dwc_dme_set_attrs);
  35
  36 /**
  37  * ufshcd_dwc_program_clk_div()
  38  * This function programs the clk divider value. This value is needed to
  39  * provide 1 microsecond tick to unipro layer.
  40  * @hba: Private Structure pointer
  41  * @divider_val: clock divider value to be programmed
  42  *
  43  */
  44 static void ufshcd_dwc_program_clk_div(struct ufs_hba *hba, u32 divider_val)
  45 {
  46         ufshcd_writel(hba, divider_val, DWC_UFS_REG_HCLKDIV);
  47 }
  48
  49 /**
  50  * ufshcd_dwc_link_is_up()
  51  * Check if link is up
  52  * @hba: private structure pointer
  53  *
  54  * Returns 0 on success, non-zero value on failure
  55  */
  56 static int ufshcd_dwc_link_is_up(struct ufs_hba *hba)
  57 {
  58         int dme_result = 0;
  59
  60         ufshcd_dme_get(hba, UIC_ARG_MIB(VS_POWERSTATE), &dme_result);
  61
  62         if (dme_result == UFSHCD_LINK_IS_UP) {
  63                 ufshcd_set_link_active(hba);
  64                 return 0;
  65         }
  66
  67         return 1;
  68 }
  69
  70 /**
  71  * ufshcd_dwc_connection_setup()
  72  * This function configures both the local side (host) and the peer side
  73  * (device) unipro attributes to establish the connection to application/
  74  * cport.
  75  * This function is not required if the hardware is properly configured to
  76  * have this connection setup on reset. But invoking this function does no
  77  * harm and should be fine even working with any ufs device.
  78  *
  79  * @hba: pointer to drivers private data
  80  *
  81  * Returns 0 on success non-zero value on failure
  82  */
  83 static int ufshcd_dwc_connection_setup(struct ufs_hba *hba)
  84 {
  85         static const struct ufshcd_dme_attr_val setup_attrs[] = {
  86                 { UIC_ARG_MIB(T_CONNECTIONSTATE), 0, DME_LOCAL },
  87                 { UIC_ARG_MIB(N_DEVICEID), 0, DME_LOCAL },
  88                 { UIC_ARG_MIB(N_DEVICEID_VALID), 0, DME_LOCAL },
  89                 { UIC_ARG_MIB(T_PEERDEVICEID), 1, DME_LOCAL },
  90                 { UIC_ARG_MIB(T_PEERCPORTID), 0, DME_LOCAL },
  91                 { UIC_ARG_MIB(T_TRAFFICCLASS), 0, DME_LOCAL },
  92                 { UIC_ARG_MIB(T_CPORTFLAGS), 0x6, DME_LOCAL },
  93                 { UIC_ARG_MIB(T_CPORTMODE), 1, DME_LOCAL },
  94                 { UIC_ARG_MIB(T_CONNECTIONSTATE), 1, DME_LOCAL },
  95                 { UIC_ARG_MIB(T_CONNECTIONSTATE), 0, DME_PEER },
  96                 { UIC_ARG_MIB(N_DEVICEID), 1, DME_PEER },
  97                 { UIC_ARG_MIB(N_DEVICEID_VALID), 1, DME_PEER },
  98                 { UIC_ARG_MIB(T_PEERDEVICEID), 1, DME_PEER },
  99                 { UIC_ARG_MIB(T_PEERCPORTID), 0, DME_PEER },
 100                 { UIC_ARG_MIB(T_TRAFFICCLASS), 0, DME_PEER },
 101                 { UIC_ARG_MIB(T_CPORTFLAGS), 0x6, DME_PEER },
 102                 { UIC_ARG_MIB(T_CPORTMODE), 1, DME_PEER },
 103                 { UIC_ARG_MIB(T_CONNECTIONSTATE), 1, DME_PEER }
 104         };
 105
 106         return ufshcd_dwc_dme_set_attrs(hba, setup_attrs, ARRAY_SIZE(setup_attrs));
 107 }
 108
 109 /**
 110  * ufshcd_dwc_link_startup_notify()
 111  * UFS Host DWC specific link startup sequence
 112  * @hba: private structure pointer
 113  * @status: Callback notify status
 114  *
 115  * Returns 0 on success, non-zero value on failure
 116  */
 117 int ufshcd_dwc_link_startup_notify(struct ufs_hba *hba,
 118                                         enum ufs_notify_change_status status)
 119 {
 120         int err = 0;
 121
 122         if (status == PRE_CHANGE) {
 123                 ufshcd_dwc_program_clk_div(hba, DWC_UFS_REG_HCLKDIV_DIV_125);
 124
 125                 err = ufshcd_vops_phy_initialization(hba);
 126                 if (err) {
 127                         dev_err(hba->dev, "Phy setup failed (%d)\n", err);
 128                         goto out;
 129                 }
 130         } else { /* POST_CHANGE */
 131                 err = ufshcd_dwc_link_is_up(hba);
 132                 if (err) {
 133                         dev_err(hba->dev, "Link is not up\n");
 134                         goto out;
 135                 }
 136
 137                 err = ufshcd_dwc_connection_setup(hba);
 138                 if (err)
 139                         dev_err(hba->dev, "Connection setup failed (%d)\n",
 140                                                                         err);
 141         }
 142
 143 out:
 144         return err;
 145 }
 146 EXPORT_SYMBOL(ufshcd_dwc_link_startup_notify);
 147
 148 MODULE_AUTHOR("Joao Pinto <[email protected]>");
 149 MODULE_DESCRIPTION("UFS Host driver for Synopsys Designware Core");
 150 MODULE_LICENSE("Dual BSD/GPL");