// SPDX-License-Identifier: GPL-2.0
/*
 * Earthsoft PT3 driver
 *
 * Copyright (C) 2014 Akihiro Tsukada <tskd08@gmail.com>
 */

#include <linux/freezer.h>
#include <linux/kernel.h>
#include <linux/kthread.h>
#include <linux/mutex.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/string.h>
#include <linux/sched/signal.h>

#include <media/dmxdev.h>
#include <media/dvbdev.h>
#include <media/dvb_demux.h>
#include <media/dvb_frontend.h>

#include "pt3.h"

DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);

static bool one_adapter;
module_param(one_adapter, bool, 0444);
MODULE_PARM_DESC(one_adapter, "Place FE's together under one adapter.");

static int num_bufs = 4;
module_param(num_bufs, int, 0444);
MODULE_PARM_DESC(num_bufs, "Number of DMA buffer (188KiB) per FE.");


static const struct i2c_algorithm pt3_i2c_algo = {
        .master_xfer   = &pt3_i2c_master_xfer,
        .functionality = &pt3_i2c_functionality,
};

static const struct pt3_adap_config adap_conf[PT3_NUM_FE] = {
        {
                .demod_info = {
                        I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x11),
                },
                .tuner_info = {
                        I2C_BOARD_INFO("qm1d1c0042", 0x63),
                },
                .tuner_cfg.qm1d1c0042 = {
                        .lpf = 1,
                },
                .init_freq = 1049480 - 300,
        },
        {
                .demod_info = {
                        I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x10),
                },
                .tuner_info = {
                        I2C_BOARD_INFO("mxl301rf", 0x62),
                },
                .init_freq = 515142857,
        },
        {
                .demod_info = {
                        I2C_BOARD_INFO(TC90522_I2C_DEV_SAT, 0x13),
                },
                .tuner_info = {
                        I2C_BOARD_INFO("qm1d1c0042", 0x60),
                },
                .tuner_cfg.qm1d1c0042 = {
                        .lpf = 1,
                },
                .init_freq = 1049480 + 300,
        },
        {
                .demod_info = {
                        I2C_BOARD_INFO(TC90522_I2C_DEV_TER, 0x12),
                },
                .tuner_info = {
                        I2C_BOARD_INFO("mxl301rf", 0x61),
                },
                .init_freq = 521142857,
        },
};


struct reg_val {
        u8 reg;
        u8 val;
};

static int
pt3_demod_write(struct pt3_adapter *adap, const struct reg_val *data, int num)
{
        struct i2c_msg msg;
        int i, ret;

        ret = 0;
        msg.addr = adap->i2c_demod->addr;
        msg.flags = 0;
        msg.len = 2;
        for (i = 0; i < num; i++) {
                msg.buf = (u8 *)&data[i];
                ret = i2c_transfer(adap->i2c_demod->adapter, &msg, 1);
                if (ret == 0)
                        ret = -EREMOTE;
                if (ret < 0)
                        return ret;
        }
        return 0;
}

static inline void pt3_lnb_ctrl(struct pt3_board *pt3, bool on)
{
        iowrite32((on ? 0x0f : 0x0c), pt3->regs[0] + REG_SYSTEM_W);
}

static inline struct pt3_adapter *pt3_find_adapter(struct dvb_frontend *fe)
{
        struct pt3_board *pt3;
        int i;

        if (one_adapter) {
                pt3 = fe->dvb->priv;
                for (i = 0; i < PT3_NUM_FE; i++)
                        if (pt3->adaps[i]->fe == fe)
                                return pt3->adaps[i];
        }
        return container_of(fe->dvb, struct pt3_adapter, dvb_adap);
}

/*
 * all 4 tuners in PT3 are packaged in a can module (Sharp VA4M6JC2103).
 * it seems that they share the power lines and Amp power line and
 * adaps[3] controls those powers.
 */
static int
pt3_set_tuner_power(struct pt3_board *pt3, bool tuner_on, bool amp_on)
{
        struct reg_val rv = { 0x1e, 0x99 };

        if (tuner_on)
                rv.val |= 0x40;
        if (amp_on)
                rv.val |= 0x04;
        return pt3_demod_write(pt3->adaps[PT3_NUM_FE - 1], &rv, 1);
}

