cx23885-ioctl.c 2.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Driver for the Conexant CX23885/7/8 PCIe bridge
  4. *
  5. * Various common ioctl() support functions
  6. *
  7. * Copyright (c) 2009 Andy Walls <[email protected]>
  8. */
  9. #include "cx23885.h"
  10. #include "cx23885-ioctl.h"
  11. #ifdef CONFIG_VIDEO_ADV_DEBUG
  12. int cx23885_g_chip_info(struct file *file, void *fh,
  13. struct v4l2_dbg_chip_info *chip)
  14. {
  15. struct cx23885_dev *dev = video_drvdata(file);
  16. if (chip->match.addr > 1)
  17. return -EINVAL;
  18. if (chip->match.addr == 1) {
  19. if (dev->v4l_device == NULL)
  20. return -EINVAL;
  21. strscpy(chip->name, "cx23417", sizeof(chip->name));
  22. } else {
  23. strscpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name));
  24. }
  25. return 0;
  26. }
  27. static int cx23417_g_register(struct cx23885_dev *dev,
  28. struct v4l2_dbg_register *reg)
  29. {
  30. u32 value;
  31. if (dev->v4l_device == NULL)
  32. return -EINVAL;
  33. if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
  34. return -EINVAL;
  35. if (mc417_register_read(dev, (u16) reg->reg, &value))
  36. return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
  37. reg->size = 4;
  38. reg->val = value;
  39. return 0;
  40. }
  41. int cx23885_g_register(struct file *file, void *fh,
  42. struct v4l2_dbg_register *reg)
  43. {
  44. struct cx23885_dev *dev = video_drvdata(file);
  45. if (reg->match.addr > 1)
  46. return -EINVAL;
  47. if (reg->match.addr)
  48. return cx23417_g_register(dev, reg);
  49. if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
  50. return -EINVAL;
  51. reg->size = 4;
  52. reg->val = cx_read(reg->reg);
  53. return 0;
  54. }
  55. static int cx23417_s_register(struct cx23885_dev *dev,
  56. const struct v4l2_dbg_register *reg)
  57. {
  58. if (dev->v4l_device == NULL)
  59. return -EINVAL;
  60. if ((reg->reg & 0x3) != 0 || reg->reg >= 0x10000)
  61. return -EINVAL;
  62. if (mc417_register_write(dev, (u16) reg->reg, (u32) reg->val))
  63. return -EINVAL; /* V4L2 spec, but -EREMOTEIO really */
  64. return 0;
  65. }
  66. int cx23885_s_register(struct file *file, void *fh,
  67. const struct v4l2_dbg_register *reg)
  68. {
  69. struct cx23885_dev *dev = video_drvdata(file);
  70. if (reg->match.addr > 1)
  71. return -EINVAL;
  72. if (reg->match.addr)
  73. return cx23417_s_register(dev, reg);
  74. if ((reg->reg & 0x3) != 0 || reg->reg >= pci_resource_len(dev->pci, 0))
  75. return -EINVAL;
  76. cx_write(reg->reg, reg->val);
  77. return 0;
  78. }
  79. #endif