Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 | // SPDX-License-Identifier: GPL-2.0-or-later /* * cx88-vp3054-i2c.c -- support for the secondary I2C bus of the * DNTV Live! DVB-T Pro (VP-3054), wired as: * GPIO[0] -> SCL, GPIO[1] -> SDA * * (c) 2005 Chris Pascoe <c.pascoe@itee.uq.edu.au> */ #include "cx88.h" #include "cx88-vp3054-i2c.h" #include <linux/module.h> #include <linux/slab.h> #include <linux/init.h> #include <linux/io.h> MODULE_DESCRIPTION("driver for cx2388x VP3054 design"); MODULE_AUTHOR("Chris Pascoe <c.pascoe@itee.uq.edu.au>"); MODULE_LICENSE("GPL"); /* ----------------------------------------------------------------------- */ static void vp3054_bit_setscl(void *data, int state) { struct cx8802_dev *dev = data; struct cx88_core *core = dev->core; struct vp3054_i2c_state *vp3054_i2c = dev->vp3054; if (state) { vp3054_i2c->state |= 0x0001; /* SCL high */ vp3054_i2c->state &= ~0x0100; /* external pullup */ } else { vp3054_i2c->state &= ~0x0001; /* SCL low */ vp3054_i2c->state |= 0x0100; /* drive pin */ } cx_write(MO_GP0_IO, 0x010000 | vp3054_i2c->state); cx_read(MO_GP0_IO); } static void vp3054_bit_setsda(void *data, int state) { struct cx8802_dev *dev = data; struct cx88_core *core = dev->core; struct vp3054_i2c_state *vp3054_i2c = dev->vp3054; if (state) { vp3054_i2c->state |= 0x0002; /* SDA high */ vp3054_i2c->state &= ~0x0200; /* tristate pin */ } else { vp3054_i2c->state &= ~0x0002; /* SDA low */ vp3054_i2c->state |= 0x0200; /* drive pin */ } cx_write(MO_GP0_IO, 0x020000 | vp3054_i2c->state); cx_read(MO_GP0_IO); } static int vp3054_bit_getscl(void *data) { struct cx8802_dev *dev = data; struct cx88_core *core = dev->core; u32 state; state = cx_read(MO_GP0_IO); return (state & 0x01) ? 1 : 0; } static int vp3054_bit_getsda(void *data) { struct cx8802_dev *dev = data; struct cx88_core *core = dev->core; u32 state; state = cx_read(MO_GP0_IO); return (state & 0x02) ? 1 : 0; } /* ----------------------------------------------------------------------- */ static const struct i2c_algo_bit_data vp3054_i2c_algo_template = { .setsda = vp3054_bit_setsda, .setscl = vp3054_bit_setscl, .getsda = vp3054_bit_getsda, .getscl = vp3054_bit_getscl, .udelay = 16, .timeout = 200, }; /* ----------------------------------------------------------------------- */ int vp3054_i2c_probe(struct cx8802_dev *dev) { struct cx88_core *core = dev->core; struct vp3054_i2c_state *vp3054_i2c; int rc; if (core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO) return 0; vp3054_i2c = kzalloc(sizeof(*vp3054_i2c), GFP_KERNEL); if (!vp3054_i2c) return -ENOMEM; dev->vp3054 = vp3054_i2c; vp3054_i2c->algo = vp3054_i2c_algo_template; vp3054_i2c->adap.dev.parent = &dev->pci->dev; strscpy(vp3054_i2c->adap.name, core->name, sizeof(vp3054_i2c->adap.name)); vp3054_i2c->adap.owner = THIS_MODULE; vp3054_i2c->algo.data = dev; i2c_set_adapdata(&vp3054_i2c->adap, dev); vp3054_i2c->adap.algo_data = &vp3054_i2c->algo; vp3054_bit_setscl(dev, 1); vp3054_bit_setsda(dev, 1); rc = i2c_bit_add_bus(&vp3054_i2c->adap); if (rc != 0) { pr_err("vp3054_i2c register FAILED\n"); kfree(dev->vp3054); dev->vp3054 = NULL; } return rc; } EXPORT_SYMBOL(vp3054_i2c_probe); void vp3054_i2c_remove(struct cx8802_dev *dev) { struct vp3054_i2c_state *vp3054_i2c = dev->vp3054; if (!vp3054_i2c || dev->core->boardnr != CX88_BOARD_DNTV_LIVE_DVB_T_PRO) return; i2c_del_adapter(&vp3054_i2c->adap); kfree(vp3054_i2c); } EXPORT_SYMBOL(vp3054_i2c_remove); |