static int pt3_set_lna(struct dvb_frontend *fe)
{
        struct pt3_adapter *adap;
        struct pt3_board *pt3;
        u32 val;
        int ret;

        /* LNA is shared btw. 2 TERR-tuners */

        adap = pt3_find_adapter(fe);
        val = fe->dtv_property_cache.lna;
        if (val == LNA_AUTO || val == adap->cur_lna)
                return 0;

        pt3 = adap->dvb_adap.priv;
        if (mutex_lock_interruptible(&pt3->lock))
                return -ERESTARTSYS;
        if (val)
                pt3->lna_on_cnt++;
        else
                pt3->lna_on_cnt--;

        if (val && pt3->lna_on_cnt <= 1) {
                pt3->lna_on_cnt = 1;
                ret = pt3_set_tuner_power(pt3, true, true);
        } else if (!val && pt3->lna_on_cnt <= 0) {
                pt3->lna_on_cnt = 0;
                ret = pt3_set_tuner_power(pt3, true, false);
        } else
                ret = 0;
        mutex_unlock(&pt3->lock);
        adap->cur_lna = (val != 0);
        return ret;
}

static int pt3_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage volt)
{
        struct pt3_adapter *adap;
        struct pt3_board *pt3;
        bool on;

        /* LNB power is shared btw. 2 SAT-tuners */

        adap = pt3_find_adapter(fe);
        on = (volt != SEC_VOLTAGE_OFF);
        if (on == adap->cur_lnb)
                return 0;
        adap->cur_lnb = on;
        pt3 = adap->dvb_adap.priv;
        if (mutex_lock_interruptible(&pt3->lock))
                return -ERESTARTSYS;
        if (on)
                pt3->lnb_on_cnt++;
        else
                pt3->lnb_on_cnt--;

        if (on && pt3->lnb_on_cnt <= 1) {
                pt3->lnb_on_cnt = 1;
                pt3_lnb_ctrl(pt3, true);
        } else if (!on && pt3->lnb_on_cnt <= 0) {
                pt3->lnb_on_cnt = 0;
                pt3_lnb_ctrl(pt3, false);
        }
        mutex_unlock(&pt3->lock);
        return 0;
}

/* register values used in pt3_fe_init() */

static const struct reg_val init0_sat[] = {
        { 0x03, 0x01 },
        { 0x1e, 0x10 },
};
static const struct reg_val init0_ter[] = {
        { 0x01, 0x40 },
        { 0x1c, 0x10 },
};
static const struct reg_val cfg_sat[] = {
        { 0x1c, 0x15 },
        { 0x1f, 0x04 },
};
static const struct reg_val cfg_ter[] = {
        { 0x1d, 0x01 },
};

/*
 * pt3_fe_init: initialize demod sub modules and ISDB-T tuners all at once.
 *
 * As for demod IC (TC90522) and ISDB-T tuners (MxL301RF),
 * the i2c sequences for init'ing them are not public and hidden in a ROM,
 * and include the board specific configurations as well.
 * They are stored in a lump and cannot be taken out / accessed separately,
 * thus cannot be moved to the FE/tuner driver.
 */
