g94.c 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172
  1. /*
  2. * Copyright 2012 Red Hat Inc.
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a
  5. * copy of this software and associated documentation files (the "Software"),
  6. * to deal in the Software without restriction, including without limitation
  7. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8. * and/or sell copies of the Software, and to permit persons to whom the
  9. * Software is furnished to do so, subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in
  12. * all copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  17. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20. * OTHER DEALINGS IN THE SOFTWARE.
  21. *
  22. * Authors: Ben Skeggs
  23. */
  24. #include "priv.h"
  25. #include "pad.h"
  26. void
  27. g94_aux_stat(struct nvkm_i2c *i2c, u32 *hi, u32 *lo, u32 *rq, u32 *tx)
  28. {
  29. struct nvkm_device *device = i2c->subdev.device;
  30. u32 intr = nvkm_rd32(device, 0x00e06c);
  31. u32 stat = nvkm_rd32(device, 0x00e068) & intr, i;
  32. for (i = 0, *hi = *lo = *rq = *tx = 0; i < 8; i++) {
  33. if ((stat & (1 << (i * 4)))) *hi |= 1 << i;
  34. if ((stat & (2 << (i * 4)))) *lo |= 1 << i;
  35. if ((stat & (4 << (i * 4)))) *rq |= 1 << i;
  36. if ((stat & (8 << (i * 4)))) *tx |= 1 << i;
  37. }
  38. nvkm_wr32(device, 0x00e06c, intr);
  39. }
  40. void
  41. g94_aux_mask(struct nvkm_i2c *i2c, u32 type, u32 mask, u32 data)
  42. {
  43. struct nvkm_device *device = i2c->subdev.device;
  44. u32 temp = nvkm_rd32(device, 0x00e068), i;
  45. for (i = 0; i < 8; i++) {
  46. if (mask & (1 << i)) {
  47. if (!(data & (1 << i))) {
  48. temp &= ~(type << (i * 4));
  49. continue;
  50. }
  51. temp |= type << (i * 4);
  52. }
  53. }
  54. nvkm_wr32(device, 0x00e068, temp);
  55. }
  56. static const struct nvkm_i2c_func
  57. g94_i2c = {
  58. .pad_x_new = g94_i2c_pad_x_new,
  59. .pad_s_new = g94_i2c_pad_s_new,
  60. .aux = 4,
  61. .aux_stat = g94_aux_stat,
  62. .aux_mask = g94_aux_mask,
  63. };
  64. int
  65. g94_i2c_new(struct nvkm_device *device, int index, struct nvkm_i2c **pi2c)
  66. {
  67. return nvkm_i2c_new_(&g94_i2c, device, index, pi2c);
  68. }