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