static int pt3_fe_init(struct pt3_board *pt3)
{
        int i, ret;
        struct dvb_frontend *fe;

        pt3_i2c_reset(pt3);
        ret = pt3_init_all_demods(pt3);
        if (ret < 0) {
                dev_warn(&pt3->pdev->dev, "Failed to init demod chips\n");
                return ret;
        }

        /* additional config? */
        for (i = 0; i < PT3_NUM_FE; i++) {
                fe = pt3->adaps[i]->fe;

                if (fe->ops.delsys[0] == SYS_ISDBS)
                        ret = pt3_demod_write(pt3->adaps[i],
                                              init0_sat, ARRAY_SIZE(init0_sat));
                else
                        ret = pt3_demod_write(pt3->adaps[i],
                                              init0_ter, ARRAY_SIZE(init0_ter));
                if (ret < 0) {
                        dev_warn(&pt3->pdev->dev,
                                 "demod[%d] failed in init sequence0\n", i);
                        return ret;
                }
                ret = fe->ops.init(fe);
                if (ret < 0)
                        return ret;
        }

        usleep_range(2000, 4000);
        ret = pt3_set_tuner_power(pt3, true, false);
        if (ret < 0) {
                dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n");
                return ret;
        }

        /* output pin configuration */
        for (i = 0; i < PT3_NUM_FE; i++) {
                fe = pt3->adaps[i]->fe;
                if (fe->ops.delsys[0] == SYS_ISDBS)
                        ret = pt3_demod_write(pt3->adaps[i],
                                                cfg_sat, ARRAY_SIZE(cfg_sat));
                else
                        ret = pt3_demod_write(pt3->adaps[i],
                                                cfg_ter, ARRAY_SIZE(cfg_ter));
                if (ret < 0) {
                        dev_warn(&pt3->pdev->dev,
                                 "demod[%d] failed in init sequence1\n", i);
                        return ret;
                }
        }
        usleep_range(4000, 6000);

        for (i = 0; i < PT3_NUM_FE; i++) {
                fe = pt3->adaps[i]->fe;
                if (fe->ops.delsys[0] != SYS_ISDBS)
                        continue;
                /* init and wake-up ISDB-S tuners */
                ret = fe->ops.tuner_ops.init(fe);
                if (ret < 0) {
                        dev_warn(&pt3->pdev->dev,
                                 "Failed to init SAT-tuner[%d]\n", i);
                        return ret;
                }
        }
        ret = pt3_init_all_mxl301rf(pt3);
        if (ret < 0) {
                dev_warn(&pt3->pdev->dev, "Failed to init TERR-tuners\n");
                return ret;
        }

        ret = pt3_set_tuner_power(pt3, true, true);
        if (ret < 0) {
                dev_warn(&pt3->pdev->dev, "Failed to control tuner module\n");
                return ret;
        }

        /* Wake up all tuners and make an initial tuning,
         * in order to avoid interference among the tuners in the module,
         * according to the doc from the manufacturer.
         */
        for (i = 0; i < PT3_NUM_FE; i++) {
                fe = pt3->adaps[i]->fe;
                ret = 0;
                if (fe->ops.delsys[0] == SYS_ISDBT)
                        ret = fe->ops.tuner_ops.init(fe);
                /* set only when called from pt3_probe(), not resume() */
                if (ret == 0 && fe->dtv_property_cache.frequency == 0) {
                        fe->dtv_property_cache.frequency =
                                                adap_conf[i].init_freq;
                        ret = fe->ops.tuner_ops.set_params(fe);
                }
                if (ret < 0) {
                        dev_warn(&pt3->pdev->dev,
                                 "Failed in initial tuning of tuner[%d]\n", i);
                        return ret;
                }
        }

        /* and sleep again, waiting to be opened by users. */
        for (i = 0; i < PT3_NUM_FE; i++) {
                fe = pt3->adaps[i]->fe;
                if (fe->ops.tuner_ops.sleep)
                        ret = fe->ops.tuner_ops.sleep(fe);
                if (ret < 0)
                        break;
                if (fe->ops.sleep)
                        ret = fe->ops.sleep(fe);
                if (ret < 0)
                        break;
                if (fe->ops.delsys[0] == SYS_ISDBS)
                        fe->ops.set_voltage = &pt3_set_voltage;
                else
                        fe->ops.set_lna = &pt3_set_lna;
        }
        if (i < PT3_NUM_FE) {
                dev_warn(&pt3->pdev->dev, "FE[%d] failed to standby\n", i);
                return ret;
        }
        return 0;
}


static int pt3_attach_fe(struct pt3_board *pt3, int i)
{
        const struct i2c_board_info *info;
        struct tc90522_config cfg;
        struct i2c_client *cl;
        struct dvb_adapter *dvb_adap;
        int ret;

        info = &adap_conf[i].demod_info;
        cfg = adap_conf[i].demod_cfg;
        cfg.tuner_i2c = NULL;

        ret = -ENODEV;
        cl = dvb_module_probe("tc90522", info->type, &pt3->i2c_adap,
                              info->addr, &cfg);
        if (!cl)
                return -ENODEV;
        pt3->adaps[i]->i2c_demod = cl;

        if (!strncmp(cl->name, TC90522_I2C_DEV_SAT,
                     strlen(TC90522_I2C_DEV_SAT))) {
                struct qm1d1c0042_config tcfg;

                tcfg = adap_conf[i].tuner_cfg.qm1d1c0042;
                tcfg.fe = cfg.fe;
                info = &adap_conf[i].tuner_info;
                cl = dvb_module_probe("qm1d1c0042", info->type, cfg.tuner_i2c,
                                      info->addr, &tcfg);
        } else {
                struct mxl301rf_config tcfg;

                tcfg = adap_conf[i].tuner_cfg.mxl301rf;
                tcfg.fe = cfg.fe;
                info = &adap_conf[i].tuner_info;
                cl = dvb_module_probe("mxl301rf", info->type, cfg.tuner_i2c,
                                      info->addr, &tcfg);
        }
        if (!cl)
                goto err_demod_module_release;
        pt3->adaps[i]->i2c_tuner = cl;

        dvb_adap = &pt3->adaps[one_adapter ? 0 : i]->dvb_adap;
        ret = dvb_register_frontend(dvb_adap, cfg.fe);
        if (ret < 0)
                goto err_tuner_module_release;
        pt3->adaps[i]->fe = cfg.fe;
        return 0;

err_tuner_module_release:
        dvb_module_release(pt3->adaps[i]->i2c_tuner);
err_demod_module_release:
        dvb_module_release(pt3->adaps[i]->i2c_demod);

        return ret;
}


