hns_dsaf_misc.c

  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Copyright (c) 2014-2015 Hisilicon Limited.
  4 */
  5
  6#include "hns_dsaf_mac.h"
  7#include "hns_dsaf_misc.h"
  8#include "hns_dsaf_ppe.h"
  9#include "hns_dsaf_reg.h"
 10
 11enum _dsm_op_index {
 12	HNS_OP_RESET_FUNC               = 0x1,
 13	HNS_OP_SERDES_LP_FUNC           = 0x2,
 14	HNS_OP_LED_SET_FUNC             = 0x3,
 15	HNS_OP_GET_PORT_TYPE_FUNC       = 0x4,
 16	HNS_OP_GET_SFP_STAT_FUNC        = 0x5,
 17	HNS_OP_LOCATE_LED_SET_FUNC      = 0x6,
 18};
 19
 20enum _dsm_rst_type {
 21	HNS_DSAF_RESET_FUNC     = 0x1,
 22	HNS_PPE_RESET_FUNC      = 0x2,
 23	HNS_XGE_RESET_FUNC      = 0x4,
 24	HNS_GE_RESET_FUNC       = 0x5,
 25	HNS_DSAF_CHN_RESET_FUNC = 0x6,
 26	HNS_ROCE_RESET_FUNC     = 0x7,
 27};
 28
 29static const guid_t hns_dsaf_acpi_dsm_guid =
 30	GUID_INIT(0x1A85AA1A, 0xE293, 0x415E,
 31		  0x8E, 0x28, 0x8D, 0x69, 0x0A, 0x0F, 0x82, 0x0A);
 32
 33static void dsaf_write_sub(struct dsaf_device *dsaf_dev, u32 reg, u32 val)
 34{
 35	if (dsaf_dev->sub_ctrl)
 36		dsaf_write_syscon(dsaf_dev->sub_ctrl, reg, val);
 37	else
 38		dsaf_write_reg(dsaf_dev->sc_base, reg, val);
 39}
 40
 41static u32 dsaf_read_sub(struct dsaf_device *dsaf_dev, u32 reg)
 42{
 43	u32 ret = 0;
 44	int err;
 45
 46	if (dsaf_dev->sub_ctrl) {
 47		err = dsaf_read_syscon(dsaf_dev->sub_ctrl, reg, &ret);
 48		if (err)
 49			dev_err(dsaf_dev->dev, "dsaf_read_syscon error %d!\n",
 50				err);
 51	} else {
 52		ret = dsaf_read_reg(dsaf_dev->sc_base, reg);
 53	}
 54
 55	return ret;
 56}
 57
 58static void hns_dsaf_acpi_ledctrl_by_port(struct hns_mac_cb *mac_cb, u8 op_type,
 59					  u32 link, u32 port, u32 act)
 60{
 61	union acpi_object *obj;
 62	union acpi_object obj_args[3], argv4;
 63
 64	obj_args[0].integer.type = ACPI_TYPE_INTEGER;
 65	obj_args[0].integer.value = link;
 66	obj_args[1].integer.type = ACPI_TYPE_INTEGER;
 67	obj_args[1].integer.value = port;
 68	obj_args[2].integer.type = ACPI_TYPE_INTEGER;
 69	obj_args[2].integer.value = act;
 70
 71	argv4.type = ACPI_TYPE_PACKAGE;
 72	argv4.package.count = 3;
 73	argv4.package.elements = obj_args;
 74
 75	obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),
 76				&hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);
 77	if (!obj) {
 78		dev_warn(mac_cb->dev, "ledctrl fail, link:%d port:%d act:%d!\n",
 79			 link, port, act);
 80		return;
 81	}
 82
 83	ACPI_FREE(obj);
 84}
 85
 86static void hns_dsaf_acpi_locate_ledctrl_by_port(struct hns_mac_cb *mac_cb,
 87						 u8 op_type, u32 locate,
 88						 u32 port)
 89{
 90	union acpi_object obj_args[2], argv4;
 91	union acpi_object *obj;
 92
 93	obj_args[0].integer.type = ACPI_TYPE_INTEGER;
 94	obj_args[0].integer.value = locate;
 95	obj_args[1].integer.type = ACPI_TYPE_INTEGER;
 96	obj_args[1].integer.value = port;
 97
 98	argv4.type = ACPI_TYPE_PACKAGE;
 99	argv4.package.count = 2;
100	argv4.package.elements = obj_args;
101
102	obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),
103				&hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);
104	if (!obj) {
105		dev_err(mac_cb->dev, "ledctrl fail, locate:%d port:%d!\n",
106			locate, port);
107		return;
108	}
109
110	ACPI_FREE(obj);
111}
112
113static void hns_cpld_set_led(struct hns_mac_cb *mac_cb, int link_status,
114			     u16 speed, int data)
115{
116	int speed_reg = 0;
117	u8 value;
118
119	if (!mac_cb) {
120		pr_err("sfp_led_opt mac_dev is null!\n");
121		return;
122	}
123	if (!mac_cb->cpld_ctrl) {
124		dev_err(mac_cb->dev, "mac_id=%d, cpld syscon is null !\n",
125			mac_cb->mac_id);
126		return;
127	}
128
129	if (speed == MAC_SPEED_10000)
130		speed_reg = 1;
131
132	value = mac_cb->cpld_led_value;
133
134	if (link_status) {
135		dsaf_set_bit(value, DSAF_LED_LINK_B, link_status);
136		dsaf_set_field(value, DSAF_LED_SPEED_M,
137			       DSAF_LED_SPEED_S, speed_reg);
138		dsaf_set_bit(value, DSAF_LED_DATA_B, data);
139
140		if (value != mac_cb->cpld_led_value) {
141			dsaf_write_syscon(mac_cb->cpld_ctrl,
142					  mac_cb->cpld_ctrl_reg, value);
143			mac_cb->cpld_led_value = value;
144		}
145	} else {
146		value = (mac_cb->cpld_led_value) & (0x1 << DSAF_LED_ANCHOR_B);
147		dsaf_write_syscon(mac_cb->cpld_ctrl,
148				  mac_cb->cpld_ctrl_reg, value);
149		mac_cb->cpld_led_value = value;
150	}
151}
152
153static void hns_cpld_set_led_acpi(struct hns_mac_cb *mac_cb, int link_status,
154				  u16 speed, int data)
155{
156	if (!mac_cb) {
157		pr_err("cpld_led_set mac_cb is null!\n");
158		return;
159	}
160
161	hns_dsaf_acpi_ledctrl_by_port(mac_cb, HNS_OP_LED_SET_FUNC,
162				      link_status, mac_cb->mac_id, data);
163}
164
165static void cpld_led_reset(struct hns_mac_cb *mac_cb)
166{
167	if (!mac_cb || !mac_cb->cpld_ctrl)
168		return;
169
170	dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
171			  CPLD_LED_DEFAULT_VALUE);
172	mac_cb->cpld_led_value = CPLD_LED_DEFAULT_VALUE;
173}
174
175static void cpld_led_reset_acpi(struct hns_mac_cb *mac_cb)
176{
177	if (!mac_cb) {
178		pr_err("cpld_led_reset mac_cb is null!\n");
179		return;
180	}
181
182	if (mac_cb->media_type != HNAE_MEDIA_TYPE_FIBER)
183		return;
184
185	hns_dsaf_acpi_ledctrl_by_port(mac_cb, HNS_OP_LED_SET_FUNC,
186				      0, mac_cb->mac_id, 0);
187}
188
189static int cpld_set_led_id(struct hns_mac_cb *mac_cb,
190			   enum hnae_led_state status)
191{
192	u32 val = 0;
193	int ret;
194
195	if (!mac_cb->cpld_ctrl)
196		return 0;
197
198	switch (status) {
199	case HNAE_LED_ACTIVE:
200		ret = dsaf_read_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
201				       &val);
202		if (ret)
203			return ret;
204
205		dsaf_set_bit(val, DSAF_LED_ANCHOR_B, CPLD_LED_ON_VALUE);
206		dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
207				  val);
208		mac_cb->cpld_led_value = val;
209		break;
210	case HNAE_LED_INACTIVE:
211		dsaf_set_bit(mac_cb->cpld_led_value, DSAF_LED_ANCHOR_B,
212			     CPLD_LED_DEFAULT_VALUE);
213		dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
214				  mac_cb->cpld_led_value);
215		break;
216	default:
217		dev_err(mac_cb->dev, "invalid led state: %d!", status);
218		return -EINVAL;
219	}
220
221	return 0;
222}
223
224static int cpld_set_led_id_acpi(struct hns_mac_cb *mac_cb,
225				enum hnae_led_state status)
226{
227	switch (status) {
228	case HNAE_LED_ACTIVE:
229		hns_dsaf_acpi_locate_ledctrl_by_port(mac_cb,
230						     HNS_OP_LOCATE_LED_SET_FUNC,
231						     CPLD_LED_ON_VALUE,
232						     mac_cb->mac_id);
233		break;
234	case HNAE_LED_INACTIVE:
235		hns_dsaf_acpi_locate_ledctrl_by_port(mac_cb,
236						     HNS_OP_LOCATE_LED_SET_FUNC,
237						     CPLD_LED_DEFAULT_VALUE,
238						     mac_cb->mac_id);
239		break;
240	default:
241		dev_err(mac_cb->dev, "invalid led state: %d!", status);
242		return -EINVAL;
243	}
244
245	return 0;
246}
247
248#define RESET_REQ_OR_DREQ 1
249
250static void hns_dsaf_acpi_srst_by_port(struct dsaf_device *dsaf_dev, u8 op_type,
251				       u32 port_type, u32 port, u32 val)
252{
253	union acpi_object *obj;
254	union acpi_object obj_args[3], argv4;
255
256	obj_args[0].integer.type = ACPI_TYPE_INTEGER;
257	obj_args[0].integer.value = port_type;
258	obj_args[1].integer.type = ACPI_TYPE_INTEGER;
259	obj_args[1].integer.value = port;
260	obj_args[2].integer.type = ACPI_TYPE_INTEGER;
261	obj_args[2].integer.value = val;
262
263	argv4.type = ACPI_TYPE_PACKAGE;
264	argv4.package.count = 3;
265	argv4.package.elements = obj_args;
266
267	obj = acpi_evaluate_dsm(ACPI_HANDLE(dsaf_dev->dev),
268				&hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);
269	if (!obj) {
270		dev_warn(dsaf_dev->dev, "reset port_type%d port%d fail!",
271			 port_type, port);
272		return;
273	}
274
275	ACPI_FREE(obj);
276}
277
278static void hns_dsaf_rst(struct dsaf_device *dsaf_dev, bool dereset)
279{
280	u32 xbar_reg_addr;
281	u32 nt_reg_addr;
282
283	if (!dereset) {
284		xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_REQ_REG;
285		nt_reg_addr = DSAF_SUB_SC_NT_RESET_REQ_REG;
286	} else {
287		xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_DREQ_REG;
288		nt_reg_addr = DSAF_SUB_SC_NT_RESET_DREQ_REG;
289	}
290
291	dsaf_write_sub(dsaf_dev, xbar_reg_addr, RESET_REQ_OR_DREQ);
292	dsaf_write_sub(dsaf_dev, nt_reg_addr, RESET_REQ_OR_DREQ);
293}
294
295static void hns_dsaf_rst_acpi(struct dsaf_device *dsaf_dev, bool dereset)
296{
297	hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
298				   HNS_DSAF_RESET_FUNC,
299				   0, dereset);
300}
301
302static void hns_dsaf_xge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
303				      bool dereset)
304{
305	u32 reg_val = 0;
306	u32 reg_addr;
307
308	if (port >= DSAF_XGE_NUM)
309		return;
310
311	reg_val |= RESET_REQ_OR_DREQ;
312	reg_val |= 0x2082082 << dsaf_dev->mac_cb[port]->port_rst_off;
313
314	if (!dereset)
315		reg_addr = DSAF_SUB_SC_XGE_RESET_REQ_REG;
316	else
317		reg_addr = DSAF_SUB_SC_XGE_RESET_DREQ_REG;
318
319	dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
320}
321
322static void hns_dsaf_xge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,
323					   u32 port, bool dereset)
324{
325	hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
326				   HNS_XGE_RESET_FUNC, port, dereset);
327}
328
329static void hns_dsaf_ge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
330				     bool dereset)
331{
332	u32 reg_val_1;
333	u32 reg_val_2;
334	u32 port_rst_off;
335
336	if (port >= DSAF_GE_NUM)
337		return;
338
339	if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {
340		/* DSAF_MAX_PORT_NUM is 6, but DSAF_GE_NUM is 8.
341		   We need check to prevent array overflow */
342		if (port >= DSAF_MAX_PORT_NUM)
343			return;
344		reg_val_1  = 0x1 << port;
345		port_rst_off = dsaf_dev->mac_cb[port]->port_rst_off;
346		/* there is difference between V1 and V2 in register.*/
347		reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ?
348				0x1041041 : 0x2082082;
349		reg_val_2 <<= port_rst_off;
350
351		if (!dereset) {
352			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,
353				       reg_val_1);
354
355			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ0_REG,
356				       reg_val_2);
357		} else {
358			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ0_REG,
359				       reg_val_2);
360
361			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,
362				       reg_val_1);
363		}
364	} else {
365		reg_val_1 = 0x15540;
366		reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 0x100 : 0x40;
367
368		reg_val_1 <<= dsaf_dev->reset_offset;
369		reg_val_2 <<= dsaf_dev->reset_offset;
370
371		if (!dereset) {
372			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,
373				       reg_val_1);
374
375			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_REQ_REG,
376				       reg_val_2);
377		} else {
378			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,
379				       reg_val_1);
380
381			dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_DREQ_REG,
382				       reg_val_2);
383		}
384	}
385}
386
387static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,
388					  u32 port, bool dereset)
389{
390	hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
391				   HNS_GE_RESET_FUNC, port, dereset);
392}
393
394static void hns_ppe_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
395				 bool dereset)
396{
397	u32 reg_val = 0;
398	u32 reg_addr;
399
400	reg_val |= RESET_REQ_OR_DREQ <<	dsaf_dev->mac_cb[port]->port_rst_off;
401
402	if (!dereset)
403		reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;
404	else
405		reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;
406
407	dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
408}
409
410static void
411hns_ppe_srst_by_port_acpi(struct dsaf_device *dsaf_dev, u32 port, bool dereset)
412{
413	hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
414				   HNS_PPE_RESET_FUNC, port, dereset);
415}
416
417static void hns_ppe_com_srst(struct dsaf_device *dsaf_dev, bool dereset)
418{
419	u32 reg_val;
420	u32 reg_addr;
421
422	if (!(dev_of_node(dsaf_dev->dev)))
423		return;
424
425	if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {
426		reg_val = RESET_REQ_OR_DREQ;
427		if (!dereset)
428			reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG;
429		else
430			reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG;
431
432	} else {
433		reg_val = 0x100 << dsaf_dev->reset_offset;
434
435		if (!dereset)
436			reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;
437		else
438			reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;
439	}
440
441	dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
442}
443
444/**
445 * hns_mac_get_phy_if - get phy ifterface form serdes mode
446 * @mac_cb: mac control block
447 * retuen phy interface
448 */
449static phy_interface_t hns_mac_get_phy_if(struct hns_mac_cb *mac_cb)
450{
451	u32 mode;
452	u32 reg;
453	bool is_ver1 = AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver);
454	int mac_id = mac_cb->mac_id;
455	phy_interface_t phy_if;
456
457	if (is_ver1) {
458		if (HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev))
459			return PHY_INTERFACE_MODE_SGMII;
460
461		if (mac_id >= 0 && mac_id <= 3)
462			reg = HNS_MAC_HILINK4_REG;
463		else
464			reg = HNS_MAC_HILINK3_REG;
465	} else {
466		if (!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev) && mac_id <= 3)
467			reg = HNS_MAC_HILINK4V2_REG;
468		else
469			reg = HNS_MAC_HILINK3V2_REG;
470	}
471
472	mode = dsaf_read_sub(mac_cb->dsaf_dev, reg);
473	if (dsaf_get_bit(mode, mac_cb->port_mode_off))
474		phy_if = PHY_INTERFACE_MODE_XGMII;
475	else
476		phy_if = PHY_INTERFACE_MODE_SGMII;
477
478	return phy_if;
479}
480
481static phy_interface_t hns_mac_get_phy_if_acpi(struct hns_mac_cb *mac_cb)
482{
483	phy_interface_t phy_if = PHY_INTERFACE_MODE_NA;
484	union acpi_object *obj;
485	union acpi_object obj_args, argv4;
486
487	obj_args.integer.type = ACPI_TYPE_INTEGER;
488	obj_args.integer.value = mac_cb->mac_id;
489
490	argv4.type = ACPI_TYPE_PACKAGE;
491	argv4.package.count = 1;
492	argv4.package.elements = &obj_args;
493
494	obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev),
495				      &hns_dsaf_acpi_dsm_guid, 0,
496				      HNS_OP_GET_PORT_TYPE_FUNC, &argv4,
497				      ACPI_TYPE_INTEGER);
498	if (!obj)
499		return phy_if;
500
501	phy_if = obj->integer.value ?
502		PHY_INTERFACE_MODE_XGMII : PHY_INTERFACE_MODE_SGMII;
503
504	dev_dbg(mac_cb->dev, "mac_id=%d, phy_if=%d\n", mac_cb->mac_id, phy_if);
505
506	ACPI_FREE(obj);
507
508	return phy_if;
509}
510
511static int hns_mac_get_sfp_prsnt(struct hns_mac_cb *mac_cb, int *sfp_prsnt)
512{
513	u32 val = 0;
514	int ret;
515
516	if (!mac_cb->cpld_ctrl)
517		return -ENODEV;
518
519	ret = dsaf_read_syscon(mac_cb->cpld_ctrl,
520			       mac_cb->cpld_ctrl_reg + MAC_SFP_PORT_OFFSET,
521			       &val);
522	if (ret)
523		return ret;
524
525	*sfp_prsnt = !val;
526	return 0;
527}
528
529static int hns_mac_get_sfp_prsnt_acpi(struct hns_mac_cb *mac_cb, int *sfp_prsnt)
530{
531	union acpi_object *obj;
532	union acpi_object obj_args, argv4;
533
534	obj_args.integer.type = ACPI_TYPE_INTEGER;
535	obj_args.integer.value = mac_cb->mac_id;
536
537	argv4.type = ACPI_TYPE_PACKAGE;
538	argv4.package.count = 1;
539	argv4.package.elements = &obj_args;
540
541	obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev),
542				      &hns_dsaf_acpi_dsm_guid, 0,
543				      HNS_OP_GET_SFP_STAT_FUNC, &argv4,
544				      ACPI_TYPE_INTEGER);
545	if (!obj)
546		return -ENODEV;
547
548	*sfp_prsnt = obj->integer.value;
549
550	ACPI_FREE(obj);
551
552	return 0;
553}
554
555/**
556 * hns_mac_config_sds_loopback - set loop back for serdes
557 * @mac_cb: mac control block
558 * @en: enable or disable
559 * return 0 == success
560 */
561static int hns_mac_config_sds_loopback(struct hns_mac_cb *mac_cb, bool en)
562{
563	const u8 lane_id[] = {
564		0,	/* mac 0 -> lane 0 */
565		1,	/* mac 1 -> lane 1 */
566		2,	/* mac 2 -> lane 2 */
567		3,	/* mac 3 -> lane 3 */
568		2,	/* mac 4 -> lane 2 */
569		3,	/* mac 5 -> lane 3 */
570		0,	/* mac 6 -> lane 0 */
571		1	/* mac 7 -> lane 1 */
572	};
573#define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2)
574	u64 reg_offset = RX_CSR(lane_id[mac_cb->mac_id], 0);
575
576	int sfp_prsnt = 0;
577	int ret = hns_mac_get_sfp_prsnt(mac_cb, &sfp_prsnt);
578
579	if (!mac_cb->phy_dev) {
580		if (ret)
581			pr_info("please confirm sfp is present or not\n");
582		else
583			if (!sfp_prsnt)
584				pr_info("no sfp in this eth\n");
585	}
586
587	if (mac_cb->serdes_ctrl) {
588		u32 origin = 0;
589
590		if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) {
591#define HILINK_ACCESS_SEL_CFG		0x40008
592			/* hilink4 & hilink3 use the same xge training and
593			 * xge u adaptor. There is a hilink access sel cfg
594			 * register to select which one to be configed
595			 */
596			if ((!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) &&
597			    (mac_cb->mac_id <= 3))
598				dsaf_write_syscon(mac_cb->serdes_ctrl,
599						  HILINK_ACCESS_SEL_CFG, 0);
600			else
601				dsaf_write_syscon(mac_cb->serdes_ctrl,
602						  HILINK_ACCESS_SEL_CFG, 3);
603		}
604
605		ret = dsaf_read_syscon(mac_cb->serdes_ctrl, reg_offset,
606				       &origin);
607		if (ret)
608			return ret;
609
610		dsaf_set_field(origin, 1ull << 10, 10, en);
611		dsaf_write_syscon(mac_cb->serdes_ctrl, reg_offset, origin);
612	} else {
613		u8 __iomem *base_addr = mac_cb->serdes_vaddr +
614				(mac_cb->mac_id <= 3 ? 0x00280000 : 0x00200000);
615		dsaf_set_reg_field(base_addr, reg_offset, 1ull << 10, 10, en);
616	}
617
618	return 0;
619}
620
621static int
622hns_mac_config_sds_loopback_acpi(struct hns_mac_cb *mac_cb, bool en)
623{
624	union acpi_object *obj;
625	union acpi_object obj_args[3], argv4;
626
627	obj_args[0].integer.type = ACPI_TYPE_INTEGER;
628	obj_args[0].integer.value = mac_cb->mac_id;
629	obj_args[1].integer.type = ACPI_TYPE_INTEGER;
630	obj_args[1].integer.value = en;
631
632	argv4.type = ACPI_TYPE_PACKAGE;
633	argv4.package.count = 2;
634	argv4.package.elements = obj_args;
635
636	obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dsaf_dev->dev),
637				&hns_dsaf_acpi_dsm_guid, 0,
638				HNS_OP_SERDES_LP_FUNC, &argv4);
639	if (!obj) {
640		dev_warn(mac_cb->dsaf_dev->dev, "set port%d serdes lp fail!",
641			 mac_cb->mac_id);
642
643		return -ENOTSUPP;
644	}
645
646	ACPI_FREE(obj);
647
648	return 0;
649}
650
651struct dsaf_misc_op *hns_misc_op_get(struct dsaf_device *dsaf_dev)
652{
653	struct dsaf_misc_op *misc_op;
654
655	misc_op = devm_kzalloc(dsaf_dev->dev, sizeof(*misc_op), GFP_KERNEL);
656	if (!misc_op)
657		return NULL;
658
659	if (dev_of_node(dsaf_dev->dev)) {
660		misc_op->cpld_set_led = hns_cpld_set_led;
661		misc_op->cpld_reset_led = cpld_led_reset;
662		misc_op->cpld_set_led_id = cpld_set_led_id;
663
664		misc_op->dsaf_reset = hns_dsaf_rst;
665		misc_op->xge_srst = hns_dsaf_xge_srst_by_port;
666		misc_op->ge_srst = hns_dsaf_ge_srst_by_port;
667		misc_op->ppe_srst = hns_ppe_srst_by_port;
668		misc_op->ppe_comm_srst = hns_ppe_com_srst;
669
670		misc_op->get_phy_if = hns_mac_get_phy_if;
671		misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt;
672
673		misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback;
674	} else if (is_acpi_node(dsaf_dev->dev->fwnode)) {
675		misc_op->cpld_set_led = hns_cpld_set_led_acpi;
676		misc_op->cpld_reset_led = cpld_led_reset_acpi;
677		misc_op->cpld_set_led_id = cpld_set_led_id_acpi;
678
679		misc_op->dsaf_reset = hns_dsaf_rst_acpi;
680		misc_op->xge_srst = hns_dsaf_xge_srst_by_port_acpi;
681		misc_op->ge_srst = hns_dsaf_ge_srst_by_port_acpi;
682		misc_op->ppe_srst = hns_ppe_srst_by_port_acpi;
683		misc_op->ppe_comm_srst = hns_ppe_com_srst;
684
685		misc_op->get_phy_if = hns_mac_get_phy_if_acpi;
686		misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt_acpi;
687
688		misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback_acpi;
689	} else {
690		devm_kfree(dsaf_dev->dev, (void *)misc_op);
691		misc_op = NULL;
692	}
693
694	return (void *)misc_op;
695}
696
697struct
698platform_device *hns_dsaf_find_platform_device(struct fwnode_handle *fwnode)
699{
700	struct device *dev;
701
702	dev = bus_find_device_by_fwnode(&platform_bus_type, fwnode);
703	return dev ? to_platform_device(dev) : NULL;
704}