1 /* 2 * Marvell 88E6xxx Address Translation Unit (ATU) support 3 * 4 * Copyright (c) 2008 Marvell Semiconductor 5 * Copyright (c) 2017 Savoir-faire Linux, Inc. 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2 of the License, or 10 * (at your option) any later version. 11 */ 12 #include <linux/interrupt.h> 13 #include <linux/irqdomain.h> 14 15 #include "chip.h" 16 #include "global1.h" 17 18 /* Offset 0x01: ATU FID Register */ 19 20 static int mv88e6xxx_g1_atu_fid_write(struct mv88e6xxx_chip *chip, u16 fid) 21 { 22 return mv88e6xxx_g1_write(chip, MV88E6352_G1_ATU_FID, fid & 0xfff); 23 } 24 25 /* Offset 0x0A: ATU Control Register */ 26 27 int mv88e6xxx_g1_atu_set_learn2all(struct mv88e6xxx_chip *chip, bool learn2all) 28 { 29 u16 val; 30 int err; 31 32 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_CTL, &val); 33 if (err) 34 return err; 35 36 if (learn2all) 37 val |= MV88E6XXX_G1_ATU_CTL_LEARN2ALL; 38 else 39 val &= ~MV88E6XXX_G1_ATU_CTL_LEARN2ALL; 40 41 return mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_CTL, val); 42 } 43 44 int mv88e6xxx_g1_atu_set_age_time(struct mv88e6xxx_chip *chip, 45 unsigned int msecs) 46 { 47 const unsigned int coeff = chip->info->age_time_coeff; 48 const unsigned int min = 0x01 * coeff; 49 const unsigned int max = 0xff * coeff; 50 u8 age_time; 51 u16 val; 52 int err; 53 54 if (msecs < min || msecs > max) 55 return -ERANGE; 56 57 /* Round to nearest multiple of coeff */ 58 age_time = (msecs + coeff / 2) / coeff; 59 60 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_CTL, &val); 61 if (err) 62 return err; 63 64 /* AgeTime is 11:4 bits */ 65 val &= ~0xff0; 66 val |= age_time << 4; 67 68 err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_CTL, val); 69 if (err) 70 return err; 71 72 dev_dbg(chip->dev, "AgeTime set to 0x%02x (%d ms)\n", age_time, 73 age_time * coeff); 74 75 return 0; 76 } 77 78 /* Offset 0x0B: ATU Operation Register */ 79 80 static int mv88e6xxx_g1_atu_op_wait(struct mv88e6xxx_chip *chip) 81 { 82 return mv88e6xxx_g1_wait(chip, MV88E6XXX_G1_ATU_OP, 83 MV88E6XXX_G1_ATU_OP_BUSY); 84 } 85 86 static int mv88e6xxx_g1_atu_op(struct mv88e6xxx_chip *chip, u16 fid, u16 op) 87 { 88 u16 val; 89 int err; 90 91 /* FID bits are dispatched all around gradually as more are supported */ 92 if (mv88e6xxx_num_databases(chip) > 256) { 93 err = mv88e6xxx_g1_atu_fid_write(chip, fid); 94 if (err) 95 return err; 96 } else { 97 if (mv88e6xxx_num_databases(chip) > 16) { 98 /* ATU DBNum[7:4] are located in ATU Control 15:12 */ 99 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_CTL, 100 &val); 101 if (err) 102 return err; 103 104 val = (val & 0x0fff) | ((fid << 8) & 0xf000); 105 err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_CTL, 106 val); 107 if (err) 108 return err; 109 } 110 111 /* ATU DBNum[3:0] are located in ATU Operation 3:0 */ 112 op |= fid & 0xf; 113 } 114 115 err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_OP, 116 MV88E6XXX_G1_ATU_OP_BUSY | op); 117 if (err) 118 return err; 119 120 return mv88e6xxx_g1_atu_op_wait(chip); 121 } 122 123 /* Offset 0x0C: ATU Data Register */ 124 125 static int mv88e6xxx_g1_atu_data_read(struct mv88e6xxx_chip *chip, 126 struct mv88e6xxx_atu_entry *entry) 127 { 128 u16 val; 129 int err; 130 131 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_DATA, &val); 132 if (err) 133 return err; 134 135 entry->state = val & 0xf; 136 if (entry->state != MV88E6XXX_G1_ATU_DATA_STATE_UNUSED) { 137 entry->trunk = !!(val & MV88E6XXX_G1_ATU_DATA_TRUNK); 138 entry->portvec = (val >> 4) & mv88e6xxx_port_mask(chip); 139 } 140 141 return 0; 142 } 143 144 static int mv88e6xxx_g1_atu_data_write(struct mv88e6xxx_chip *chip, 145 struct mv88e6xxx_atu_entry *entry) 146 { 147 u16 data = entry->state & 0xf; 148 149 if (entry->state != MV88E6XXX_G1_ATU_DATA_STATE_UNUSED) { 150 if (entry->trunk) 151 data |= MV88E6XXX_G1_ATU_DATA_TRUNK; 152 153 data |= (entry->portvec & mv88e6xxx_port_mask(chip)) << 4; 154 } 155 156 return mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_DATA, data); 157 } 158 159 /* Offset 0x0D: ATU MAC Address Register Bytes 0 & 1 160 * Offset 0x0E: ATU MAC Address Register Bytes 2 & 3 161 * Offset 0x0F: ATU MAC Address Register Bytes 4 & 5 162 */ 163 164 static int mv88e6xxx_g1_atu_mac_read(struct mv88e6xxx_chip *chip, 165 struct mv88e6xxx_atu_entry *entry) 166 { 167 u16 val; 168 int i, err; 169 170 for (i = 0; i < 3; i++) { 171 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_MAC01 + i, &val); 172 if (err) 173 return err; 174 175 entry->mac[i * 2] = val >> 8; 176 entry->mac[i * 2 + 1] = val & 0xff; 177 } 178 179 return 0; 180 } 181 182 static int mv88e6xxx_g1_atu_mac_write(struct mv88e6xxx_chip *chip, 183 struct mv88e6xxx_atu_entry *entry) 184 { 185 u16 val; 186 int i, err; 187 188 for (i = 0; i < 3; i++) { 189 val = (entry->mac[i * 2] << 8) | entry->mac[i * 2 + 1]; 190 err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_ATU_MAC01 + i, val); 191 if (err) 192 return err; 193 } 194 195 return 0; 196 } 197 198 /* Address Translation Unit operations */ 199 200 int mv88e6xxx_g1_atu_getnext(struct mv88e6xxx_chip *chip, u16 fid, 201 struct mv88e6xxx_atu_entry *entry) 202 { 203 int err; 204 205 err = mv88e6xxx_g1_atu_op_wait(chip); 206 if (err) 207 return err; 208 209 /* Write the MAC address to iterate from only once */ 210 if (entry->state == MV88E6XXX_G1_ATU_DATA_STATE_UNUSED) { 211 err = mv88e6xxx_g1_atu_mac_write(chip, entry); 212 if (err) 213 return err; 214 } 215 216 err = mv88e6xxx_g1_atu_op(chip, fid, MV88E6XXX_G1_ATU_OP_GET_NEXT_DB); 217 if (err) 218 return err; 219 220 err = mv88e6xxx_g1_atu_data_read(chip, entry); 221 if (err) 222 return err; 223 224 return mv88e6xxx_g1_atu_mac_read(chip, entry); 225 } 226 227 int mv88e6xxx_g1_atu_loadpurge(struct mv88e6xxx_chip *chip, u16 fid, 228 struct mv88e6xxx_atu_entry *entry) 229 { 230 int err; 231 232 err = mv88e6xxx_g1_atu_op_wait(chip); 233 if (err) 234 return err; 235 236 err = mv88e6xxx_g1_atu_mac_write(chip, entry); 237 if (err) 238 return err; 239 240 err = mv88e6xxx_g1_atu_data_write(chip, entry); 241 if (err) 242 return err; 243 244 return mv88e6xxx_g1_atu_op(chip, fid, MV88E6XXX_G1_ATU_OP_LOAD_DB); 245 } 246 247 static int mv88e6xxx_g1_atu_flushmove(struct mv88e6xxx_chip *chip, u16 fid, 248 struct mv88e6xxx_atu_entry *entry, 249 bool all) 250 { 251 u16 op; 252 int err; 253 254 err = mv88e6xxx_g1_atu_op_wait(chip); 255 if (err) 256 return err; 257 258 err = mv88e6xxx_g1_atu_data_write(chip, entry); 259 if (err) 260 return err; 261 262 /* Flush/Move all or non-static entries from all or a given database */ 263 if (all && fid) 264 op = MV88E6XXX_G1_ATU_OP_FLUSH_MOVE_ALL_DB; 265 else if (fid) 266 op = MV88E6XXX_G1_ATU_OP_FLUSH_MOVE_NON_STATIC_DB; 267 else if (all) 268 op = MV88E6XXX_G1_ATU_OP_FLUSH_MOVE_ALL; 269 else 270 op = MV88E6XXX_G1_ATU_OP_FLUSH_MOVE_NON_STATIC; 271 272 return mv88e6xxx_g1_atu_op(chip, fid, op); 273 } 274 275 int mv88e6xxx_g1_atu_flush(struct mv88e6xxx_chip *chip, u16 fid, bool all) 276 { 277 struct mv88e6xxx_atu_entry entry = { 278 .state = 0, /* Null EntryState means Flush */ 279 }; 280 281 return mv88e6xxx_g1_atu_flushmove(chip, fid, &entry, all); 282 } 283 284 static int mv88e6xxx_g1_atu_move(struct mv88e6xxx_chip *chip, u16 fid, 285 int from_port, int to_port, bool all) 286 { 287 struct mv88e6xxx_atu_entry entry = { 0 }; 288 unsigned long mask; 289 int shift; 290 291 if (!chip->info->atu_move_port_mask) 292 return -EOPNOTSUPP; 293 294 mask = chip->info->atu_move_port_mask; 295 shift = bitmap_weight(&mask, 16); 296 297 entry.state = 0xf, /* Full EntryState means Move */ 298 entry.portvec = from_port & mask; 299 entry.portvec |= (to_port & mask) << shift; 300 301 return mv88e6xxx_g1_atu_flushmove(chip, fid, &entry, all); 302 } 303 304 int mv88e6xxx_g1_atu_remove(struct mv88e6xxx_chip *chip, u16 fid, int port, 305 bool all) 306 { 307 int from_port = port; 308 int to_port = chip->info->atu_move_port_mask; 309 310 return mv88e6xxx_g1_atu_move(chip, fid, from_port, to_port, all); 311 } 312 313 static irqreturn_t mv88e6xxx_g1_atu_prob_irq_thread_fn(int irq, void *dev_id) 314 { 315 struct mv88e6xxx_chip *chip = dev_id; 316 struct mv88e6xxx_atu_entry entry; 317 int err; 318 u16 val; 319 320 mutex_lock(&chip->reg_lock); 321 322 err = mv88e6xxx_g1_atu_op(chip, 0, 323 MV88E6XXX_G1_ATU_OP_GET_CLR_VIOLATION); 324 if (err) 325 goto out; 326 327 err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_ATU_OP, &val); 328 if (err) 329 goto out; 330 331 err = mv88e6xxx_g1_atu_data_read(chip, &entry); 332 if (err) 333 goto out; 334 335 err = mv88e6xxx_g1_atu_mac_read(chip, &entry); 336 if (err) 337 goto out; 338 339 if (val & MV88E6XXX_G1_ATU_OP_AGE_OUT_VIOLATION) { 340 dev_err_ratelimited(chip->dev, 341 "ATU age out violation for %pM\n", 342 entry.mac); 343 } 344 345 if (val & MV88E6XXX_G1_ATU_OP_MEMBER_VIOLATION) { 346 dev_err_ratelimited(chip->dev, 347 "ATU member violation for %pM portvec %x\n", 348 entry.mac, entry.portvec); 349 chip->ports[entry.portvec].atu_member_violation++; 350 } 351 352 if (val & MV88E6XXX_G1_ATU_OP_MEMBER_VIOLATION) { 353 dev_err_ratelimited(chip->dev, 354 "ATU miss violation for %pM portvec %x\n", 355 entry.mac, entry.portvec); 356 chip->ports[entry.portvec].atu_miss_violation++; 357 } 358 359 if (val & MV88E6XXX_G1_ATU_OP_FULL_VIOLATION) { 360 dev_err_ratelimited(chip->dev, 361 "ATU full violation for %pM portvec %x\n", 362 entry.mac, entry.portvec); 363 chip->ports[entry.portvec].atu_full_violation++; 364 } 365 mutex_unlock(&chip->reg_lock); 366 367 return IRQ_HANDLED; 368 369 out: 370 mutex_unlock(&chip->reg_lock); 371 372 dev_err(chip->dev, "ATU problem: error %d while handling interrupt\n", 373 err); 374 return IRQ_HANDLED; 375 } 376 377 int mv88e6xxx_g1_atu_prob_irq_setup(struct mv88e6xxx_chip *chip) 378 { 379 int err; 380 381 chip->atu_prob_irq = irq_find_mapping(chip->g1_irq.domain, 382 MV88E6XXX_G1_STS_IRQ_ATU_PROB); 383 if (chip->atu_prob_irq < 0) 384 return chip->atu_prob_irq; 385 386 err = request_threaded_irq(chip->atu_prob_irq, NULL, 387 mv88e6xxx_g1_atu_prob_irq_thread_fn, 388 IRQF_ONESHOT, "mv88e6xxx-g1-atu-prob", 389 chip); 390 if (err) 391 irq_dispose_mapping(chip->atu_prob_irq); 392 393 return err; 394 } 395 396 void mv88e6xxx_g1_atu_prob_irq_free(struct mv88e6xxx_chip *chip) 397 { 398 free_irq(chip->atu_prob_irq, chip); 399 irq_dispose_mapping(chip->atu_prob_irq); 400 } 401