1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * ZyDAS ZD1301 driver (USB interface) 4 * 5 * Copyright (C) 2015 Antti Palosaari <crope@iki.fi> 6 */ 7 8 #include "dvb_usb.h" 9 #include "zd1301_demod.h" 10 #include "mt2060.h" 11 #include <linux/i2c.h> 12 #include <linux/platform_device.h> 13 14 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); 15 16 struct zd1301_dev { 17 #define BUF_LEN 8 18 u8 buf[BUF_LEN]; /* bulk USB control message */ 19 struct zd1301_demod_platform_data demod_pdata; 20 struct mt2060_platform_data mt2060_pdata; 21 struct platform_device *platform_device_demod; 22 struct i2c_client *i2c_client_tuner; 23 }; 24 25 static int zd1301_ctrl_msg(struct dvb_usb_device *d, const u8 *wbuf, 26 unsigned int wlen, u8 *rbuf, unsigned int rlen) 27 { 28 struct zd1301_dev *dev = d_to_priv(d); 29 struct usb_interface *intf = d->intf; 30 int ret, actual_length; 31 32 mutex_lock(&d->usb_mutex); 33 34 memcpy(&dev->buf, wbuf, wlen); 35 36 dev_dbg(&intf->dev, ">>> %*ph\n", wlen, dev->buf); 37 38 ret = usb_bulk_msg(d->udev, usb_sndbulkpipe(d->udev, 0x04), dev->buf, 39 wlen, &actual_length, 1000); 40 if (ret) { 41 dev_err(&intf->dev, "1st usb_bulk_msg() failed %d\n", ret); 42 goto err_mutex_unlock; 43 } 44 45 if (rlen) { 46 ret = usb_bulk_msg(d->udev, usb_rcvbulkpipe(d->udev, 0x83), 47 dev->buf, rlen, &actual_length, 1000); 48 if (ret) { 49 dev_err(&intf->dev, 50 "2nd usb_bulk_msg() failed %d\n", ret); 51 goto err_mutex_unlock; 52 } 53 54 dev_dbg(&intf->dev, "<<< %*ph\n", actual_length, dev->buf); 55 56 if (actual_length != rlen) { 57 /* 58 * Chip replies often with 3 byte len stub. On that case 59 * we have to query new reply. 60 */ 61 dev_dbg(&intf->dev, "repeating reply message\n"); 62 63 ret = usb_bulk_msg(d->udev, 64 usb_rcvbulkpipe(d->udev, 0x83), 65 dev->buf, rlen, &actual_length, 66 1000); 67 if (ret) { 68 dev_err(&intf->dev, 69 "3rd usb_bulk_msg() failed %d\n", ret); 70 goto err_mutex_unlock; 71 } 72 73 dev_dbg(&intf->dev, 74 "<<< %*ph\n", actual_length, dev->buf); 75 } 76 77 memcpy(rbuf, dev->buf, rlen); 78 } 79 80 err_mutex_unlock: 81 mutex_unlock(&d->usb_mutex); 82 return ret; 83 } 84 85 static int zd1301_demod_wreg(void *reg_priv, u16 reg, u8 val) 86 { 87 struct dvb_usb_device *d = reg_priv; 88 struct usb_interface *intf = d->intf; 89 int ret; 90 u8 buf[7] = {0x07, 0x00, 0x03, 0x01, 91 (reg >> 0) & 0xff, (reg >> 8) & 0xff, val}; 92 93 ret = zd1301_ctrl_msg(d, buf, 7, NULL, 0); 94 if (ret) 95 goto err; 96 97 return 0; 98 err: 99 dev_dbg(&intf->dev, "failed=%d\n", ret); 100 return ret; 101 } 102 103 static int zd1301_demod_rreg(void *reg_priv, u16 reg, u8 *val) 104 { 105 struct dvb_usb_device *d = reg_priv; 106 struct usb_interface *intf = d->intf; 107 int ret; 108 u8 buf[7] = {0x07, 0x00, 0x04, 0x01, 109 (reg >> 0) & 0xff, (reg >> 8) & 0xff, 0}; 110 111 ret = zd1301_ctrl_msg(d, buf, 7, buf, 7); 112 if (ret) 113 goto err; 114 115 *val = buf[6]; 116 117 return 0; 118 err: 119 dev_dbg(&intf->dev, "failed=%d\n", ret); 120 return ret; 121 } 122 123 static int zd1301_frontend_attach(struct dvb_usb_adapter *adap) 124 { 125 struct dvb_usb_device *d = adap_to_d(adap); 126 struct zd1301_dev *dev = adap_to_priv(adap); 127 struct usb_interface *intf = d->intf; 128 struct platform_device *pdev; 129 struct i2c_client *client; 130 struct i2c_board_info board_info; 131 struct i2c_adapter *adapter; 132 struct dvb_frontend *frontend; 133 int ret; 134 135 dev_dbg(&intf->dev, "\n"); 136 137 /* Add platform demod */ 138 dev->demod_pdata.reg_priv = d; 139 dev->demod_pdata.reg_read = zd1301_demod_rreg; 140 dev->demod_pdata.reg_write = zd1301_demod_wreg; 141 request_module("%s", "zd1301_demod"); 142 pdev = platform_device_register_data(&intf->dev, 143 "zd1301_demod", 144 PLATFORM_DEVID_AUTO, 145 &dev->demod_pdata, 146 sizeof(dev->demod_pdata)); 147 if (IS_ERR(pdev)) { 148 ret = PTR_ERR(pdev); 149 goto err; 150 } 151 if (!pdev->dev.driver) { 152 ret = -ENODEV; 153 goto err; 154 } 155 if (!try_module_get(pdev->dev.driver->owner)) { 156 ret = -ENODEV; 157 goto err_platform_device_unregister; 158 } 159 160 adapter = zd1301_demod_get_i2c_adapter(pdev); 161 frontend = zd1301_demod_get_dvb_frontend(pdev); 162 if (!adapter || !frontend) { 163 ret = -ENODEV; 164 goto err_module_put_demod; 165 } 166 167 /* Add I2C tuner */ 168 dev->mt2060_pdata.i2c_write_max = 9; 169 dev->mt2060_pdata.dvb_frontend = frontend; 170 memset(&board_info, 0, sizeof(board_info)); 171 strscpy(board_info.type, "mt2060", I2C_NAME_SIZE); 172 board_info.addr = 0x60; 173 board_info.platform_data = &dev->mt2060_pdata; 174 request_module("%s", "mt2060"); 175 client = i2c_new_device(adapter, &board_info); 176 if (!client || !client->dev.driver) { 177 ret = -ENODEV; 178 goto err_module_put_demod; 179 } 180 if (!try_module_get(client->dev.driver->owner)) { 181 ret = -ENODEV; 182 goto err_i2c_unregister_device; 183 } 184 185 dev->platform_device_demod = pdev; 186 dev->i2c_client_tuner = client; 187 adap->fe[0] = frontend; 188 189 return 0; 190 err_i2c_unregister_device: 191 i2c_unregister_device(client); 192 err_module_put_demod: 193 module_put(pdev->dev.driver->owner); 194 err_platform_device_unregister: 195 platform_device_unregister(pdev); 196 err: 197 dev_dbg(&intf->dev, "failed=%d\n", ret); 198 return ret; 199 } 200 201 static int zd1301_frontend_detach(struct dvb_usb_adapter *adap) 202 { 203 struct dvb_usb_device *d = adap_to_d(adap); 204 struct zd1301_dev *dev = d_to_priv(d); 205 struct usb_interface *intf = d->intf; 206 struct platform_device *pdev; 207 struct i2c_client *client; 208 209 dev_dbg(&intf->dev, "\n"); 210 211 client = dev->i2c_client_tuner; 212 pdev = dev->platform_device_demod; 213 214 /* Remove I2C tuner */ 215 if (client) { 216 module_put(client->dev.driver->owner); 217 i2c_unregister_device(client); 218 } 219 220 /* Remove platform demod */ 221 if (pdev) { 222 module_put(pdev->dev.driver->owner); 223 platform_device_unregister(pdev); 224 } 225 226 return 0; 227 } 228 229 static int zd1301_streaming_ctrl(struct dvb_frontend *fe, int onoff) 230 { 231 struct dvb_usb_device *d = fe_to_d(fe); 232 struct usb_interface *intf = d->intf; 233 int ret; 234 u8 buf[3] = {0x03, 0x00, onoff ? 0x07 : 0x08}; 235 236 dev_dbg(&intf->dev, "onoff=%d\n", onoff); 237 238 ret = zd1301_ctrl_msg(d, buf, 3, NULL, 0); 239 if (ret) 240 goto err; 241 242 return 0; 243 err: 244 dev_dbg(&intf->dev, "failed=%d\n", ret); 245 return ret; 246 } 247 248 static const struct dvb_usb_device_properties zd1301_props = { 249 .driver_name = KBUILD_MODNAME, 250 .owner = THIS_MODULE, 251 .adapter_nr = adapter_nr, 252 .size_of_priv = sizeof(struct zd1301_dev), 253 254 .frontend_attach = zd1301_frontend_attach, 255 .frontend_detach = zd1301_frontend_detach, 256 .streaming_ctrl = zd1301_streaming_ctrl, 257 258 .num_adapters = 1, 259 .adapter = { 260 { 261 .stream = DVB_USB_STREAM_BULK(0x81, 6, 21 * 188), 262 }, 263 }, 264 }; 265 266 static const struct usb_device_id zd1301_id_table[] = { 267 {DVB_USB_DEVICE(USB_VID_ZYDAS, 0x13a1, &zd1301_props, 268 "ZyDAS ZD1301 reference design", NULL)}, 269 {} 270 }; 271 MODULE_DEVICE_TABLE(usb, zd1301_id_table); 272 273 /* Usb specific object needed to register this driver with the usb subsystem */ 274 static struct usb_driver zd1301_usb_driver = { 275 .name = KBUILD_MODNAME, 276 .id_table = zd1301_id_table, 277 .probe = dvb_usbv2_probe, 278 .disconnect = dvb_usbv2_disconnect, 279 .suspend = dvb_usbv2_suspend, 280 .resume = dvb_usbv2_resume, 281 .reset_resume = dvb_usbv2_reset_resume, 282 .no_dynamic_id = 1, 283 .soft_unbind = 1, 284 }; 285 module_usb_driver(zd1301_usb_driver); 286 287 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 288 MODULE_DESCRIPTION("ZyDAS ZD1301 driver"); 289 MODULE_LICENSE("GPL"); 290