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