1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (C) 2023 Intel Corporation */
3
4 #include "idpf.h"
5 #include "idpf_lan_vf_regs.h"
6 #include "idpf_virtchnl.h"
7
8 #define IDPF_VF_ITR_IDX_SPACING 0x40
9
10 /**
11 * idpf_vf_ctlq_reg_init - initialize default mailbox registers
12 * @adapter: adapter structure
13 * @cq: pointer to the array of create control queues
14 */
idpf_vf_ctlq_reg_init(struct idpf_adapter * adapter,struct idpf_ctlq_create_info * cq)15 static void idpf_vf_ctlq_reg_init(struct idpf_adapter *adapter,
16 struct idpf_ctlq_create_info *cq)
17 {
18 resource_size_t mbx_start = adapter->dev_ops.static_reg_info[0].start;
19 int i;
20
21 for (i = 0; i < IDPF_NUM_DFLT_MBX_Q; i++) {
22 struct idpf_ctlq_create_info *ccq = cq + i;
23
24 switch (ccq->type) {
25 case IDPF_CTLQ_TYPE_MAILBOX_TX:
26 /* set head and tail registers in our local struct */
27 ccq->reg.head = VF_ATQH - mbx_start;
28 ccq->reg.tail = VF_ATQT - mbx_start;
29 ccq->reg.len = VF_ATQLEN - mbx_start;
30 ccq->reg.bah = VF_ATQBAH - mbx_start;
31 ccq->reg.bal = VF_ATQBAL - mbx_start;
32 ccq->reg.len_mask = VF_ATQLEN_ATQLEN_M;
33 ccq->reg.len_ena_mask = VF_ATQLEN_ATQENABLE_M;
34 ccq->reg.head_mask = VF_ATQH_ATQH_M;
35 break;
36 case IDPF_CTLQ_TYPE_MAILBOX_RX:
37 /* set head and tail registers in our local struct */
38 ccq->reg.head = VF_ARQH - mbx_start;
39 ccq->reg.tail = VF_ARQT - mbx_start;
40 ccq->reg.len = VF_ARQLEN - mbx_start;
41 ccq->reg.bah = VF_ARQBAH - mbx_start;
42 ccq->reg.bal = VF_ARQBAL - mbx_start;
43 ccq->reg.len_mask = VF_ARQLEN_ARQLEN_M;
44 ccq->reg.len_ena_mask = VF_ARQLEN_ARQENABLE_M;
45 ccq->reg.head_mask = VF_ARQH_ARQH_M;
46 break;
47 default:
48 break;
49 }
50 }
51 }
52
53 /**
54 * idpf_vf_mb_intr_reg_init - Initialize the mailbox register
55 * @adapter: adapter structure
56 */
idpf_vf_mb_intr_reg_init(struct idpf_adapter * adapter)57 static void idpf_vf_mb_intr_reg_init(struct idpf_adapter *adapter)
58 {
59 struct idpf_intr_reg *intr = &adapter->mb_vector.intr_reg;
60 u32 dyn_ctl = le32_to_cpu(adapter->caps.mailbox_dyn_ctl);
61
62 intr->dyn_ctl = idpf_get_reg_addr(adapter, dyn_ctl);
63 intr->dyn_ctl_intena_m = VF_INT_DYN_CTL0_INTENA_M;
64 intr->dyn_ctl_itridx_m = VF_INT_DYN_CTL0_ITR_INDX_M;
65 intr->icr_ena = idpf_get_reg_addr(adapter, VF_INT_ICR0_ENA1);
66 intr->icr_ena_ctlq_m = VF_INT_ICR0_ENA1_ADMINQ_M;
67 }
68
69 /**
70 * idpf_vf_intr_reg_init - Initialize interrupt registers
71 * @vport: virtual port structure
72 */
idpf_vf_intr_reg_init(struct idpf_vport * vport)73 static int idpf_vf_intr_reg_init(struct idpf_vport *vport)
74 {
75 struct idpf_adapter *adapter = vport->adapter;
76 int num_vecs = vport->num_q_vectors;
77 struct idpf_vec_regs *reg_vals;
78 int num_regs, i, err = 0;
79 u32 rx_itr, tx_itr;
80 u16 total_vecs;
81
82 total_vecs = idpf_get_reserved_vecs(vport->adapter);
83 reg_vals = kcalloc(total_vecs, sizeof(struct idpf_vec_regs),
84 GFP_KERNEL);
85 if (!reg_vals)
86 return -ENOMEM;
87
88 num_regs = idpf_get_reg_intr_vecs(vport, reg_vals);
89 if (num_regs < num_vecs) {
90 err = -EINVAL;
91 goto free_reg_vals;
92 }
93
94 for (i = 0; i < num_vecs; i++) {
95 struct idpf_q_vector *q_vector = &vport->q_vectors[i];
96 u16 vec_id = vport->q_vector_idxs[i] - IDPF_MBX_Q_VEC;
97 struct idpf_intr_reg *intr = &q_vector->intr_reg;
98 u32 spacing;
99
100 intr->dyn_ctl = idpf_get_reg_addr(adapter,
101 reg_vals[vec_id].dyn_ctl_reg);
102 intr->dyn_ctl_intena_m = VF_INT_DYN_CTLN_INTENA_M;
103 intr->dyn_ctl_intena_msk_m = VF_INT_DYN_CTLN_INTENA_MSK_M;
104 intr->dyn_ctl_itridx_s = VF_INT_DYN_CTLN_ITR_INDX_S;
105 intr->dyn_ctl_intrvl_s = VF_INT_DYN_CTLN_INTERVAL_S;
106 intr->dyn_ctl_wb_on_itr_m = VF_INT_DYN_CTLN_WB_ON_ITR_M;
107 intr->dyn_ctl_swint_trig_m = VF_INT_DYN_CTLN_SWINT_TRIG_M;
108 intr->dyn_ctl_sw_itridx_ena_m =
109 VF_INT_DYN_CTLN_SW_ITR_INDX_ENA_M;
110
111 spacing = IDPF_ITR_IDX_SPACING(reg_vals[vec_id].itrn_index_spacing,
112 IDPF_VF_ITR_IDX_SPACING);
113 rx_itr = VF_INT_ITRN_ADDR(VIRTCHNL2_ITR_IDX_0,
114 reg_vals[vec_id].itrn_reg,
115 spacing);
116 tx_itr = VF_INT_ITRN_ADDR(VIRTCHNL2_ITR_IDX_1,
117 reg_vals[vec_id].itrn_reg,
118 spacing);
119 intr->rx_itr = idpf_get_reg_addr(adapter, rx_itr);
120 intr->tx_itr = idpf_get_reg_addr(adapter, tx_itr);
121 }
122
123 free_reg_vals:
124 kfree(reg_vals);
125
126 return err;
127 }
128
129 /**
130 * idpf_vf_reset_reg_init - Initialize reset registers
131 * @adapter: Driver specific private structure
132 */
idpf_vf_reset_reg_init(struct idpf_adapter * adapter)133 static void idpf_vf_reset_reg_init(struct idpf_adapter *adapter)
134 {
135 adapter->reset_reg.rstat = idpf_get_rstat_reg_addr(adapter, VFGEN_RSTAT);
136 adapter->reset_reg.rstat_m = VFGEN_RSTAT_VFR_STATE_M;
137 }
138
139 /**
140 * idpf_vf_trigger_reset - trigger reset
141 * @adapter: Driver specific private structure
142 * @trig_cause: Reason to trigger a reset
143 */
idpf_vf_trigger_reset(struct idpf_adapter * adapter,enum idpf_flags trig_cause)144 static void idpf_vf_trigger_reset(struct idpf_adapter *adapter,
145 enum idpf_flags trig_cause)
146 {
147 /* Do not send VIRTCHNL2_OP_RESET_VF message on driver unload */
148 if (trig_cause == IDPF_HR_FUNC_RESET &&
149 !test_bit(IDPF_REMOVE_IN_PROG, adapter->flags))
150 idpf_send_mb_msg(adapter, VIRTCHNL2_OP_RESET_VF, 0, NULL, 0);
151 }
152
153 /**
154 * idpf_idc_vf_register - register for IDC callbacks
155 * @adapter: Driver specific private structure
156 *
157 * Return: 0 on success or error code on failure.
158 */
idpf_idc_vf_register(struct idpf_adapter * adapter)159 static int idpf_idc_vf_register(struct idpf_adapter *adapter)
160 {
161 return idpf_idc_init_aux_core_dev(adapter, IIDC_FUNCTION_TYPE_VF);
162 }
163
164 /**
165 * idpf_vf_reg_ops_init - Initialize register API function pointers
166 * @adapter: Driver specific private structure
167 */
idpf_vf_reg_ops_init(struct idpf_adapter * adapter)168 static void idpf_vf_reg_ops_init(struct idpf_adapter *adapter)
169 {
170 adapter->dev_ops.reg_ops.ctlq_reg_init = idpf_vf_ctlq_reg_init;
171 adapter->dev_ops.reg_ops.intr_reg_init = idpf_vf_intr_reg_init;
172 adapter->dev_ops.reg_ops.mb_intr_reg_init = idpf_vf_mb_intr_reg_init;
173 adapter->dev_ops.reg_ops.reset_reg_init = idpf_vf_reset_reg_init;
174 adapter->dev_ops.reg_ops.trigger_reset = idpf_vf_trigger_reset;
175 }
176
177 /**
178 * idpf_vf_dev_ops_init - Initialize device API function pointers
179 * @adapter: Driver specific private structure
180 */
idpf_vf_dev_ops_init(struct idpf_adapter * adapter)181 void idpf_vf_dev_ops_init(struct idpf_adapter *adapter)
182 {
183 idpf_vf_reg_ops_init(adapter);
184
185 adapter->dev_ops.idc_init = idpf_idc_vf_register;
186
187 resource_set_range(&adapter->dev_ops.static_reg_info[0],
188 VF_BASE, IDPF_VF_MBX_REGION_SZ);
189 resource_set_range(&adapter->dev_ops.static_reg_info[1],
190 VFGEN_RSTAT, IDPF_VF_RSTAT_REGION_SZ);
191 }
192