cregit-Linux how code gets into the kernel

Release 4.11 drivers/media/common/saa7146/saa7146_core.c

/*
    saa7146.o - driver for generic saa7146-based hardware

    Copyright (C) 1998-2003 Michael Hunold <michael@mihu.de>

    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/


#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <media/drv-intf/saa7146.h>
#include <linux/module.h>


static int saa7146_num;


unsigned int saa7146_debug;

module_param(saa7146_debug, uint, 0644);
MODULE_PARM_DESC(saa7146_debug, "debug level (default: 0)");

#if 0
static void dump_registers(struct saa7146_dev* dev)
{
        int i = 0;

        pr_info(" @ %li jiffies:\n", jiffies);
        for (i = 0; i <= 0x148; i += 4)
                pr_info("0x%03x: 0x%08x\n", i, saa7146_read(dev, i));
}
#endif

/****************************************************************************
 * gpio and debi helper functions
 ****************************************************************************/


void saa7146_setgpio(struct saa7146_dev *dev, int port, u32 data) { u32 value = 0; BUG_ON(port > 3); value = saa7146_read(dev, GPIO_CTRL); value &= ~(0xff << (8*port)); value |= (data << (8*port)); saa7146_write(dev, GPIO_CTRL, value); }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Morton6084.51%150.00%
Johannes Stezenbach1115.49%150.00%
Total71100.00%2100.00%