static int pt3_fetch_thread(void *data)
{
        struct pt3_adapter *adap = data;
        ktime_t delay;
        bool was_frozen;

#define PT3_INITIAL_BUF_DROPS 4
#define PT3_FETCH_DELAY 10
#define PT3_FETCH_DELAY_DELTA 2

        pt3_init_dmabuf(adap);
        adap->num_discard = PT3_INITIAL_BUF_DROPS;

        dev_dbg(adap->dvb_adap.device, "PT3: [%s] started\n",
                adap->thread->comm);
        set_freezable();
        while (!kthread_freezable_should_stop(&was_frozen)) {
                if (was_frozen)
                        adap->num_discard = PT3_INITIAL_BUF_DROPS;

                pt3_proc_dma(adap);

                delay = ktime_set(0, PT3_FETCH_DELAY * NSEC_PER_MSEC);
                set_current_state(TASK_UNINTERRUPTIBLE|TASK_FREEZABLE);
                schedule_hrtimeout_range(&delay,
                                        PT3_FETCH_DELAY_DELTA * NSEC_PER_MSEC,
                                        HRTIMER_MODE_REL);
        }
        dev_dbg(adap->dvb_adap.device, "PT3: [%s] exited\n",
                adap->thread->comm);
        return 0;
}

static int pt3_start_streaming(struct pt3_adapter *adap)
{
        struct task_struct *thread;

        /* start fetching thread */
        thread = kthread_run(pt3_fetch_thread, adap, "pt3-ad%i-dmx%i",
                                adap->dvb_adap.num, adap->dmxdev.dvbdev->id);
        if (IS_ERR(thread)) {
                int ret = PTR_ERR(thread);

                adap->thread = NULL;
                dev_warn(adap->dvb_adap.device,
                         "PT3 (adap:%d, dmx:%d): failed to start kthread\n",
                         adap->dvb_adap.num, adap->dmxdev.dvbdev->id);
                return ret;
        }
        adap->thread = thread;

        return pt3_start_dma(adap);
}

static int pt3_stop_streaming(struct pt3_adapter *adap)
{
        int ret;

        ret = pt3_stop_dma(adap);
        if (ret)
                dev_warn(adap->dvb_adap.device,
                         "PT3: failed to stop streaming of adap:%d/FE:%d\n",
                         adap->dvb_adap.num, adap->fe->id);

        /* kill the fetching thread */
        ret = kthread_stop(adap->thread);
        adap->thread = NULL;
        return ret;
}

static int pt3_start_feed(struct dvb_demux_feed *feed)
{
        struct pt3_adapter *adap;

        if (signal_pending(current))
                return -EINTR;

        adap = container_of(feed->demux, struct pt3_adapter, demux);
        adap->num_feeds++;
        if (adap->num_feeds > 1)
                return 0;

        return pt3_start_streaming(adap);

}

static int pt3_stop_feed(struct dvb_demux_feed *feed)
{
        struct pt3_adapter *adap;

        adap = container_of(feed->demux, struct pt3_adapter, demux);

        adap->num_feeds--;
        if (adap->num_feeds > 0 || !adap->thread)
                return 0;
        adap->num_feeds = 0;

        return pt3_stop_streaming(adap);
}


