tw5864-util.c 930 B

1234567891011121314151617181920212223242526272829303132333435363738
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include "tw5864.h"
  3. void tw5864_indir_writeb(struct tw5864_dev *dev, u16 addr, u8 data)
  4. {
  5. int retries = 30000;
  6. while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
  7. ;
  8. if (!retries)
  9. dev_err(&dev->pci->dev,
  10. "tw_indir_writel() retries exhausted before writing\n");
  11. tw_writel(TW5864_IND_DATA, data);
  12. tw_writel(TW5864_IND_CTL, addr << 2 | TW5864_RW | TW5864_ENABLE);
  13. }
  14. u8 tw5864_indir_readb(struct tw5864_dev *dev, u16 addr)
  15. {
  16. int retries = 30000;
  17. while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
  18. ;
  19. if (!retries)
  20. dev_err(&dev->pci->dev,
  21. "tw_indir_readl() retries exhausted before reading\n");
  22. tw_writel(TW5864_IND_CTL, addr << 2 | TW5864_ENABLE);
  23. retries = 30000;
  24. while (tw_readl(TW5864_IND_CTL) & BIT(31) && --retries)
  25. ;
  26. if (!retries)
  27. dev_err(&dev->pci->dev,
  28. "tw_indir_readl() retries exhausted at reading\n");
  29. return tw_readl(TW5864_IND_DATA);
  30. }