gdsys_rxaui_ctrl.c 1.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2015
  4. * Dirk Eibach, Guntermann & Drunck GmbH, eibach@gdsys.de
  5. *
  6. * (C) Copyright 2017
  7. * Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc
  8. */
  9. #include <common.h>
  10. #include <dm.h>
  11. #include <regmap.h>
  12. #include <misc.h>
  13. struct gdsys_rxaui_ctrl_regs {
  14. u16 gen_cnt;
  15. u16 err_cnt;
  16. u16 succ_cnt;
  17. u16 status;
  18. u16 ctrl_0;
  19. u16 ctrl_1;
  20. };
  21. #define rxaui_ctrl_set(map, member, val) \
  22. regmap_set(map, struct gdsys_rxaui_ctrl_regs, member, val)
  23. #define rxaui_ctrl_get(map, member, valp) \
  24. regmap_get(map, struct gdsys_rxaui_ctrl_regs, member, valp)
  25. struct gdsys_rxaui_ctrl_priv {
  26. struct regmap *map;
  27. bool state;
  28. };
  29. int gdsys_rxaui_set_polarity_inversion(struct udevice *dev, bool val)
  30. {
  31. struct gdsys_rxaui_ctrl_priv *priv = dev_get_priv(dev);
  32. u16 state;
  33. priv->state = !priv->state;
  34. rxaui_ctrl_get(priv->map, ctrl_1, &state);
  35. if (val)
  36. state |= ~0x7800;
  37. else
  38. state &= ~0x7800;
  39. rxaui_ctrl_set(priv->map, ctrl_1, state);
  40. return !priv->state;
  41. }
  42. static const struct misc_ops gdsys_rxaui_ctrl_ops = {
  43. .set_enabled = gdsys_rxaui_set_polarity_inversion,
  44. };
  45. int gdsys_rxaui_ctrl_probe(struct udevice *dev)
  46. {
  47. struct gdsys_rxaui_ctrl_priv *priv = dev_get_priv(dev);
  48. regmap_init_mem(dev_ofnode(dev), &priv->map);
  49. priv->state = false;
  50. return 0;
  51. }
  52. static const struct udevice_id gdsys_rxaui_ctrl_ids[] = {
  53. { .compatible = "gdsys,rxaui_ctrl" },
  54. { }
  55. };
  56. U_BOOT_DRIVER(gdsys_rxaui_ctrl) = {
  57. .name = "gdsys_rxaui_ctrl",
  58. .id = UCLASS_MISC,
  59. .ops = &gdsys_rxaui_ctrl_ops,
  60. .of_match = gdsys_rxaui_ctrl_ids,
  61. .probe = gdsys_rxaui_ctrl_probe,
  62. .priv_auto = sizeof(struct gdsys_rxaui_ctrl_priv),
  63. };