1 // SPDX-License-Identifier: GPL-2.0+ 2 3 #include "lan966x_main.h" 4 5 /* 0-8 : 9 port policers */ 6 #define POL_IDX_PORT 0 7 8 /* Policer order: Serial (QoS -> Port -> VCAP) */ 9 #define POL_ORDER 0x1d3 10 11 struct lan966x_tc_policer { 12 /* kilobit per second */ 13 u32 rate; 14 /* bytes */ 15 u32 burst; 16 }; 17 18 static int lan966x_police_add(struct lan966x_port *port, 19 struct lan966x_tc_policer *pol, 20 u16 pol_idx) 21 { 22 struct lan966x *lan966x = port->lan966x; 23 24 /* Rate unit is 33 1/3 kpps */ 25 pol->rate = DIV_ROUND_UP(pol->rate * 3, 100); 26 /* Avoid zero burst size */ 27 pol->burst = pol->burst ?: 1; 28 /* Unit is 4kB */ 29 pol->burst = DIV_ROUND_UP(pol->burst, 4096); 30 31 if (pol->rate > GENMASK(15, 0) || 32 pol->burst > GENMASK(6, 0)) 33 return -EINVAL; 34 35 lan_wr(ANA_POL_MODE_DROP_ON_YELLOW_ENA_SET(0) | 36 ANA_POL_MODE_MARK_ALL_FRMS_RED_ENA_SET(0) | 37 ANA_POL_MODE_IPG_SIZE_SET(20) | 38 ANA_POL_MODE_FRM_MODE_SET(1) | 39 ANA_POL_MODE_OVERSHOOT_ENA_SET(1), 40 lan966x, ANA_POL_MODE(pol_idx)); 41 42 lan_wr(ANA_POL_PIR_STATE_PIR_LVL_SET(0), 43 lan966x, ANA_POL_PIR_STATE(pol_idx)); 44 45 lan_wr(ANA_POL_PIR_CFG_PIR_RATE_SET(pol->rate) | 46 ANA_POL_PIR_CFG_PIR_BURST_SET(pol->burst), 47 lan966x, ANA_POL_PIR_CFG(pol_idx)); 48 49 return 0; 50 } 51 52 static int lan966x_police_del(struct lan966x_port *port, 53 u16 pol_idx) 54 { 55 struct lan966x *lan966x = port->lan966x; 56 57 lan_wr(ANA_POL_MODE_DROP_ON_YELLOW_ENA_SET(0) | 58 ANA_POL_MODE_MARK_ALL_FRMS_RED_ENA_SET(0) | 59 ANA_POL_MODE_IPG_SIZE_SET(20) | 60 ANA_POL_MODE_FRM_MODE_SET(2) | 61 ANA_POL_MODE_OVERSHOOT_ENA_SET(1), 62 lan966x, ANA_POL_MODE(pol_idx)); 63 64 lan_wr(ANA_POL_PIR_STATE_PIR_LVL_SET(0), 65 lan966x, ANA_POL_PIR_STATE(pol_idx)); 66 67 lan_wr(ANA_POL_PIR_CFG_PIR_RATE_SET(GENMASK(14, 0)) | 68 ANA_POL_PIR_CFG_PIR_BURST_SET(0), 69 lan966x, ANA_POL_PIR_CFG(pol_idx)); 70 71 return 0; 72 } 73 74 static int lan966x_police_validate(struct lan966x_port *port, 75 const struct flow_action *action, 76 const struct flow_action_entry *act, 77 unsigned long police_id, 78 bool ingress, 79 struct netlink_ext_ack *extack) 80 { 81 if (act->police.exceed.act_id != FLOW_ACTION_DROP) { 82 NL_SET_ERR_MSG_MOD(extack, 83 "Offload not supported when exceed action is not drop"); 84 return -EOPNOTSUPP; 85 } 86 87 if (act->police.notexceed.act_id != FLOW_ACTION_PIPE && 88 act->police.notexceed.act_id != FLOW_ACTION_ACCEPT) { 89 NL_SET_ERR_MSG_MOD(extack, 90 "Offload not supported when conform action is not pipe or ok"); 91 return -EOPNOTSUPP; 92 } 93 94 if (act->police.notexceed.act_id == FLOW_ACTION_ACCEPT && 95 !flow_action_is_last_entry(action, act)) { 96 NL_SET_ERR_MSG_MOD(extack, 97 "Offload not supported when conform action is ok, but action is not last"); 98 return -EOPNOTSUPP; 99 } 100 101 if (act->police.peakrate_bytes_ps || 102 act->police.avrate || act->police.overhead) { 103 NL_SET_ERR_MSG_MOD(extack, 104 "Offload not supported when peakrate/avrate/overhead is configured"); 105 return -EOPNOTSUPP; 106 } 107 108 if (act->police.rate_pkt_ps) { 109 NL_SET_ERR_MSG_MOD(extack, 110 "QoS offload not support packets per second"); 111 return -EOPNOTSUPP; 112 } 113 114 if (!ingress) { 115 NL_SET_ERR_MSG_MOD(extack, 116 "Policer is not supported on egress"); 117 return -EOPNOTSUPP; 118 } 119 120 if (port->tc.ingress_shared_block) { 121 NL_SET_ERR_MSG_MOD(extack, 122 "Policer is not supported on shared ingress blocks"); 123 return -EOPNOTSUPP; 124 } 125 126 if (port->tc.police_id && port->tc.police_id != police_id) { 127 NL_SET_ERR_MSG_MOD(extack, 128 "Only one policer per port is supported"); 129 return -EEXIST; 130 } 131 132 return 0; 133 } 134 135 int lan966x_police_port_add(struct lan966x_port *port, 136 struct flow_action *action, 137 struct flow_action_entry *act, 138 unsigned long police_id, 139 bool ingress, 140 struct netlink_ext_ack *extack) 141 { 142 struct lan966x *lan966x = port->lan966x; 143 struct rtnl_link_stats64 new_stats; 144 struct lan966x_tc_policer pol; 145 struct flow_stats *old_stats; 146 int err; 147 148 err = lan966x_police_validate(port, action, act, police_id, ingress, 149 extack); 150 if (err) 151 return err; 152 153 memset(&pol, 0, sizeof(pol)); 154 155 pol.rate = div_u64(act->police.rate_bytes_ps, 1000) * 8; 156 pol.burst = act->police.burst; 157 158 err = lan966x_police_add(port, &pol, POL_IDX_PORT + port->chip_port); 159 if (err) { 160 NL_SET_ERR_MSG_MOD(extack, 161 "Failed to add policer to port"); 162 return err; 163 } 164 165 lan_rmw(ANA_POL_CFG_PORT_POL_ENA_SET(1) | 166 ANA_POL_CFG_POL_ORDER_SET(POL_ORDER), 167 ANA_POL_CFG_PORT_POL_ENA | 168 ANA_POL_CFG_POL_ORDER, 169 lan966x, ANA_POL_CFG(port->chip_port)); 170 171 port->tc.police_id = police_id; 172 173 /* Setup initial stats */ 174 old_stats = &port->tc.police_stat; 175 lan966x_stats_get(port->dev, &new_stats); 176 old_stats->bytes = new_stats.rx_bytes; 177 old_stats->pkts = new_stats.rx_packets; 178 old_stats->drops = new_stats.rx_dropped; 179 old_stats->lastused = jiffies; 180 181 return 0; 182 } 183 184 int lan966x_police_port_del(struct lan966x_port *port, 185 unsigned long police_id, 186 struct netlink_ext_ack *extack) 187 { 188 struct lan966x *lan966x = port->lan966x; 189 int err; 190 191 if (port->tc.police_id != police_id) { 192 NL_SET_ERR_MSG_MOD(extack, 193 "Invalid policer id"); 194 return -EINVAL; 195 } 196 197 err = lan966x_police_del(port, POL_IDX_PORT + port->chip_port); 198 if (err) { 199 NL_SET_ERR_MSG_MOD(extack, 200 "Failed to add policer to port"); 201 return err; 202 } 203 204 lan_rmw(ANA_POL_CFG_PORT_POL_ENA_SET(0) | 205 ANA_POL_CFG_POL_ORDER_SET(POL_ORDER), 206 ANA_POL_CFG_PORT_POL_ENA | 207 ANA_POL_CFG_POL_ORDER, 208 lan966x, ANA_POL_CFG(port->chip_port)); 209 210 port->tc.police_id = 0; 211 212 return 0; 213 } 214 215 void lan966x_police_port_stats(struct lan966x_port *port, 216 struct flow_stats *stats) 217 { 218 struct rtnl_link_stats64 new_stats; 219 struct flow_stats *old_stats; 220 221 old_stats = &port->tc.police_stat; 222 lan966x_stats_get(port->dev, &new_stats); 223 224 flow_stats_update(stats, 225 new_stats.rx_bytes - old_stats->bytes, 226 new_stats.rx_packets - old_stats->pkts, 227 new_stats.rx_dropped - old_stats->drops, 228 old_stats->lastused, 229 FLOW_ACTION_HW_STATS_IMMEDIATE); 230 231 old_stats->bytes = new_stats.rx_bytes; 232 old_stats->pkts = new_stats.rx_packets; 233 old_stats->drops = new_stats.rx_dropped; 234 old_stats->lastused = jiffies; 235 } 236