microchip/lan966x/lan966x_mac.c

35 static int lan966x_mac_get_status(struct lan966x *lan966x)
37 	return lan_rd(lan966x, ANA_MACACCESS);
40 static int lan966x_mac_wait_for_completion(struct lan966x *lan966x)
45 					 lan966x, val,
52 static void lan966x_mac_select(struct lan966x *lan966x,
69 	lan_wr(macl, lan966x, ANA_MACLDATA);
70 	lan_wr(mach, lan966x, ANA_MACHDATA);
73 static int __lan966x_mac_learn_locked(struct lan966x *lan966x, int pgid,
79 	lockdep_assert_held(&lan966x->mac_lock);
81 	lan966x_mac_select(lan966x, mac, vid);
90 	       lan966x, ANA_MACACCESS);
92 	return lan966x_mac_wait_for_completion(lan966x);
95 static int __lan966x_mac_learn(struct lan966x *lan966x, int pgid,
103 	spin_lock(&lan966x->mac_lock);
104 	ret = __lan966x_mac_learn_locked(lan966x, pgid, cpu_copy, mac, vid, type);
105 	spin_unlock(&lan966x->mac_lock);
113 int lan966x_mac_ip_learn(struct lan966x *lan966x,
121 	return __lan966x_mac_learn(lan966x, 0, cpu_copy, mac, vid, type);
124 int lan966x_mac_learn(struct lan966x *lan966x, int port,
131 	return __lan966x_mac_learn(lan966x, port, false, mac, vid, type);
134 static int lan966x_mac_learn_locked(struct lan966x *lan966x, int port,
141 	return __lan966x_mac_learn_locked(lan966x, port, false, mac, vid, type);
144 static int lan966x_mac_forget_locked(struct lan966x *lan966x,
149 	lockdep_assert_held(&lan966x->mac_lock);
151 	lan966x_mac_select(lan966x, mac, vid);
156 	       lan966x, ANA_MACACCESS);
158 	return lan966x_mac_wait_for_completion(lan966x);
161 int lan966x_mac_forget(struct lan966x *lan966x,
168 	spin_lock(&lan966x->mac_lock);
169 	ret = lan966x_mac_forget_locked(lan966x, mac, vid, type);
170 	spin_unlock(&lan966x->mac_lock);
175 int lan966x_mac_cpu_learn(struct lan966x *lan966x, const char *addr, u16 vid)
177 	return lan966x_mac_learn(lan966x, PGID_CPU, addr, vid, ENTRYTYPE_LOCKED);
180 int lan966x_mac_cpu_forget(struct lan966x *lan966x, const char *addr, u16 vid)
182 	return lan966x_mac_forget(lan966x, addr, vid, ENTRYTYPE_LOCKED);
185 void lan966x_mac_set_ageing(struct lan966x *lan966x,
190 		lan966x, ANA_AUTOAGE);
193 void lan966x_mac_init(struct lan966x *lan966x)
196 	lan_wr(MACACCESS_CMD_INIT, lan966x, ANA_MACACCESS);
197 	lan966x_mac_wait_for_completion(lan966x);
199 	spin_lock_init(&lan966x->mac_lock);
200 	INIT_LIST_HEAD(&lan966x->mac_entries);
221 static struct lan966x_mac_entry *lan966x_mac_find_entry(struct lan966x *lan966x,
228 	list_for_each_entry(mac_entry, &lan966x->mac_entries, list) {
240 static int lan966x_mac_lookup(struct lan966x *lan966x,
246 	lan966x_mac_select(lan966x, mac, vid);
252 	       lan966x, ANA_MACACCESS);
254 	ret = lan966x_mac_wait_for_completion(lan966x);
258 	return ANA_MACACCESS_VALID_GET(lan_rd(lan966x, ANA_MACACCESS));
273 int lan966x_mac_add_entry(struct lan966x *lan966x, struct lan966x_port *port,
278 	spin_lock(&lan966x->mac_lock);
279 	if (lan966x_mac_lookup(lan966x, addr, vid, ENTRYTYPE_NORMAL)) {
280 		spin_unlock(&lan966x->mac_lock);
290 	mac_entry = lan966x_mac_find_entry(lan966x, addr, vid, port->chip_port);
292 		spin_unlock(&lan966x->mac_lock);
298 		spin_unlock(&lan966x->mac_lock);
302 	list_add_tail(&mac_entry->list, &lan966x->mac_entries);
303 	spin_unlock(&lan966x->mac_lock);
309 	lan966x_mac_learn(lan966x, port->chip_port, addr, vid, ENTRYTYPE_LOCKED);
314 int lan966x_mac_del_entry(struct lan966x *lan966x, const unsigned char *addr,
319 	spin_lock(&lan966x->mac_lock);
320 	list_for_each_entry_safe(mac_entry, tmp, &lan966x->mac_entries,
324 			lan966x_mac_forget_locked(lan966x, mac_entry->mac,
332 	spin_unlock(&lan966x->mac_lock);
337 void lan966x_mac_lag_replace_port_entry(struct lan966x *lan966x,
343 	spin_lock(&lan966x->mac_lock);
344 	list_for_each_entry(mac_entry, &lan966x->mac_entries, list) {
347 			lan966x_mac_forget_locked(lan966x, mac_entry->mac,
351 			lan966x_mac_learn_locked(lan966x, dst->chip_port,
357 	spin_unlock(&lan966x->mac_lock);
360 void lan966x_mac_lag_remove_port_entry(struct lan966x *lan966x,
365 	spin_lock(&lan966x->mac_lock);
366 	list_for_each_entry_safe(mac_entry, tmp, &lan966x->mac_entries,
370 			lan966x_mac_forget_locked(lan966x, mac_entry->mac,
378 	spin_unlock(&lan966x->mac_lock);
381 void lan966x_mac_purge_entries(struct lan966x *lan966x)
385 	spin_lock(&lan966x->mac_lock);
386 	list_for_each_entry_safe(mac_entry, tmp, &lan966x->mac_entries,
388 		lan966x_mac_forget_locked(lan966x, mac_entry->mac,
394 	spin_unlock(&lan966x->mac_lock);
420 static void lan966x_mac_irq_process(struct lan966x *lan966x, u32 row,
433 	spin_lock(&lan966x->mac_lock);
434 	list_for_each_entry_safe(mac_entry, tmp, &lan966x->mac_entries, list) {
450 			if (WARN_ON(dest_idx >= lan966x->num_phys_ports))
473 	spin_unlock(&lan966x->mac_lock);
479 		port = lan966x->ports[mac_entry->port_index];
504 		if (WARN_ON(dest_idx >= lan966x->num_phys_ports))
507 		spin_lock(&lan966x->mac_lock);
508 		mac_entry = lan966x_mac_find_entry(lan966x, mac, vid, dest_idx);
510 			spin_unlock(&lan966x->mac_lock);
514 		port = lan966x->ports[dest_idx];
517 			spin_unlock(&lan966x->mac_lock);
522 		list_add_tail(&mac_entry->list, &lan966x->mac_entries);
523 		spin_unlock(&lan966x->mac_lock);
530 irqreturn_t lan966x_mac_irq_handler(struct lan966x *lan966x)
540 	       lan966x, ANA_MACTINDX);
543 		spin_lock(&lan966x->mac_lock);
546 			lan966x, ANA_MACACCESS);
547 		lan966x_mac_wait_for_completion(lan966x);
549 		val = lan_rd(lan966x, ANA_MACTINDX);
568 			spin_unlock(&lan966x->mac_lock);
572 		entry[column].mach = lan_rd(lan966x, ANA_MACHDATA);
573 		entry[column].macl = lan_rd(lan966x, ANA_MACLDATA);
574 		entry[column].maca = lan_rd(lan966x, ANA_MACACCESS);
575 		spin_unlock(&lan966x->mac_lock);
579 			lan966x_mac_irq_process(lan966x, index, entry);
589 		lan966x, ANA_ANAINTR);