static int pt3_alloc_adapter(struct pt3_board *pt3, int index)
{
        int ret;
        struct pt3_adapter *adap;
        struct dvb_adapter *da;

        adap = kzalloc_obj(*adap);
        if (!adap)
                return -ENOMEM;

        pt3->adaps[index] = adap;
        adap->adap_idx = index;

        if (index == 0 || !one_adapter) {
                ret = dvb_register_adapter(&adap->dvb_adap, "PT3 DVB",
                                THIS_MODULE, &pt3->pdev->dev, adapter_nr);
                if (ret < 0) {
                        dev_err(&pt3->pdev->dev,
                                "failed to register adapter dev\n");
                        goto err_mem;
                }
                da = &adap->dvb_adap;
        } else
                da = &pt3->adaps[0]->dvb_adap;

        adap->dvb_adap.priv = pt3;
        adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;
        adap->demux.priv = adap;
        adap->demux.feednum = 256;
        adap->demux.filternum = 256;
        adap->demux.start_feed = pt3_start_feed;
        adap->demux.stop_feed = pt3_stop_feed;
        ret = dvb_dmx_init(&adap->demux);
        if (ret < 0) {
                dev_err(&pt3->pdev->dev, "failed to init dmx dev\n");
                goto err_adap;
        }

        adap->dmxdev.filternum = 256;
        adap->dmxdev.demux = &adap->demux.dmx;
        ret = dvb_dmxdev_init(&adap->dmxdev, da);
        if (ret < 0) {
                dev_err(&pt3->pdev->dev, "failed to init dmxdev\n");
                goto err_demux;
        }

        ret = pt3_alloc_dmabuf(adap);
        if (ret) {
                dev_err(&pt3->pdev->dev, "failed to alloc DMA buffers\n");
                goto err_dmabuf;
        }

        return 0;

err_dmabuf:
        pt3_free_dmabuf(adap);
        dvb_dmxdev_release(&adap->dmxdev);
err_demux:
        dvb_dmx_release(&adap->demux);
err_adap:
        if (index == 0 || !one_adapter)
                dvb_unregister_adapter(da);
err_mem:
        kfree(adap);
        pt3->adaps[index] = NULL;
        return ret;
}

static void pt3_cleanup_adapter(struct pt3_board *pt3, int index)
{
        struct pt3_adapter *adap;
        struct dmx_demux *dmx;

        adap = pt3->adaps[index];
        if (adap == NULL)
                return;

        /* stop demux kthread */
        if (adap->thread)
                pt3_stop_streaming(adap);

        dmx = &adap->demux.dmx;
        dmx->close(dmx);
        if (adap->fe) {
                adap->fe->callback = NULL;
                if (adap->fe->frontend_priv)
                        dvb_unregister_frontend(adap->fe);
                dvb_module_release(adap->i2c_tuner);
                dvb_module_release(adap->i2c_demod);
        }
        pt3_free_dmabuf(adap);
        dvb_dmxdev_release(&adap->dmxdev);
        dvb_dmx_release(&adap->demux);
        if (index == 0 || !one_adapter)
                dvb_unregister_adapter(&adap->dvb_adap);
        kfree(adap);
        pt3->adaps[index] = NULL;
}

#ifdef CONFIG_PM_SLEEP

static int pt3_suspend(struct device *dev)
{
        struct pt3_board *pt3 = dev_get_drvdata(dev);
        int i;
        struct pt3_adapter *adap;

        for (i = 0; i < PT3_NUM_FE; i++) {
                adap = pt3->adaps[i];
                if (adap->num_feeds > 0)
                        pt3_stop_dma(adap);
                dvb_frontend_suspend(adap->fe);
                pt3_free_dmabuf(adap);
        }

        pt3_lnb_ctrl(pt3, false);
        pt3_set_tuner_power(pt3, false, false);
        return 0;
}

static int pt3_resume(struct device *dev)
{
        struct pt3_board *pt3 = dev_get_drvdata(dev);
        int i, ret;
        struct pt3_adapter *adap;

        ret = pt3_fe_init(pt3);
        if (ret)
                return ret;

        if (pt3->lna_on_cnt > 0)
                pt3_set_tuner_power(pt3, true, true);
        if (pt3->lnb_on_cnt > 0)
                pt3_lnb_ctrl(pt3, true);

        for (i = 0; i < PT3_NUM_FE; i++) {
                adap = pt3->adaps[i];
                dvb_frontend_resume(adap->fe);
                ret = pt3_alloc_dmabuf(adap);
                if (ret) {
                        dev_err(&pt3->pdev->dev, "failed to alloc DMA bufs\n");
                        continue;
                }
                if (adap->num_feeds > 0)
                        pt3_start_dma(adap);
        }

        return 0;
}

#endif /* CONFIG_PM_SLEEP */