/* This DEBI code is based on the saa7146 Stradis driver by Nathan Laredo */
static inline int saa7146_wait_for_debi_done_sleep(struct saa7146_dev *dev, unsigned long us1, unsigned long us2) { unsigned long timeout; int err; /* wait for registers to be programmed */ timeout = jiffies + usecs_to_jiffies(us1); while (1) { err = time_after(jiffies, timeout); if (saa7146_read(dev, MC2) & 2) break; if (err) { pr_debug("%s: %s timed out while waiting for registers getting programmed\n", dev->name, __func__); return -ETIMEDOUT; } msleep(1); } /* wait for transfer to complete */ timeout = jiffies + usecs_to_jiffies(us2); while (1) { err = time_after(jiffies, timeout); if (!(saa7146_read(dev, PSR) & SPCI_DEBI_S)) break; saa7146_read(dev, MC2); if (err) { DEB_S("%s: %s timed out while waiting for transfer completion\n", dev->name, __func__); return -ETIMEDOUT; } msleep(1); } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Andrew Morton8953.61%225.00%
Oliver Endriss6438.55%225.00%
Michael Hunold63.61%112.50%
Joe Perches42.41%112.50%
Harvey Harrison21.20%112.50%
Johann Klammer10.60%112.50%
Total166100.00%8100.00%


static inline int saa7146_wait_for_debi_done_busyloop(struct saa7146_dev *dev, unsigned long us1, unsigned long us2) { unsigned long loops; /* wait for registers to be programmed */ loops = us1; while (1) { if (saa7146_read(dev, MC2) & 2) break; if (!loops--) { pr_err("%s: %s timed out while waiting for registers getting programmed\n", dev->name, __func__); return -ETIMEDOUT; } udelay(1); } /* wait for transfer to complete */ loops = us2 / 5; while (1) { if (!(saa7146_read(dev, PSR) & SPCI_DEBI_S)) break; saa7146_read(dev, MC2); if (!loops--) { DEB_S("%s: %s timed out while waiting for transfer completion\n", dev->name, __func__); return -ETIMEDOUT; } udelay(5); } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Oliver Endriss12286.52%120.00%
Michael Hunold74.96%120.00%
Joe Perches53.55%120.00%
Andrew Morton53.55%120.00%
Harvey Harrison21.42%120.00%
Total141100.00%5100.00%


int saa7146_wait_for_debi_done(struct saa7146_dev *dev, int nobusyloop) { if (nobusyloop) return saa7146_wait_for_debi_done_sleep(dev, 50000, 250000); else return saa7146_wait_for_debi_done_busyloop(dev, 50000, 250000); }

Contributors

PersonTokensPropCommitsCommitProp
Oliver Endriss38100.00%1100.00%
Total38100.00%1100.00%

/**************************************************************************** * general helper functions ****************************************************************************/ /* this is videobuf_vmalloc_to_sg() from videobuf-dma-sg.c make sure virt has been allocated with vmalloc_32(), otherwise the BUG() may be triggered on highmem machines */
static struct scatterlist* vmalloc_to_sg(unsigned char *virt, int nr_pages) { struct scatterlist *sglist; struct page *pg; int i; sglist = kcalloc(nr_pages, sizeof(struct scatterlist), GFP_KERNEL); if (NULL == sglist) return NULL; sg_init_table(sglist, nr_pages); for (i = 0; i < nr_pages; i++, virt += PAGE_SIZE) { pg = vmalloc_to_page(virt); if (NULL == pg) goto err; BUG_ON(PageHighMem(pg)); sg_set_page(&sglist[i], pg, PAGE_SIZE, 0); } return sglist; err: kfree(sglist); return NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox10983.21%116.67%
Jens Axboe1511.45%233.33%
Panagiotis Issaris32.29%116.67%
Eric Sesterhenn / Snakebyte32.29%116.67%
Michael Hunold10.76%116.67%
Total131100.00%6100.00%

/********************************************************************************/ /* common page table functions */
void *saa7146_vmalloc_build_pgtable(struct pci_dev *pci, long length, struct saa7146_pgtable *pt) { int pages = (length+PAGE_SIZE-1)/PAGE_SIZE; void *mem = vmalloc_32(length); int slen = 0; if (NULL == mem) goto err_null; if (!(pt->slist = vmalloc_to_sg(mem, pages))) goto err_free_mem; if (saa7146_pgtable_alloc(pci, pt)) goto err_free_slist; pt->nents = pages; slen = pci_map_sg(pci,pt->slist,pt->nents,PCI_DMA_FROMDEVICE); if (0 == slen) goto err_free_pgtable; if (0 != saa7146_pgtable_build_single(pci, pt, pt->slist, slen)) goto err_unmap_sg; return mem; err_unmap_sg: pci_unmap_sg(pci, pt->slist, pt->nents, PCI_DMA_FROMDEVICE); err_free_pgtable: saa7146_pgtable_free(pci, pt); err_free_slist: kfree(pt->slist); pt->slist = NULL; err_free_mem: vfree(mem); err_null: return NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Jon Burgess9448.45%120.00%
Alan Cox8744.85%120.00%
Andrew Morton115.67%240.00%
Oliver Endriss21.03%120.00%
Total194100.00%5100.00%


void saa7146_vfree_destroy_pgtable(struct pci_dev *pci, void *mem, struct saa7146_pgtable *pt) { pci_unmap_sg(pci, pt->slist, pt->nents, PCI_DMA_FROMDEVICE); saa7146_pgtable_free(pci, pt); kfree(pt->slist); pt->slist = NULL; vfree(mem); }

Contributors

PersonTokensPropCommitsCommitProp
Jon Burgess3661.02%120.00%
Alan Cox1728.81%120.00%
Andrew Morton58.47%240.00%
Oliver Endriss11.69%120.00%
Total59100.00%5100.00%


void saa7146_pgtable_free(struct pci_dev *pci, struct saa7146_pgtable *pt) { if (NULL == pt->cpu) return; pci_free_consistent(pci, pt->size, pt->cpu, pt->dma); pt->cpu = NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox4697.87%150.00%
Andrew Morton12.13%150.00%
Total47100.00%2100.00%


int saa7146_pgtable_alloc(struct pci_dev *pci, struct saa7146_pgtable *pt) { __le32 *cpu; dma_addr_t dma_addr = 0; cpu = pci_alloc_consistent(pci, PAGE_SIZE, &dma_addr); if (NULL == cpu) { return -ENOMEM; } pt->size = PAGE_SIZE; pt->cpu = cpu; pt->dma = dma_addr; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox6492.75%125.00%
Hans Verkuil22.90%125.00%
Michael Hunold22.90%125.00%
Al Viro11.45%125.00%
Total69100.00%4100.00%


int saa7146_pgtable_build_single(struct pci_dev *pci, struct saa7146_pgtable *pt, struct scatterlist *list, int sglen ) { __le32 *ptr, fill; int nr_pages = 0; int i,p; BUG_ON(0 == sglen); BUG_ON(list->offset > PAGE_SIZE); /* if we have a user buffer, the first page may not be aligned to a page boundary. */ pt->offset = list->offset; ptr = pt->cpu; for (i = 0; i < sglen; i++, list++) { /* pr_debug("i:%d, adr:0x%08x, len:%d, offset:%d\n", i, sg_dma_address(list), sg_dma_len(list), list->offset); */ for (p = 0; p * 4096 < list->length; p++, ptr++) { *ptr = cpu_to_le32(sg_dma_address(list) + p * 4096); nr_pages++; } } /* safety; fill the page table up with the last valid page */ fill = *(ptr-1); for(i=nr_pages;i<1024;i++) { *ptr++ = fill; } /* ptr = pt->cpu; pr_debug("offset: %d\n", pt->offset); for(i=0;i<5;i++) { pr_debug("ptr1 %d: 0x%08x\n", i, ptr[i]); } */ return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox12173.78%116.67%
Michael Hunold2917.68%233.33%
Andrew Morton116.71%116.67%
Joe Perches21.22%116.67%
Al Viro10.61%116.67%
Total164100.00%6100.00%

/********************************************************************************/ /* interrupt handler */
static irqreturn_t interrupt_hw(int irq, void *dev_id) { struct saa7146_dev *dev = dev_id; u32 isr; u32 ack_isr; /* read out the interrupt status register */ ack_isr = isr = saa7146_read(dev, ISR); /* is this our interrupt? */ if ( 0 == isr ) { /* nope, some other device */ return IRQ_NONE; } if (dev->ext) { if (dev->ext->irq_mask & isr) { if (dev->ext->irq_func) dev->ext->irq_func(dev, &isr); isr &= ~dev->ext->irq_mask; } } if (0 != (isr & (MASK_27))) { DEB_INT("irq: RPS0 (0x%08x)\n", isr); if (dev->vv_data && dev->vv_callback) dev->vv_callback(dev,isr); isr &= ~MASK_27; } if (0 != (isr & (MASK_28))) { if (dev->vv_data && dev->vv_callback) dev->vv_callback(dev,isr); isr &= ~MASK_28; } if (0 != (isr & (MASK_16|MASK_17))) { SAA7146_IER_DISABLE(dev, MASK_16|MASK_17); /* only wake up if we expect something */ if (0 != dev->i2c_op) { dev->i2c_op = 0; wake_up(&dev->i2c_wq); } else { u32 psr = saa7146_read(dev, PSR); u32 ssr = saa7146_read(dev, SSR); pr_warn("%s: unexpected i2c irq: isr %08x psr %08x ssr %08x\n", dev->name, isr, psr, ssr); } isr &= ~(MASK_16|MASK_17); } if( 0 != isr ) { ERR("warning: interrupt enabled, but not handled properly.(0x%08x)\n", isr); ERR("disabling interrupt source(s)!\n"); SAA7146_IER_DISABLE(dev,isr); } saa7146_write(dev, ISR, ack_isr); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox26783.70%120.00%
Oliver Endriss3912.23%120.00%
Andrew Morton72.19%120.00%
Joe Perches41.25%120.00%
Michael Hunold20.63%120.00%
Total319100.00%5100.00%

/*********************************************************************************/ /* configuration-functions */
static int saa7146_init_one(struct pci_dev *pci, const struct pci_device_id *ent) { struct saa7146_pci_extension_data *pci_ext = (struct saa7146_pci_extension_data *)ent->driver_data; struct saa7146_extension *ext = pci_ext->ext; struct saa7146_dev *dev; int err = -ENOMEM; /* clear out mem for sure */ dev = kzalloc(sizeof(struct saa7146_dev), GFP_KERNEL); if (!dev) { ERR("out of memory\n"); goto out; } /* create a nice device name */ sprintf(dev->name, "saa7146 (%d)", saa7146_num); DEB_EE("pci:%p\n", pci); err = pci_enable_device(pci); if (err < 0) { ERR("pci_enable_device() failed\n"); goto err_free; } /* enable bus-mastering */ pci_set_master(pci); dev->pci = pci; /* get chip-revision; this is needed to enable bug-fixes */ dev->revision = pci->revision; /* remap the memory from virtual to physical address */ err = pci_request_region(pci, 0, "saa7146"); if (err < 0) goto err_disable; dev->mem = ioremap(pci_resource_start(pci, 0), pci_resource_len(pci, 0)); if (!dev->mem) { ERR("ioremap() failed\n"); err = -ENODEV; goto err_release; } /* we don't do a master reset here anymore, it screws up some boards that don't have an i2c-eeprom for configuration values */ /* saa7146_write(dev, MC1, MASK_31); */ /* disable all irqs */ saa7146_write(dev, IER, 0); /* shut down all dma transfers and rps tasks */ saa7146_write(dev, MC1, 0x30ff0000); /* clear out any rps-signals pending */ saa7146_write(dev, MC2, 0xf8000000); /* request an interrupt for the saa7146 */ err = request_irq(pci->irq, interrupt_hw, IRQF_SHARED, dev->name, dev); if (err < 0) { ERR("request_irq() failed\n"); goto err_unmap; } err = -ENOMEM; /* get memory for various stuff */ dev->d_rps0.cpu_addr = pci_zalloc_consistent(pci, SAA7146_RPS_MEM, &dev->d_rps0.dma_handle); if (!dev->d_rps0.cpu_addr) goto err_free_irq; dev->d_rps1.cpu_addr = pci_zalloc_consistent(pci, SAA7146_RPS_MEM, &dev->d_rps1.dma_handle); if (!dev->d_rps1.cpu_addr) goto err_free_rps0; dev->d_i2c.cpu_addr = pci_zalloc_consistent(pci, SAA7146_RPS_MEM, &dev->d_i2c.dma_handle); if (!dev->d_i2c.cpu_addr) goto err_free_rps1; /* the rest + print status message */ pr_info("found saa7146 @ mem %p (revision %d, irq %d) (0x%04x,0x%04x)\n", dev->mem, dev->revision, pci->irq, pci->subsystem_vendor, pci->subsystem_device); dev->ext = ext; mutex_init(&dev->v4l2_lock); spin_lock_init(&dev->int_slock); spin_lock_init(&dev->slock); mutex_init(&dev->i2c_lock); dev->module = THIS_MODULE; init_waitqueue_head(&dev->i2c_wq); /* set some sane pci arbitrition values */ saa7146_write(dev, PCI_BT_V1, 0x1c00101f); /* TODO: use the status code of the callback */ err = -ENODEV; if (ext->probe && ext->probe(dev)) { DEB_D("ext->probe() failed for %p. skipping device.\n", dev); goto err_free_i2c; } if (ext->attach(dev, pci_ext)) { DEB_D("ext->attach() failed for %p. skipping device.\n", dev); goto err_free_i2c; } /* V4L extensions will set the pci drvdata to the v4l2_device in the attach() above. So for those cards that do not use V4L we have to set it explicitly. */ pci_set_drvdata(pci, &dev->v4l2_dev); saa7146_num++; err = 0; out: return err; err_free_i2c: pci_free_consistent(pci, SAA7146_RPS_MEM, dev->d_i2c.cpu_addr, dev->d_i2c.dma_handle); err_free_rps1: pci_free_consistent(pci, SAA7146_RPS_MEM, dev->d_rps1.cpu_addr, dev->d_rps1.dma_handle); err_free_rps0: pci_free_consistent(pci, SAA7146_RPS_MEM, dev->d_rps0.cpu_addr, dev->d_rps0.dma_handle); err_free_irq: free_irq(pci->irq, (void *)dev); err_unmap: iounmap(dev->mem); err_release: pci_release_region(pci, 0); err_disable: pci_disable_device(pci); err_free: kfree(dev); goto out; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox40261.37%15.26%
Michael Hunold18828.70%421.05%
Joe Perches182.75%315.79%
Hans Verkuil142.14%315.79%
Lubomir Rintel121.83%15.26%
Thomas Gleixner91.37%210.53%
Andrew Morton40.61%15.26%
Johannes Stezenbach20.31%15.26%
Ingo Molnar20.31%15.26%
Björn Mork20.31%15.26%
Panagiotis Issaris20.31%15.26%
Total655100.00%19100.00%


static void saa7146_remove_one(struct pci_dev *pdev) { struct v4l2_device *v4l2_dev = pci_get_drvdata(pdev); struct saa7146_dev *dev = to_saa7146_dev(v4l2_dev); struct { void *addr; dma_addr_t dma; } dev_map[] = { { dev->d_i2c.cpu_addr, dev->d_i2c.dma_handle }, { dev->d_rps1.cpu_addr, dev->d_rps1.dma_handle }, { dev->d_rps0.cpu_addr, dev->d_rps0.dma_handle }, { NULL, 0 } }, *p; DEB_EE("dev:%p\n", dev); dev->ext->detach(dev); /* shut down all video dma transfers */ saa7146_write(dev, MC1, 0x00ff0000); /* disable all irqs, release irq-routine */ saa7146_write(dev, IER, 0); free_irq(pdev->irq, dev); for (p = dev_map; p->addr; p++) pci_free_consistent(pdev, SAA7146_RPS_MEM, p->addr, p->dma); iounmap(dev->mem); pci_release_region(pdev, 0); pci_disable_device(pdev); kfree(dev); saa7146_num--; }

Contributors

PersonTokensPropCommitsCommitProp
Michael Hunold10050.76%342.86%
Alan Cox8442.64%114.29%
Hans Verkuil126.09%228.57%
Joe Perches10.51%114.29%
Total197100.00%7100.00%

/*********************************************************************************/ /* extension handling functions */
int saa7146_register_extension(struct saa7146_extension* ext) { DEB_EE("ext:%p\n", ext); ext->driver.name = ext->name; ext->driver.id_table = ext->pci_tbl; ext->driver.probe = saa7146_init_one; ext->driver.remove = saa7146_remove_one; pr_info("register extension '%s'\n", ext->name); return pci_register_driver(&ext->driver); }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox6794.37%133.33%
Joe Perches34.23%133.33%
Christophe Lucas11.41%133.33%
Total71100.00%3100.00%


int saa7146_unregister_extension(struct saa7146_extension* ext) { DEB_EE("ext:%p\n", ext); pr_info("unregister extension '%s'\n", ext->name); pci_unregister_driver(&ext->driver); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Alan Cox3491.89%150.00%
Joe Perches38.11%150.00%
Total37100.00%2100.00%

EXPORT_SYMBOL_GPL(saa7146_register_extension); EXPORT_SYMBOL_GPL(saa7146_unregister_extension); /* misc functions used by extension modules */ EXPORT_SYMBOL_GPL(saa7146_pgtable_alloc); EXPORT_SYMBOL_GPL(saa7146_pgtable_free); EXPORT_SYMBOL_GPL(saa7146_pgtable_build_single); EXPORT_SYMBOL_GPL(saa7146_vmalloc_build_pgtable); EXPORT_SYMBOL_GPL(saa7146_vfree_destroy_pgtable); EXPORT_SYMBOL_GPL(saa7146_wait_for_debi_done); EXPORT_SYMBOL_GPL(saa7146_setgpio); EXPORT_SYMBOL_GPL(saa7146_i2c_adapter_prepare); EXPORT_SYMBOL_GPL(saa7146_debug); MODULE_AUTHOR("Michael Hunold <michael@mihu.de>"); MODULE_DESCRIPTION("driver for generic saa7146-based hardware"); MODULE_LICENSE("GPL");

Overall Contributors

PersonTokensPropCommitsCommitProp
Alan Cox139556.11%12.33%
Michael Hunold33913.64%716.28%
Oliver Endriss26710.74%49.30%
Andrew Morton2008.05%49.30%
Jon Burgess1355.43%12.33%
Joe Perches481.93%36.98%
Hans Verkuil281.13%511.63%
Jens Axboe150.60%24.65%
Johannes Stezenbach130.52%24.65%
Lubomir Rintel120.48%12.33%
Thomas Gleixner90.36%24.65%
Panagiotis Issaris50.20%12.33%
Harvey Harrison40.16%12.33%
Paul Gortmaker30.12%12.33%
Eric Sesterhenn / Snakebyte30.12%12.33%
Ingo Molnar20.08%12.33%
Björn Mork20.08%12.33%
Al Viro20.08%12.33%
Mauro Carvalho Chehab20.08%24.65%
Christophe Lucas10.04%12.33%
Johann Klammer10.04%12.33%
Total2486100.00%43100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.