879 static int vsc9959_gcb_soft_rst_status(struct ocelot *ocelot)  in vsc9959_gcb_soft_rst_status()  argument
883 	ocelot_field_read(ocelot, GCB_SOFT_RST_SWC_RST, &val);  in vsc9959_gcb_soft_rst_status()
888 static int vsc9959_sys_ram_init_status(struct ocelot *ocelot)  in vsc9959_sys_ram_init_status()  argument
890 	return ocelot_read(ocelot, SYS_RAM_INIT);  in vsc9959_sys_ram_init_status()
896 static int vsc9959_reset(struct ocelot *ocelot)  in vsc9959_reset()  argument
901 	ocelot_field_write(ocelot, GCB_SOFT_RST_SWC_RST, 1);  in vsc9959_reset()
903 	err = readx_poll_timeout(vsc9959_gcb_soft_rst_status, ocelot, val, !val,  in vsc9959_reset()
906 		dev_err(ocelot->dev, "timeout: switch core reset\n");  in vsc9959_reset()
911 	ocelot_write(ocelot, SYS_RAM_INIT_RAM_INIT, SYS_RAM_INIT);  in vsc9959_reset()
912 	err = readx_poll_timeout(vsc9959_sys_ram_init_status, ocelot, val, !val,  in vsc9959_reset()
916 		dev_err(ocelot->dev, "timeout: switch sram init\n");  in vsc9959_reset()
921 	ocelot_field_write(ocelot, SYS_RESET_CFG_CORE_ENA, 1);  in vsc9959_reset()
956 static int vsc9959_mdio_bus_alloc(struct ocelot *ocelot)  in vsc9959_mdio_bus_alloc()  argument
958 	struct pci_dev *pdev = to_pci_dev(ocelot->dev);  in vsc9959_mdio_bus_alloc()
959 	struct felix *felix = ocelot_to_felix(ocelot);  in vsc9959_mdio_bus_alloc()
961 	struct device *dev = ocelot->dev;  in vsc9959_mdio_bus_alloc()
1023 		struct ocelot_port *ocelot_port = ocelot->ports[port];  in vsc9959_mdio_bus_alloc()
1044 static void vsc9959_mdio_bus_free(struct ocelot *ocelot)  in vsc9959_mdio_bus_free()  argument
1046 	struct felix *felix = ocelot_to_felix(ocelot);  in vsc9959_mdio_bus_free()
1049 	for (port = 0; port < ocelot->num_phys_ports; port++) {  in vsc9959_mdio_bus_free()
1148 static void vsc9959_port_qmaxsdu_set(struct ocelot *ocelot, int port, int tc,  in vsc9959_port_qmaxsdu_set()  argument
1153 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_0,  in vsc9959_port_qmaxsdu_set()
1157 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_1,  in vsc9959_port_qmaxsdu_set()
1161 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_2,  in vsc9959_port_qmaxsdu_set()
1165 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_3,  in vsc9959_port_qmaxsdu_set()
1169 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_4,  in vsc9959_port_qmaxsdu_set()
1173 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_5,  in vsc9959_port_qmaxsdu_set()
1177 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_6,  in vsc9959_port_qmaxsdu_set()
1181 		ocelot_write_rix(ocelot, max_sdu, QSYS_QMAXSDU_CFG_7,  in vsc9959_port_qmaxsdu_set()
1187 static u32 vsc9959_port_qmaxsdu_get(struct ocelot *ocelot, int port, int tc)  in vsc9959_port_qmaxsdu_get()  argument
1190 	case 0: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_0, port);  in vsc9959_port_qmaxsdu_get()
1191 	case 1: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_1, port);  in vsc9959_port_qmaxsdu_get()
1192 	case 2: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_2, port);  in vsc9959_port_qmaxsdu_get()
1193 	case 3: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_3, port);  in vsc9959_port_qmaxsdu_get()
1194 	case 4: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_4, port);  in vsc9959_port_qmaxsdu_get()
1195 	case 5: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_5, port);  in vsc9959_port_qmaxsdu_get()
1196 	case 6: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_6, port);  in vsc9959_port_qmaxsdu_get()
1197 	case 7: return ocelot_read_rix(ocelot, QSYS_QMAXSDU_CFG_7, port);  in vsc9959_port_qmaxsdu_get()
1217 static void vsc9959_tas_guard_bands_update(struct ocelot *ocelot, int port)  in vsc9959_tas_guard_bands_update()  argument
1219 	struct ocelot_port *ocelot_port = ocelot->ports[port];  in vsc9959_tas_guard_bands_update()
1220 	struct ocelot_mm_state *mm = &ocelot->mm[port];  in vsc9959_tas_guard_bands_update()
1230 	lockdep_assert_held(&ocelot->fwd_domain_lock);  in vsc9959_tas_guard_bands_update()
1234 	val = ocelot_read_rix(ocelot, QSYS_TAG_CONFIG, port);  in vsc9959_tas_guard_bands_update()
1269 	val = ocelot_read_rix(ocelot, QSYS_PREEMPTION_CFG, port);  in vsc9959_tas_guard_bands_update()
1274 	dev_dbg(ocelot->dev,  in vsc9959_tas_guard_bands_update()
1296 			dev_dbg(ocelot->dev,  in vsc9959_tas_guard_bands_update()
1331 			dev_info(ocelot->dev,  in vsc9959_tas_guard_bands_update()
1340 		vsc9959_port_qmaxsdu_set(ocelot, port, tc, max_sdu);  in vsc9959_tas_guard_bands_update()
1343 	ocelot_write_rix(ocelot, maxlen, QSYS_PORT_MAX_SDU, port);  in vsc9959_tas_guard_bands_update()
1345 	ocelot->ops->cut_through_fwd(ocelot);  in vsc9959_tas_guard_bands_update()
1348 static void vsc9959_sched_speed_set(struct ocelot *ocelot, int port,  in vsc9959_sched_speed_set()  argument
1351 	struct ocelot_port *ocelot_port = ocelot->ports[port];  in vsc9959_sched_speed_set()
1372 	mutex_lock(&ocelot->fwd_domain_lock);  in vsc9959_sched_speed_set()
1374 	ocelot_rmw_rix(ocelot,  in vsc9959_sched_speed_set()
1380 		vsc9959_tas_guard_bands_update(ocelot, port);  in vsc9959_sched_speed_set()
1382 	mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_sched_speed_set()
1385 static void vsc9959_new_base_time(struct ocelot *ocelot, ktime_t base_time,  in vsc9959_new_base_time()  argument
1393 	ocelot_ptp_gettime64(&ocelot->ptp_info, &ts);  in vsc9959_new_base_time()
1407 static u32 vsc9959_tas_read_cfg_status(struct ocelot *ocelot)  in vsc9959_tas_read_cfg_status()  argument
1409 	return ocelot_read(ocelot, QSYS_TAS_PARAM_CFG_CTRL);  in vsc9959_tas_read_cfg_status()
1412 static void vsc9959_tas_gcl_set(struct ocelot *ocelot, const u32 gcl_ix,  in vsc9959_tas_gcl_set()  argument
1415 	ocelot_write(ocelot,  in vsc9959_tas_gcl_set()
1419 	ocelot_write(ocelot, entry->interval, QSYS_GCL_CFG_REG_2);  in vsc9959_tas_gcl_set()
1422 static int vsc9959_qos_port_tas_set(struct ocelot *ocelot, int port,  in vsc9959_qos_port_tas_set()  argument
1425 	struct ocelot_port *ocelot_port = ocelot->ports[port];  in vsc9959_qos_port_tas_set()
1430 	mutex_lock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_tas_set()
1433 		ocelot_port_mqprio(ocelot, port, &taprio->mqprio);  in vsc9959_qos_port_tas_set()
1434 		ocelot_rmw_rix(ocelot, 0, QSYS_TAG_CONFIG_ENABLE,  in vsc9959_qos_port_tas_set()
1440 		vsc9959_tas_guard_bands_update(ocelot, port);  in vsc9959_qos_port_tas_set()
1442 		mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_tas_set()
1449 	ret = ocelot_port_mqprio(ocelot, port, &taprio->mqprio);  in vsc9959_qos_port_tas_set()
1473 	ocelot_rmw(ocelot, QSYS_TAS_PARAM_CFG_CTRL_PORT_NUM(port) |  in vsc9959_qos_port_tas_set()
1482 	val = ocelot_read_rix(ocelot, QSYS_TAG_CONFIG, port);  in vsc9959_qos_port_tas_set()
1484 		val = ocelot_read(ocelot, QSYS_PARAM_STATUS_REG_8);  in vsc9959_qos_port_tas_set()
1491 	ocelot_rmw_rix(ocelot,  in vsc9959_qos_port_tas_set()
1500 	vsc9959_new_base_time(ocelot, taprio->base_time,  in vsc9959_qos_port_tas_set()
1502 	ocelot_write(ocelot, base_ts.tv_nsec, QSYS_PARAM_CFG_REG_1);  in vsc9959_qos_port_tas_set()
1503 	ocelot_write(ocelot, lower_32_bits(base_ts.tv_sec), QSYS_PARAM_CFG_REG_2);  in vsc9959_qos_port_tas_set()
1505 	ocelot_write(ocelot,  in vsc9959_qos_port_tas_set()
1509 	ocelot_write(ocelot, taprio->cycle_time, QSYS_PARAM_CFG_REG_4);  in vsc9959_qos_port_tas_set()
1510 	ocelot_write(ocelot, taprio->cycle_time_extension, QSYS_PARAM_CFG_REG_5);  in vsc9959_qos_port_tas_set()
1513 		vsc9959_tas_gcl_set(ocelot, i, &taprio->entries[i]);  in vsc9959_qos_port_tas_set()
1515 	ocelot_rmw(ocelot, QSYS_TAS_PARAM_CFG_CTRL_CONFIG_CHANGE,  in vsc9959_qos_port_tas_set()
1519 	ret = readx_poll_timeout(vsc9959_tas_read_cfg_status, ocelot, val,  in vsc9959_qos_port_tas_set()
1526 	vsc9959_tas_guard_bands_update(ocelot, port);  in vsc9959_qos_port_tas_set()
1528 	mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_tas_set()
1534 	ocelot_port_mqprio(ocelot, port, &taprio->mqprio);  in vsc9959_qos_port_tas_set()
1536 	mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_tas_set()
1541 static void vsc9959_tas_clock_adjust(struct ocelot *ocelot)  in vsc9959_tas_clock_adjust()  argument
1549 	mutex_lock(&ocelot->fwd_domain_lock);  in vsc9959_tas_clock_adjust()
1551 	for (port = 0; port < ocelot->num_phys_ports; port++) {  in vsc9959_tas_clock_adjust()
1552 		ocelot_port = ocelot->ports[port];  in vsc9959_tas_clock_adjust()
1557 		ocelot_rmw(ocelot,  in vsc9959_tas_clock_adjust()
1563 		ocelot_rmw_rix(ocelot, 0, QSYS_TAG_CONFIG_ENABLE,  in vsc9959_tas_clock_adjust()
1566 		vsc9959_new_base_time(ocelot, taprio->base_time,  in vsc9959_tas_clock_adjust()
1569 		ocelot_write(ocelot, base_ts.tv_nsec, QSYS_PARAM_CFG_REG_1);  in vsc9959_tas_clock_adjust()
1570 		ocelot_write(ocelot, lower_32_bits(base_ts.tv_sec),  in vsc9959_tas_clock_adjust()
1573 		ocelot_rmw(ocelot,  in vsc9959_tas_clock_adjust()
1578 		ocelot_rmw(ocelot, QSYS_TAS_PARAM_CFG_CTRL_CONFIG_CHANGE,  in vsc9959_tas_clock_adjust()
1583 		ocelot_rmw_rix(ocelot, QSYS_TAG_CONFIG_ENABLE,  in vsc9959_tas_clock_adjust()
1587 	mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_tas_clock_adjust()
1593 	struct ocelot *ocelot = ds->priv;  in vsc9959_qos_port_cbs_set()  local
1601 		ocelot_write_gix(ocelot, QSYS_CIR_CFG_CIR_RATE(0) |  in vsc9959_qos_port_cbs_set()
1605 		ocelot_rmw_gix(ocelot, 0, QSYS_SE_CFG_SE_AVB_ENA,  in vsc9959_qos_port_cbs_set()
1619 	ocelot_write_gix(ocelot,  in vsc9959_qos_port_cbs_set()
1625 	ocelot_rmw_gix(ocelot,  in vsc9959_qos_port_cbs_set()
1658 static int vsc9959_qos_port_mqprio(struct ocelot *ocelot, int port,  in vsc9959_qos_port_mqprio()  argument
1663 	mutex_lock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_mqprio()
1664 	ret = ocelot_port_mqprio(ocelot, port, mqprio);  in vsc9959_qos_port_mqprio()
1665 	mutex_unlock(&ocelot->fwd_domain_lock);  in vsc9959_qos_port_mqprio()
1674 	struct ocelot *ocelot = ds->priv;  in vsc9959_port_setup_tc()  local
1680 		return vsc9959_qos_port_tas_set(ocelot, port, type_data);  in vsc9959_port_setup_tc()
1682 		return vsc9959_qos_port_mqprio(ocelot, port, type_data);  in vsc9959_port_setup_tc()
1798 static int vsc9959_mact_stream_set(struct ocelot *ocelot,  in vsc9959_mact_stream_set()  argument
1813 	ret = ocelot_mact_lookup(ocelot, &dst_idx, mac, vid, &type);  in vsc9959_mact_stream_set()
1827 	ret = ocelot_mact_learn_streamdata(ocelot, dst_idx, mac, vid, type,  in vsc9959_mact_stream_set()
1847 static int vsc9959_stream_table_add(struct ocelot *ocelot,  in vsc9959_stream_table_add()  argument
1860 		ret = vsc9959_mact_stream_set(ocelot, stream_entry, extack);  in vsc9959_stream_table_add()
1884 static void vsc9959_stream_table_del(struct ocelot *ocelot,  in vsc9959_stream_table_del()  argument
1888 		vsc9959_mact_stream_set(ocelot, stream, NULL);  in vsc9959_stream_table_del()
1894 static u32 vsc9959_sfi_access_status(struct ocelot *ocelot)  in vsc9959_sfi_access_status()  argument
1896 	return ocelot_read(ocelot, ANA_TABLES_SFIDACCESS);  in vsc9959_sfi_access_status()
1899 static int vsc9959_psfp_sfi_set(struct ocelot *ocelot,  in vsc9959_psfp_sfi_set()  argument
1908 		ocelot_write(ocelot, ANA_TABLES_SFIDTIDX_SFID_INDEX(sfi->index),  in vsc9959_psfp_sfi_set()
1912 		ocelot_write(ocelot, val, ANA_TABLES_SFIDACCESS);  in vsc9959_psfp_sfi_set()
1914 		return readx_poll_timeout(vsc9959_sfi_access_status, ocelot, val,  in vsc9959_psfp_sfi_set()
1923 	ocelot_write(ocelot,  in vsc9959_psfp_sfi_set()
1931 	ocelot_write(ocelot,  in vsc9959_psfp_sfi_set()
1938 	return readx_poll_timeout(vsc9959_sfi_access_status, ocelot, val,  in vsc9959_psfp_sfi_set()
1943 static int vsc9959_psfp_sfidmask_set(struct ocelot *ocelot, u32 sfid, int ports)  in vsc9959_psfp_sfidmask_set()  argument
1947 	ocelot_rmw(ocelot,  in vsc9959_psfp_sfidmask_set()
1952 	ocelot_write(ocelot,  in vsc9959_psfp_sfidmask_set()
1957 	ocelot_rmw(ocelot,  in vsc9959_psfp_sfidmask_set()
1962 	return readx_poll_timeout(vsc9959_sfi_access_status, ocelot, val,  in vsc9959_psfp_sfidmask_set()
1967 static int vsc9959_psfp_sfi_list_add(struct ocelot *ocelot,  in vsc9959_psfp_sfi_list_add()  argument
1980 	ret = vsc9959_psfp_sfi_set(ocelot, sfi_entry);  in vsc9959_psfp_sfi_list_add()
1986 	vsc9959_psfp_sfidmask_set(ocelot, sfi->index, sfi->portmask);  in vsc9959_psfp_sfi_list_add()
1993 static int vsc9959_psfp_sfi_table_add(struct ocelot *ocelot,  in vsc9959_psfp_sfi_table_add()  argument
2001 	psfp = &ocelot->psfp;  in vsc9959_psfp_sfi_table_add()
2023 	return vsc9959_psfp_sfi_list_add(ocelot, sfi, last);  in vsc9959_psfp_sfi_table_add()
2026 static int vsc9959_psfp_sfi_table_add2(struct ocelot *ocelot,  in vsc9959_psfp_sfi_table_add2()  argument
2036 	psfp = &ocelot->psfp;  in vsc9959_psfp_sfi_table_add2()
2050 	ret = vsc9959_psfp_sfi_list_add(ocelot, sfi, last);  in vsc9959_psfp_sfi_table_add2()
2056 	return vsc9959_psfp_sfi_list_add(ocelot, sfi2, last->next);  in vsc9959_psfp_sfi_table_add2()
2071 static void vsc9959_psfp_sfi_table_del(struct ocelot *ocelot, u32 index)  in vsc9959_psfp_sfi_table_del()  argument
2077 	psfp = &ocelot->psfp;  in vsc9959_psfp_sfi_table_del()
2084 				vsc9959_psfp_sfi_set(ocelot, tmp);  in vsc9959_psfp_sfi_table_del()
2107 static u32 vsc9959_sgi_cfg_status(struct ocelot *ocelot)  in vsc9959_sgi_cfg_status()  argument
2109 	return ocelot_read(ocelot, ANA_SG_ACCESS_CTRL);  in vsc9959_sgi_cfg_status()
2112 static int vsc9959_psfp_sgi_set(struct ocelot *ocelot,  in vsc9959_psfp_sgi_set()  argument
2124 	ocelot_write(ocelot, ANA_SG_ACCESS_CTRL_SGID(sgi->index),  in vsc9959_psfp_sgi_set()
2128 		ocelot_rmw(ocelot, ANA_SG_CONFIG_REG_3_INIT_GATE_STATE,  in vsc9959_psfp_sgi_set()
2143 	vsc9959_new_base_time(ocelot, sgi->basetime, sgi->cycletime, &base_ts);  in vsc9959_psfp_sgi_set()
2144 	ocelot_write(ocelot, base_ts.tv_nsec, ANA_SG_CONFIG_REG_1);  in vsc9959_psfp_sgi_set()
2146 	ocelot_write(ocelot, val, ANA_SG_CONFIG_REG_2);  in vsc9959_psfp_sgi_set()
2149 	ocelot_write(ocelot,  in vsc9959_psfp_sgi_set()
2158 	ocelot_write(ocelot, sgi->cycletime, ANA_SG_CONFIG_REG_4);  in vsc9959_psfp_sgi_set()
2164 		ocelot_write_rix(ocelot, ANA_SG_GCL_GS_CONFIG_IPS(ips) |  in vsc9959_psfp_sgi_set()
2170 		ocelot_write_rix(ocelot, interval_sum, ANA_SG_GCL_TI_CONFIG, i);  in vsc9959_psfp_sgi_set()
2173 	ocelot_rmw(ocelot, ANA_SG_ACCESS_CTRL_CONFIG_CHANGE,  in vsc9959_psfp_sgi_set()
2177 	return readx_poll_timeout(vsc9959_sgi_cfg_status, ocelot, val,  in vsc9959_psfp_sgi_set()
2182 static int vsc9959_psfp_sgi_table_add(struct ocelot *ocelot,  in vsc9959_psfp_sgi_table_add()  argument
2189 	psfp = &ocelot->psfp;  in vsc9959_psfp_sgi_table_add()
2201 	ret = vsc9959_psfp_sgi_set(ocelot, sgi);  in vsc9959_psfp_sgi_table_add()
2214 static void vsc9959_psfp_sgi_table_del(struct ocelot *ocelot,  in vsc9959_psfp_sgi_table_del()  argument
2222 	psfp = &ocelot->psfp;  in vsc9959_psfp_sgi_table_del()
2230 				vsc9959_psfp_sgi_set(ocelot, &sgi);  in vsc9959_psfp_sgi_table_del()
2238 static int vsc9959_psfp_filter_add(struct ocelot *ocelot, int port,  in vsc9959_psfp_filter_add()  argument
2254 	psfp = &ocelot->psfp;  in vsc9959_psfp_filter_add()
2274 			ret = vsc9959_psfp_sgi_table_add(ocelot, sgi);  in vsc9959_psfp_filter_add()
2296 			ret = ocelot_vcap_policer_add(ocelot, index, &pol);  in vsc9959_psfp_filter_add()
2342 		vsc9959_psfp_sfi_table_del(ocelot, stream_entry->sfid);  in vsc9959_psfp_filter_add()
2348 			ret = vsc9959_psfp_sfi_table_add2(ocelot, &sfi,  in vsc9959_psfp_filter_add()
2352 			ret = vsc9959_psfp_sfi_table_add2(ocelot, &old_sfi,  in vsc9959_psfp_filter_add()
2361 		ret = vsc9959_psfp_sfi_table_add(ocelot, &sfi);  in vsc9959_psfp_filter_add()
2368 	ret = vsc9959_stream_table_add(ocelot, &psfp->stream_list,  in vsc9959_psfp_filter_add()
2371 		vsc9959_psfp_sfi_table_del(ocelot, stream.sfid);  in vsc9959_psfp_filter_add()
2381 		vsc9959_psfp_sgi_table_del(ocelot, sfi.sgid);  in vsc9959_psfp_filter_add()
2384 		ocelot_vcap_policer_del(ocelot, sfi.fmid);  in vsc9959_psfp_filter_add()
2391 static int vsc9959_psfp_filter_del(struct ocelot *ocelot,  in vsc9959_psfp_filter_del()  argument
2395 	struct ocelot_psfp_list *psfp = &ocelot->psfp;  in vsc9959_psfp_filter_del()
2413 		vsc9959_psfp_sgi_table_del(ocelot, sfi->sgid);  in vsc9959_psfp_filter_del()
2416 		ocelot_vcap_policer_del(ocelot, sfi->fmid);  in vsc9959_psfp_filter_del()
2418 	vsc9959_psfp_sfi_table_del(ocelot, stream->sfid);  in vsc9959_psfp_filter_del()
2423 	vsc9959_stream_table_del(ocelot, stream);  in vsc9959_psfp_filter_del()
2430 			vsc9959_mact_stream_set(ocelot, stream_entry, NULL);  in vsc9959_psfp_filter_del()
2432 		vsc9959_psfp_sfidmask_set(ocelot, stream_entry->sfid,  in vsc9959_psfp_filter_del()
2441 static void vsc9959_update_sfid_stats(struct ocelot *ocelot,  in vsc9959_update_sfid_stats()  argument
2448 	lockdep_assert_held(&ocelot->stat_view_lock);  in vsc9959_update_sfid_stats()
2450 	ocelot_rmw(ocelot, SYS_STAT_CFG_STAT_VIEW(sfid),  in vsc9959_update_sfid_stats()
2454 	match = ocelot_read(ocelot, SYS_COUNT_SF_MATCHING_FRAMES);  in vsc9959_update_sfid_stats()
2455 	not_pass_gate = ocelot_read(ocelot, SYS_COUNT_SF_NOT_PASSING_FRAMES);  in vsc9959_update_sfid_stats()
2456 	not_pass_sdu = ocelot_read(ocelot, SYS_COUNT_SF_NOT_PASSING_SDU);  in vsc9959_update_sfid_stats()
2457 	red = ocelot_read(ocelot, SYS_COUNT_SF_RED_FRAMES);  in vsc9959_update_sfid_stats()
2460 	ocelot_write(ocelot,  in vsc9959_update_sfid_stats()
2472 static void vsc9959_update_stats(struct ocelot *ocelot)  in vsc9959_update_stats()  argument
2474 	struct ocelot_psfp_list *psfp = &ocelot->psfp;  in vsc9959_update_stats()
2480 		vsc9959_update_sfid_stats(ocelot, sfi);  in vsc9959_update_stats()
2485 static int vsc9959_psfp_stats_get(struct ocelot *ocelot,  in vsc9959_psfp_stats_get()  argument
2489 	struct ocelot_psfp_list *psfp = &ocelot->psfp;  in vsc9959_psfp_stats_get()
2502 	mutex_lock(&ocelot->stat_view_lock);  in vsc9959_psfp_stats_get()
2504 	vsc9959_update_sfid_stats(ocelot, sfi);  in vsc9959_psfp_stats_get()
2512 	mutex_unlock(&ocelot->stat_view_lock);  in vsc9959_psfp_stats_get()
2517 static void vsc9959_psfp_init(struct ocelot *ocelot)  in vsc9959_psfp_init()  argument
2519 	struct ocelot_psfp_list *psfp = &ocelot->psfp;  in vsc9959_psfp_init()
2536 static void vsc9959_cut_through_fwd(struct ocelot *ocelot)  in vsc9959_cut_through_fwd()  argument
2538 	struct felix *felix = ocelot_to_felix(ocelot);  in vsc9959_cut_through_fwd()
2542 	lockdep_assert_held(&ocelot->fwd_domain_lock);  in vsc9959_cut_through_fwd()
2544 	for (port = 0; port < ocelot->num_phys_ports; port++) {  in vsc9959_cut_through_fwd()
2545 		struct ocelot_port *ocelot_port = ocelot->ports[port];  in vsc9959_cut_through_fwd()
2546 		struct ocelot_mm_state *mm = &ocelot->mm[port];  in vsc9959_cut_through_fwd()
2562 			mask = ocelot_get_bridge_fwd_mask(ocelot, port);  in vsc9959_cut_through_fwd()
2564 			if (ocelot->npi >= 0)  in vsc9959_cut_through_fwd()
2565 				mask |= BIT(ocelot->npi);  in vsc9959_cut_through_fwd()
2567 				mask |= ocelot_port_assigned_dsa_8021q_cpu_mask(ocelot,  in vsc9959_cut_through_fwd()
2574 		for_each_set_bit(other_port, &mask, ocelot->num_phys_ports) {  in vsc9959_cut_through_fwd()
2577 			other_ocelot_port = ocelot->ports[other_port];  in vsc9959_cut_through_fwd()
2595 				if (vsc9959_port_qmaxsdu_get(ocelot, port, tc))  in vsc9959_cut_through_fwd()
2600 		tmp = ocelot_read_rix(ocelot, ANA_CUT_THRU_CFG, port);  in vsc9959_cut_through_fwd()
2604 		dev_dbg(ocelot->dev,  in vsc9959_cut_through_fwd()
2609 		ocelot_write_rix(ocelot, val, ANA_CUT_THRU_CFG, port);  in vsc9959_cut_through_fwd()
2660 	struct ocelot *ocelot = (struct ocelot *)data;  in felix_irq_handler()  local
2662 	ocelot_get_txtstamp(ocelot);  in felix_irq_handler()
2663 	ocelot_mm_irq(ocelot);  in felix_irq_handler()
2672 	struct ocelot *ocelot;  in felix_pci_probe()  local
2695 	ocelot = &felix->ocelot;  in felix_pci_probe()
2696 	ocelot->dev = &pdev->dev;  in felix_pci_probe()
2697 	ocelot->num_flooding_pgids = OCELOT_NUM_TC;  in felix_pci_probe()
2705 					"felix-intb", ocelot);  in felix_pci_probe()
2711 	ocelot->ptp = 1;  in felix_pci_probe()
2712 	ocelot->mm_supported = true;  in felix_pci_probe()
2725 	ds->priv = ocelot;  in felix_pci_probe()