static void pt3_remove(struct pci_dev *pdev)
{
        struct pt3_board *pt3;
        int i;

        pt3 = pci_get_drvdata(pdev);
        for (i = PT3_NUM_FE - 1; i >= 0; i--)
                pt3_cleanup_adapter(pt3, i);
        i2c_del_adapter(&pt3->i2c_adap);
}

static int pt3_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
        u8 rev;
        u32 ver;
        int i, ret;
        void __iomem *iomem;
        struct pt3_board *pt3;
        struct i2c_adapter *i2c;

        if (pci_read_config_byte(pdev, PCI_REVISION_ID, &rev) || rev != 1)
                return -ENODEV;

        ret = pcim_enable_device(pdev);
        if (ret < 0)
                return -ENODEV;
        pci_set_master(pdev);

        ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
        if (ret) {
                dev_err(&pdev->dev, "Failed to set DMA mask\n");
                return ret;
        }

        pt3 = devm_kzalloc(&pdev->dev, sizeof(*pt3), GFP_KERNEL);
        if (!pt3)
                return -ENOMEM;
        pci_set_drvdata(pdev, pt3);
        pt3->pdev = pdev;
        mutex_init(&pt3->lock);

        iomem = pcim_iomap_region(pdev, 0, DRV_NAME);
        if (IS_ERR(iomem))
                return PTR_ERR(iomem);
        pt3->regs[0] = iomem;

        iomem = pcim_iomap_region(pdev, 2, DRV_NAME);
        if (IS_ERR(iomem))
                return PTR_ERR(iomem);
        pt3->regs[1] = iomem;

        ver = ioread32(pt3->regs[0] + REG_VERSION);
        if ((ver >> 16) != 0x0301) {
                dev_warn(&pdev->dev, "PT%d, I/F-ver.:%d not supported\n",
                         ver >> 24, (ver & 0x00ff0000) >> 16);
                return -ENODEV;
        }

        pt3->num_bufs = clamp_val(num_bufs, MIN_DATA_BUFS, MAX_DATA_BUFS);

        pt3->i2c_buf = devm_kmalloc(&pdev->dev, sizeof(*pt3->i2c_buf), GFP_KERNEL);
        if (!pt3->i2c_buf)
                return -ENOMEM;
        i2c = &pt3->i2c_adap;
        i2c->owner = THIS_MODULE;
        i2c->algo = &pt3_i2c_algo;
        i2c->algo_data = NULL;
        i2c->dev.parent = &pdev->dev;
        strscpy(i2c->name, DRV_NAME, sizeof(i2c->name));
        i2c_set_adapdata(i2c, pt3);
        ret = i2c_add_adapter(i2c);
        if (ret < 0)
                return ret;

        for (i = 0; i < PT3_NUM_FE; i++) {
                ret = pt3_alloc_adapter(pt3, i);
                if (ret < 0)
                        break;

                ret = pt3_attach_fe(pt3, i);
                if (ret < 0)
                        break;
        }
        if (i < PT3_NUM_FE) {
                dev_err(&pdev->dev, "Failed to create FE%d\n", i);
                goto err_cleanup_adapters;
        }

        ret = pt3_fe_init(pt3);
        if (ret < 0) {
                dev_err(&pdev->dev, "Failed to init frontends\n");
                i = PT3_NUM_FE - 1;
                goto err_cleanup_adapters;
        }

        dev_info(&pdev->dev,
                 "successfully init'ed PT%d (fw:0x%02x, I/F:0x%02x)\n",
                 ver >> 24, (ver >> 8) & 0xff, (ver >> 16) & 0xff);
        return 0;

err_cleanup_adapters:
        while (i >= 0)
                pt3_cleanup_adapter(pt3, i--);
        i2c_del_adapter(i2c);
        return ret;
}

static const struct pci_device_id pt3_id_table[] = {
        { PCI_DEVICE_SUB(0x1172, 0x4c15, 0xee8d, 0x0368) },
        { },
};
MODULE_DEVICE_TABLE(pci, pt3_id_table);

static SIMPLE_DEV_PM_OPS(pt3_pm_ops, pt3_suspend, pt3_resume);

static struct pci_driver pt3_driver = {
        .name           = DRV_NAME,
        .probe          = pt3_probe,
        .remove         = pt3_remove,
        .id_table       = pt3_id_table,

        .driver.pm      = &pt3_pm_ops,
};

module_pci_driver(pt3_driver);

MODULE_DESCRIPTION("Earthsoft PT3 Driver");
MODULE_AUTHOR("Akihiro TSUKADA");
MODULE_LICENSE("GPL");