hns_dsaf_misc.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644
  1. /*
  2. * Copyright (c) 2014-2015 Hisilicon Limited.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation; either version 2 of the License, or
  7. * (at your option) any later version.
  8. */
  9. #include "hns_dsaf_mac.h"
  10. #include "hns_dsaf_misc.h"
  11. #include "hns_dsaf_ppe.h"
  12. #include "hns_dsaf_reg.h"
  13. enum _dsm_op_index {
  14. HNS_OP_RESET_FUNC = 0x1,
  15. HNS_OP_SERDES_LP_FUNC = 0x2,
  16. HNS_OP_LED_SET_FUNC = 0x3,
  17. HNS_OP_GET_PORT_TYPE_FUNC = 0x4,
  18. HNS_OP_GET_SFP_STAT_FUNC = 0x5,
  19. };
  20. enum _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. const guid_t hns_dsaf_acpi_dsm_guid =
  29. GUID_INIT(0x1A85AA1A, 0xE293, 0x415E,
  30. 0x8E, 0x28, 0x8D, 0x69, 0x0A, 0x0F, 0x82, 0x0A);
  31. static void dsaf_write_sub(struct dsaf_device *dsaf_dev, u32 reg, u32 val)
  32. {
  33. if (dsaf_dev->sub_ctrl)
  34. dsaf_write_syscon(dsaf_dev->sub_ctrl, reg, val);
  35. else
  36. dsaf_write_reg(dsaf_dev->sc_base, reg, val);
  37. }
  38. static u32 dsaf_read_sub(struct dsaf_device *dsaf_dev, u32 reg)
  39. {
  40. u32 ret;
  41. if (dsaf_dev->sub_ctrl)
  42. ret = dsaf_read_syscon(dsaf_dev->sub_ctrl, reg);
  43. else
  44. ret = dsaf_read_reg(dsaf_dev->sc_base, reg);
  45. return ret;
  46. }
  47. static void hns_cpld_set_led(struct hns_mac_cb *mac_cb, int link_status,
  48. u16 speed, int data)
  49. {
  50. int speed_reg = 0;
  51. u8 value;
  52. if (!mac_cb) {
  53. pr_err("sfp_led_opt mac_dev is null!\n");
  54. return;
  55. }
  56. if (!mac_cb->cpld_ctrl) {
  57. dev_err(mac_cb->dev, "mac_id=%d, cpld syscon is null !\n",
  58. mac_cb->mac_id);
  59. return;
  60. }
  61. if (speed == MAC_SPEED_10000)
  62. speed_reg = 1;
  63. value = mac_cb->cpld_led_value;
  64. if (link_status) {
  65. dsaf_set_bit(value, DSAF_LED_LINK_B, link_status);
  66. dsaf_set_field(value, DSAF_LED_SPEED_M,
  67. DSAF_LED_SPEED_S, speed_reg);
  68. dsaf_set_bit(value, DSAF_LED_DATA_B, data);
  69. if (value != mac_cb->cpld_led_value) {
  70. dsaf_write_syscon(mac_cb->cpld_ctrl,
  71. mac_cb->cpld_ctrl_reg, value);
  72. mac_cb->cpld_led_value = value;
  73. }
  74. } else {
  75. value = (mac_cb->cpld_led_value) & (0x1 << DSAF_LED_ANCHOR_B);
  76. dsaf_write_syscon(mac_cb->cpld_ctrl,
  77. mac_cb->cpld_ctrl_reg, value);
  78. mac_cb->cpld_led_value = value;
  79. }
  80. }
  81. static void cpld_led_reset(struct hns_mac_cb *mac_cb)
  82. {
  83. if (!mac_cb || !mac_cb->cpld_ctrl)
  84. return;
  85. dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
  86. CPLD_LED_DEFAULT_VALUE);
  87. mac_cb->cpld_led_value = CPLD_LED_DEFAULT_VALUE;
  88. }
  89. static int cpld_set_led_id(struct hns_mac_cb *mac_cb,
  90. enum hnae_led_state status)
  91. {
  92. switch (status) {
  93. case HNAE_LED_ACTIVE:
  94. mac_cb->cpld_led_value =
  95. dsaf_read_syscon(mac_cb->cpld_ctrl,
  96. mac_cb->cpld_ctrl_reg);
  97. dsaf_set_bit(mac_cb->cpld_led_value, DSAF_LED_ANCHOR_B,
  98. CPLD_LED_ON_VALUE);
  99. dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
  100. mac_cb->cpld_led_value);
  101. break;
  102. case HNAE_LED_INACTIVE:
  103. dsaf_set_bit(mac_cb->cpld_led_value, DSAF_LED_ANCHOR_B,
  104. CPLD_LED_DEFAULT_VALUE);
  105. dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,
  106. mac_cb->cpld_led_value);
  107. break;
  108. default:
  109. dev_err(mac_cb->dev, "invalid led state: %d!", status);
  110. return -EINVAL;
  111. }
  112. return 0;
  113. }
  114. #define RESET_REQ_OR_DREQ 1
  115. static void hns_dsaf_acpi_srst_by_port(struct dsaf_device *dsaf_dev, u8 op_type,
  116. u32 port_type, u32 port, u32 val)
  117. {
  118. union acpi_object *obj;
  119. union acpi_object obj_args[3], argv4;
  120. obj_args[0].integer.type = ACPI_TYPE_INTEGER;
  121. obj_args[0].integer.value = port_type;
  122. obj_args[1].integer.type = ACPI_TYPE_INTEGER;
  123. obj_args[1].integer.value = port;
  124. obj_args[2].integer.type = ACPI_TYPE_INTEGER;
  125. obj_args[2].integer.value = val;
  126. argv4.type = ACPI_TYPE_PACKAGE;
  127. argv4.package.count = 3;
  128. argv4.package.elements = obj_args;
  129. obj = acpi_evaluate_dsm(ACPI_HANDLE(dsaf_dev->dev),
  130. &hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);
  131. if (!obj) {
  132. dev_warn(dsaf_dev->dev, "reset port_type%d port%d fail!",
  133. port_type, port);
  134. return;
  135. }
  136. ACPI_FREE(obj);
  137. }
  138. static void hns_dsaf_rst(struct dsaf_device *dsaf_dev, bool dereset)
  139. {
  140. u32 xbar_reg_addr;
  141. u32 nt_reg_addr;
  142. if (!dereset) {
  143. xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_REQ_REG;
  144. nt_reg_addr = DSAF_SUB_SC_NT_RESET_REQ_REG;
  145. } else {
  146. xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_DREQ_REG;
  147. nt_reg_addr = DSAF_SUB_SC_NT_RESET_DREQ_REG;
  148. }
  149. dsaf_write_sub(dsaf_dev, xbar_reg_addr, RESET_REQ_OR_DREQ);
  150. dsaf_write_sub(dsaf_dev, nt_reg_addr, RESET_REQ_OR_DREQ);
  151. }
  152. static void hns_dsaf_rst_acpi(struct dsaf_device *dsaf_dev, bool dereset)
  153. {
  154. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  155. HNS_DSAF_RESET_FUNC,
  156. 0, dereset);
  157. }
  158. static void hns_dsaf_xge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
  159. bool dereset)
  160. {
  161. u32 reg_val = 0;
  162. u32 reg_addr;
  163. if (port >= DSAF_XGE_NUM)
  164. return;
  165. reg_val |= RESET_REQ_OR_DREQ;
  166. reg_val |= 0x2082082 << dsaf_dev->mac_cb[port]->port_rst_off;
  167. if (!dereset)
  168. reg_addr = DSAF_SUB_SC_XGE_RESET_REQ_REG;
  169. else
  170. reg_addr = DSAF_SUB_SC_XGE_RESET_DREQ_REG;
  171. dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
  172. }
  173. static void hns_dsaf_xge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,
  174. u32 port, bool dereset)
  175. {
  176. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  177. HNS_XGE_RESET_FUNC, port, dereset);
  178. }
  179. /**
  180. * hns_dsaf_srst_chns - reset dsaf channels
  181. * @dsaf_dev: dsaf device struct pointer
  182. * @msk: xbar channels mask value:
  183. * bit0-5 for xge0-5
  184. * bit6-11 for ppe0-5
  185. * bit12-17 for roce0-5
  186. * bit18-19 for com/dfx
  187. * @enable: false - request reset , true - drop reset
  188. */
  189. void hns_dsaf_srst_chns(struct dsaf_device *dsaf_dev, u32 msk, bool dereset)
  190. {
  191. u32 reg_addr;
  192. if (!dereset)
  193. reg_addr = DSAF_SUB_SC_DSAF_RESET_REQ_REG;
  194. else
  195. reg_addr = DSAF_SUB_SC_DSAF_RESET_DREQ_REG;
  196. dsaf_write_sub(dsaf_dev, reg_addr, msk);
  197. }
  198. /**
  199. * hns_dsaf_srst_chns - reset dsaf channels
  200. * @dsaf_dev: dsaf device struct pointer
  201. * @msk: xbar channels mask value:
  202. * bit0-5 for xge0-5
  203. * bit6-11 for ppe0-5
  204. * bit12-17 for roce0-5
  205. * bit18-19 for com/dfx
  206. * @enable: false - request reset , true - drop reset
  207. */
  208. void
  209. hns_dsaf_srst_chns_acpi(struct dsaf_device *dsaf_dev, u32 msk, bool dereset)
  210. {
  211. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  212. HNS_DSAF_CHN_RESET_FUNC,
  213. msk, dereset);
  214. }
  215. void hns_dsaf_roce_srst(struct dsaf_device *dsaf_dev, bool dereset)
  216. {
  217. if (!dereset) {
  218. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_ROCEE_RESET_REQ_REG, 1);
  219. } else {
  220. dsaf_write_sub(dsaf_dev,
  221. DSAF_SUB_SC_ROCEE_CLK_DIS_REG, 1);
  222. dsaf_write_sub(dsaf_dev,
  223. DSAF_SUB_SC_ROCEE_RESET_DREQ_REG, 1);
  224. msleep(20);
  225. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_ROCEE_CLK_EN_REG, 1);
  226. }
  227. }
  228. void hns_dsaf_roce_srst_acpi(struct dsaf_device *dsaf_dev, bool dereset)
  229. {
  230. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  231. HNS_ROCE_RESET_FUNC, 0, dereset);
  232. }
  233. static void hns_dsaf_ge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
  234. bool dereset)
  235. {
  236. u32 reg_val_1;
  237. u32 reg_val_2;
  238. u32 port_rst_off;
  239. if (port >= DSAF_GE_NUM)
  240. return;
  241. if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {
  242. reg_val_1 = 0x1 << port;
  243. port_rst_off = dsaf_dev->mac_cb[port]->port_rst_off;
  244. /* there is difference between V1 and V2 in register.*/
  245. reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ?
  246. 0x1041041 : 0x2082082;
  247. reg_val_2 <<= port_rst_off;
  248. if (!dereset) {
  249. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,
  250. reg_val_1);
  251. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ0_REG,
  252. reg_val_2);
  253. } else {
  254. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ0_REG,
  255. reg_val_2);
  256. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,
  257. reg_val_1);
  258. }
  259. } else {
  260. reg_val_1 = 0x15540;
  261. reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 0x100 : 0x40;
  262. reg_val_1 <<= dsaf_dev->reset_offset;
  263. reg_val_2 <<= dsaf_dev->reset_offset;
  264. if (!dereset) {
  265. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,
  266. reg_val_1);
  267. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_REQ_REG,
  268. reg_val_2);
  269. } else {
  270. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,
  271. reg_val_1);
  272. dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_DREQ_REG,
  273. reg_val_2);
  274. }
  275. }
  276. }
  277. static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,
  278. u32 port, bool dereset)
  279. {
  280. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  281. HNS_GE_RESET_FUNC, port, dereset);
  282. }
  283. static void hns_ppe_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,
  284. bool dereset)
  285. {
  286. u32 reg_val = 0;
  287. u32 reg_addr;
  288. reg_val |= RESET_REQ_OR_DREQ << dsaf_dev->mac_cb[port]->port_rst_off;
  289. if (!dereset)
  290. reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;
  291. else
  292. reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;
  293. dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
  294. }
  295. static void
  296. hns_ppe_srst_by_port_acpi(struct dsaf_device *dsaf_dev, u32 port, bool dereset)
  297. {
  298. hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,
  299. HNS_PPE_RESET_FUNC, port, dereset);
  300. }
  301. static void hns_ppe_com_srst(struct dsaf_device *dsaf_dev, bool dereset)
  302. {
  303. u32 reg_val;
  304. u32 reg_addr;
  305. if (!(dev_of_node(dsaf_dev->dev)))
  306. return;
  307. if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {
  308. reg_val = RESET_REQ_OR_DREQ;
  309. if (!dereset)
  310. reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG;
  311. else
  312. reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG;
  313. } else {
  314. reg_val = 0x100 << dsaf_dev->reset_offset;
  315. if (!dereset)
  316. reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;
  317. else
  318. reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;
  319. }
  320. dsaf_write_sub(dsaf_dev, reg_addr, reg_val);
  321. }
  322. /**
  323. * hns_mac_get_sds_mode - get phy ifterface form serdes mode
  324. * @mac_cb: mac control block
  325. * retuen phy interface
  326. */
  327. static phy_interface_t hns_mac_get_phy_if(struct hns_mac_cb *mac_cb)
  328. {
  329. u32 mode;
  330. u32 reg;
  331. bool is_ver1 = AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver);
  332. int mac_id = mac_cb->mac_id;
  333. phy_interface_t phy_if;
  334. if (is_ver1) {
  335. if (HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev))
  336. return PHY_INTERFACE_MODE_SGMII;
  337. if (mac_id >= 0 && mac_id <= 3)
  338. reg = HNS_MAC_HILINK4_REG;
  339. else
  340. reg = HNS_MAC_HILINK3_REG;
  341. } else{
  342. if (!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev) && mac_id <= 3)
  343. reg = HNS_MAC_HILINK4V2_REG;
  344. else
  345. reg = HNS_MAC_HILINK3V2_REG;
  346. }
  347. mode = dsaf_read_sub(mac_cb->dsaf_dev, reg);
  348. if (dsaf_get_bit(mode, mac_cb->port_mode_off))
  349. phy_if = PHY_INTERFACE_MODE_XGMII;
  350. else
  351. phy_if = PHY_INTERFACE_MODE_SGMII;
  352. return phy_if;
  353. }
  354. static phy_interface_t hns_mac_get_phy_if_acpi(struct hns_mac_cb *mac_cb)
  355. {
  356. phy_interface_t phy_if = PHY_INTERFACE_MODE_NA;
  357. union acpi_object *obj;
  358. union acpi_object obj_args, argv4;
  359. obj_args.integer.type = ACPI_TYPE_INTEGER;
  360. obj_args.integer.value = mac_cb->mac_id;
  361. argv4.type = ACPI_TYPE_PACKAGE,
  362. argv4.package.count = 1,
  363. argv4.package.elements = &obj_args,
  364. obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),
  365. &hns_dsaf_acpi_dsm_guid, 0,
  366. HNS_OP_GET_PORT_TYPE_FUNC, &argv4);
  367. if (!obj || obj->type != ACPI_TYPE_INTEGER)
  368. return phy_if;
  369. phy_if = obj->integer.value ?
  370. PHY_INTERFACE_MODE_XGMII : PHY_INTERFACE_MODE_SGMII;
  371. dev_dbg(mac_cb->dev, "mac_id=%d, phy_if=%d\n", mac_cb->mac_id, phy_if);
  372. ACPI_FREE(obj);
  373. return phy_if;
  374. }
  375. int hns_mac_get_sfp_prsnt(struct hns_mac_cb *mac_cb, int *sfp_prsnt)
  376. {
  377. if (!mac_cb->cpld_ctrl)
  378. return -ENODEV;
  379. *sfp_prsnt = !dsaf_read_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg
  380. + MAC_SFP_PORT_OFFSET);
  381. return 0;
  382. }
  383. int hns_mac_get_sfp_prsnt_acpi(struct hns_mac_cb *mac_cb, int *sfp_prsnt)
  384. {
  385. union acpi_object *obj;
  386. union acpi_object obj_args, argv4;
  387. obj_args.integer.type = ACPI_TYPE_INTEGER;
  388. obj_args.integer.value = mac_cb->mac_id;
  389. argv4.type = ACPI_TYPE_PACKAGE,
  390. argv4.package.count = 1,
  391. argv4.package.elements = &obj_args,
  392. obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),
  393. &hns_dsaf_acpi_dsm_guid, 0,
  394. HNS_OP_GET_SFP_STAT_FUNC, &argv4);
  395. if (!obj || obj->type != ACPI_TYPE_INTEGER)
  396. return -ENODEV;
  397. *sfp_prsnt = obj->integer.value;
  398. ACPI_FREE(obj);
  399. return 0;
  400. }
  401. /**
  402. * hns_mac_config_sds_loopback - set loop back for serdes
  403. * @mac_cb: mac control block
  404. * retuen 0 == success
  405. */
  406. static int hns_mac_config_sds_loopback(struct hns_mac_cb *mac_cb, bool en)
  407. {
  408. const u8 lane_id[] = {
  409. 0, /* mac 0 -> lane 0 */
  410. 1, /* mac 1 -> lane 1 */
  411. 2, /* mac 2 -> lane 2 */
  412. 3, /* mac 3 -> lane 3 */
  413. 2, /* mac 4 -> lane 2 */
  414. 3, /* mac 5 -> lane 3 */
  415. 0, /* mac 6 -> lane 0 */
  416. 1 /* mac 7 -> lane 1 */
  417. };
  418. #define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2)
  419. u64 reg_offset = RX_CSR(lane_id[mac_cb->mac_id], 0);
  420. int sfp_prsnt;
  421. int ret = hns_mac_get_sfp_prsnt(mac_cb, &sfp_prsnt);
  422. if (!mac_cb->phy_dev) {
  423. if (ret)
  424. pr_info("please confirm sfp is present or not\n");
  425. else
  426. if (!sfp_prsnt)
  427. pr_info("no sfp in this eth\n");
  428. }
  429. if (mac_cb->serdes_ctrl) {
  430. u32 origin;
  431. if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) {
  432. #define HILINK_ACCESS_SEL_CFG 0x40008
  433. /* hilink4 & hilink3 use the same xge training and
  434. * xge u adaptor. There is a hilink access sel cfg
  435. * register to select which one to be configed
  436. */
  437. if ((!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) &&
  438. (mac_cb->mac_id <= 3))
  439. dsaf_write_syscon(mac_cb->serdes_ctrl,
  440. HILINK_ACCESS_SEL_CFG, 0);
  441. else
  442. dsaf_write_syscon(mac_cb->serdes_ctrl,
  443. HILINK_ACCESS_SEL_CFG, 3);
  444. }
  445. origin = dsaf_read_syscon(mac_cb->serdes_ctrl, reg_offset);
  446. dsaf_set_field(origin, 1ull << 10, 10, en);
  447. dsaf_write_syscon(mac_cb->serdes_ctrl, reg_offset, origin);
  448. } else {
  449. u8 *base_addr = (u8 *)mac_cb->serdes_vaddr +
  450. (mac_cb->mac_id <= 3 ? 0x00280000 : 0x00200000);
  451. dsaf_set_reg_field(base_addr, reg_offset, 1ull << 10, 10, en);
  452. }
  453. return 0;
  454. }
  455. static int
  456. hns_mac_config_sds_loopback_acpi(struct hns_mac_cb *mac_cb, bool en)
  457. {
  458. union acpi_object *obj;
  459. union acpi_object obj_args[3], argv4;
  460. obj_args[0].integer.type = ACPI_TYPE_INTEGER;
  461. obj_args[0].integer.value = mac_cb->mac_id;
  462. obj_args[1].integer.type = ACPI_TYPE_INTEGER;
  463. obj_args[1].integer.value = !!en;
  464. argv4.type = ACPI_TYPE_PACKAGE;
  465. argv4.package.count = 2;
  466. argv4.package.elements = obj_args;
  467. obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dsaf_dev->dev),
  468. &hns_dsaf_acpi_dsm_guid, 0,
  469. HNS_OP_SERDES_LP_FUNC, &argv4);
  470. if (!obj) {
  471. dev_warn(mac_cb->dsaf_dev->dev, "set port%d serdes lp fail!",
  472. mac_cb->mac_id);
  473. return -ENOTSUPP;
  474. }
  475. ACPI_FREE(obj);
  476. return 0;
  477. }
  478. struct dsaf_misc_op *hns_misc_op_get(struct dsaf_device *dsaf_dev)
  479. {
  480. struct dsaf_misc_op *misc_op;
  481. misc_op = devm_kzalloc(dsaf_dev->dev, sizeof(*misc_op), GFP_KERNEL);
  482. if (!misc_op)
  483. return NULL;
  484. if (dev_of_node(dsaf_dev->dev)) {
  485. misc_op->cpld_set_led = hns_cpld_set_led;
  486. misc_op->cpld_reset_led = cpld_led_reset;
  487. misc_op->cpld_set_led_id = cpld_set_led_id;
  488. misc_op->dsaf_reset = hns_dsaf_rst;
  489. misc_op->xge_srst = hns_dsaf_xge_srst_by_port;
  490. misc_op->ge_srst = hns_dsaf_ge_srst_by_port;
  491. misc_op->ppe_srst = hns_ppe_srst_by_port;
  492. misc_op->ppe_comm_srst = hns_ppe_com_srst;
  493. misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns;
  494. misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst;
  495. misc_op->get_phy_if = hns_mac_get_phy_if;
  496. misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt;
  497. misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback;
  498. } else if (is_acpi_node(dsaf_dev->dev->fwnode)) {
  499. misc_op->cpld_set_led = hns_cpld_set_led;
  500. misc_op->cpld_reset_led = cpld_led_reset;
  501. misc_op->cpld_set_led_id = cpld_set_led_id;
  502. misc_op->dsaf_reset = hns_dsaf_rst_acpi;
  503. misc_op->xge_srst = hns_dsaf_xge_srst_by_port_acpi;
  504. misc_op->ge_srst = hns_dsaf_ge_srst_by_port_acpi;
  505. misc_op->ppe_srst = hns_ppe_srst_by_port_acpi;
  506. misc_op->ppe_comm_srst = hns_ppe_com_srst;
  507. misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns_acpi;
  508. misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst_acpi;
  509. misc_op->get_phy_if = hns_mac_get_phy_if_acpi;
  510. misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt_acpi;
  511. misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback_acpi;
  512. } else {
  513. devm_kfree(dsaf_dev->dev, (void *)misc_op);
  514. misc_op = NULL;
  515. }
  516. return (void *)misc_op;
  517. }
  518. static int hns_dsaf_dev_match(struct device *dev, void *fwnode)
  519. {
  520. return dev->fwnode == fwnode;
  521. }
  522. struct
  523. platform_device *hns_dsaf_find_platform_device(struct fwnode_handle *fwnode)
  524. {
  525. struct device *dev;
  526. dev = bus_find_device(&platform_bus_type, NULL,
  527. fwnode, hns_dsaf_dev_match);
  528. return dev ? to_platform_device(dev) : NULL;
  529. }