cregit-Linux how code gets into the kernel

Release 4.11 drivers/media/pci/saa7134/saa7134-go7007.c

/*
 * Copyright (C) 2005-2006 Micronas USA Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License (Version 2) as
 * published by the Free Software Foundation.
 *
 * 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.
 */

#include "saa7134.h"
#include "saa7134-reg.h"

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/spinlock.h>
#include <linux/wait.h>
#include <linux/list.h>
#include <linux/slab.h>
#include <linux/time.h>
#include <linux/mm.h>
#include <linux/usb.h>
#include <linux/i2c.h>
#include <asm/byteorder.h>
#include <media/v4l2-common.h>
#include <media/v4l2-device.h>
#include <media/v4l2-subdev.h>

#include "go7007-priv.h"

/*#define GO7007_HPI_DEBUG*/


enum hpi_address {
	
HPI_ADDR_VIDEO_BUFFER = 0xe4,
	
HPI_ADDR_INIT_BUFFER = 0xea,
	
HPI_ADDR_INTR_RET_VALUE = 0xee,
	
HPI_ADDR_INTR_RET_DATA = 0xec,
	
HPI_ADDR_INTR_STATUS = 0xf4,
	
HPI_ADDR_INTR_WR_PARAM = 0xf6,
	
HPI_ADDR_INTR_WR_INDEX = 0xf8,
};


enum gpio_command {
	
GPIO_COMMAND_RESET = 0x00, /* 000b */
	
GPIO_COMMAND_REQ1  = 0x04, /* 001b */
	
GPIO_COMMAND_WRITE = 0x20, /* 010b */
	
GPIO_COMMAND_REQ2  = 0x24, /* 011b */
	
GPIO_COMMAND_READ  = 0x80, /* 100b */
	
GPIO_COMMAND_VIDEO = 0x84, /* 101b */
	
GPIO_COMMAND_IDLE  = 0xA0, /* 110b */
	
GPIO_COMMAND_ADDR  = 0xA4, /* 111b */
};


struct saa7134_go7007 {
	
struct v4l2_subdev sd;
	
struct saa7134_dev *dev;
	
u8 *top;
	
u8 *bottom;
	
dma_addr_t top_dma;
	
dma_addr_t bottom_dma;
};


static inline struct saa7134_go7007 *to_state(struct v4l2_subdev *sd) { return container_of(sd, struct saa7134_go7007, sd); }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil25100.00%1100.00%
Total25100.00%1100.00%

static const struct go7007_board_info board_voyager = { .flags = 0, .sensor_flags = GO7007_SENSOR_656 | GO7007_SENSOR_VALID_ENABLE | GO7007_SENSOR_TV | GO7007_SENSOR_VBI, .audio_flags = GO7007_AUDIO_I2S_MODE_1 | GO7007_AUDIO_WORD_16, .audio_rate = 48000, .audio_bclk_div = 8, .audio_main_div = 2, .hpi_buffer_cap = 7, .num_inputs = 1, .inputs = { { .name = "SAA7134", }, }, }; /********************* Driver for GPIO HPI interface *********************/
static int gpio_write(struct saa7134_dev *dev, u8 addr, u16 data) { saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); /* Write HPI address */ saa_writeb(SAA7134_GPIO_GPSTATUS0, addr); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); /* Write low byte */ saa_writeb(SAA7134_GPIO_GPSTATUS0, data & 0xff); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); /* Write high byte */ saa_writeb(SAA7134_GPIO_GPSTATUS0, data >> 8); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil97100.00%1100.00%
Total97100.00%1100.00%


static int gpio_read(struct saa7134_dev *dev, u8 addr, u16 *data) { saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); /* Write HPI address */ saa_writeb(SAA7134_GPIO_GPSTATUS0, addr); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); saa_writeb(SAA7134_GPIO_GPMODE0, 0x00); /* Read low byte */ saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ); saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); *data = saa_readb(SAA7134_GPIO_GPSTATUS0); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); /* Read high byte */ saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_READ); saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); *data |= saa_readb(SAA7134_GPIO_GPSTATUS0) << 8; saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil133100.00%1100.00%
Total133100.00%1100.00%


static int saa7134_go7007_interface_reset(struct go7007 *go) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev = saa->dev; u16 intr_val, intr_data; int count = 20; saa_clearb(SAA7134_TS_PARALLEL, 0x80); /* Disable TS interface */ saa_writeb(SAA7134_GPIO_GPMODE2, 0xa4); saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_RESET); msleep(1); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2); msleep(10); saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_readb(SAA7134_GPIO_GPSTATUS2); /*pr_debug("status is %s\n", saa_readb(SAA7134_GPIO_GPSTATUS2) & 0x40 ? "OK" : "not OK"); */ /* enter command mode...(?) */ saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ1); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_REQ2); do { saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_readb(SAA7134_GPIO_GPSTATUS2); /*pr_info("gpio is %08x\n", saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2)); */ } while (--count > 0); /* Wait for an interrupt to indicate successful hardware reset */ if (go7007_read_interrupt(go, &intr_val, &intr_data) < 0 || (intr_val & ~0x1) != 0x55aa) { pr_err("saa7134-go7007: unable to reset the GO7007\n"); return -1; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil20399.51%150.00%
Mauro Carvalho Chehab10.49%150.00%
Total204100.00%2100.00%


static int saa7134_go7007_write_interrupt(struct go7007 *go, int addr, int data) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev = saa->dev; int i; u16 status_reg; #ifdef GO7007_HPI_DEBUG pr_debug("saa7134-go7007: WriteInterrupt: %04x %04x\n", addr, data); #endif for (i = 0; i < 100; ++i) { gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg); if (!(status_reg & 0x0010)) break; msleep(10); } if (i == 100) { pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n", status_reg); return -1; } gpio_write(dev, HPI_ADDR_INTR_WR_PARAM, data); gpio_write(dev, HPI_ADDR_INTR_WR_INDEX, addr); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil135100.00%1100.00%
Total135100.00%1100.00%


static int saa7134_go7007_read_interrupt(struct go7007 *go) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev = saa->dev; /* XXX we need to wait if there is no interrupt available */ go->interrupt_available = 1; gpio_read(dev, HPI_ADDR_INTR_RET_VALUE, &go->interrupt_value); gpio_read(dev, HPI_ADDR_INTR_RET_DATA, &go->interrupt_data); #ifdef GO7007_HPI_DEBUG pr_debug("saa7134-go7007: ReadInterrupt: %04x %04x\n", go->interrupt_value, go->interrupt_data); #endif return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil81100.00%1100.00%
Total81100.00%1100.00%


static void saa7134_go7007_irq_ts_done(struct saa7134_dev *dev, unsigned long status) { struct go7007 *go = video_get_drvdata(dev->empress_dev); struct saa7134_go7007 *saa = go->hpi_context; if (!vb2_is_streaming(&go->vidq)) return; if (0 != (status & 0x000f0000)) pr_debug("saa7134-go7007: irq: lost %ld\n", (status >> 16) & 0x0f); if (status & 0x100000) { dma_sync_single_for_cpu(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE); go7007_parse_video_stream(go, saa->bottom, PAGE_SIZE); saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma); } else { dma_sync_single_for_cpu(&dev->pci->dev, saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE); go7007_parse_video_stream(go, saa->top, PAGE_SIZE); saa_writel(SAA7134_RS_BA1(5), saa->top_dma); } }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil164100.00%1100.00%
Total164100.00%1100.00%


static int saa7134_go7007_stream_start(struct go7007 *go) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev = saa->dev; saa->top_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->top), 0, PAGE_SIZE, DMA_FROM_DEVICE); if (dma_mapping_error(&dev->pci->dev, saa->top_dma)) return -ENOMEM; saa->bottom_dma = dma_map_page(&dev->pci->dev, virt_to_page(saa->bottom), 0, PAGE_SIZE, DMA_FROM_DEVICE); if (dma_mapping_error(&dev->pci->dev, saa->bottom_dma)) { dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE); return -ENOMEM; } saa_writel(SAA7134_VIDEO_PORT_CTRL0 >> 2, 0xA300B000); saa_writel(SAA7134_VIDEO_PORT_CTRL4 >> 2, 0x40000200); /* Set HPI interface for video */ saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_VIDEO_BUFFER); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); saa_writeb(SAA7134_GPIO_GPMODE0, 0x00); /* Enable TS interface */ saa_writeb(SAA7134_TS_PARALLEL, 0xe6); /* Reset TS interface */ saa_setb(SAA7134_TS_SERIAL1, 0x01); saa_clearb(SAA7134_TS_SERIAL1, 0x01); /* Set up transfer block size */ saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 128 - 1); saa_writeb(SAA7134_TS_DMA0, ((PAGE_SIZE >> 7) - 1) & 0xff); saa_writeb(SAA7134_TS_DMA1, (PAGE_SIZE >> 15) & 0xff); saa_writeb(SAA7134_TS_DMA2, (PAGE_SIZE >> 31) & 0x3f); /* Enable video streaming mode */ saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_VIDEO); saa_writel(SAA7134_RS_BA1(5), saa->top_dma); saa_writel(SAA7134_RS_BA2(5), saa->bottom_dma); saa_writel(SAA7134_RS_PITCH(5), 128); saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_MAX); /* Enable TS FIFO */ saa_setl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5); /* Enable DMA IRQ */ saa_setl(SAA7134_IRQ1, SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil32194.69%150.00%
Mauro Carvalho Chehab185.31%150.00%
Total339100.00%2100.00%


static int saa7134_go7007_stream_stop(struct go7007 *go) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev; if (!saa) return -EINVAL; dev = saa->dev; if (!dev) return -EINVAL; /* Shut down TS FIFO */ saa_clearl(SAA7134_MAIN_CTRL, SAA7134_MAIN_CTRL_TE5); /* Disable DMA IRQ */ saa_clearl(SAA7134_IRQ1, SAA7134_IRQ1_INTE_RA2_1 | SAA7134_IRQ1_INTE_RA2_0); /* Disable TS interface */ saa_clearb(SAA7134_TS_PARALLEL, 0x80); dma_unmap_page(&dev->pci->dev, saa->top_dma, PAGE_SIZE, DMA_FROM_DEVICE); dma_unmap_page(&dev->pci->dev, saa->bottom_dma, PAGE_SIZE, DMA_FROM_DEVICE); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil114100.00%1100.00%
Total114100.00%1100.00%


static int saa7134_go7007_send_firmware(struct go7007 *go, u8 *data, int len) { struct saa7134_go7007 *saa = go->hpi_context; struct saa7134_dev *dev = saa->dev; u16 status_reg; int i; #ifdef GO7007_HPI_DEBUG pr_debug("saa7134-go7007: DownloadBuffer sending %d bytes\n", len); #endif while (len > 0) { i = len > 64 ? 64 : len; saa_writeb(SAA7134_GPIO_GPMODE0, 0xff); saa_writeb(SAA7134_GPIO_GPSTATUS0, HPI_ADDR_INIT_BUFFER); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_ADDR); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); while (i-- > 0) { saa_writeb(SAA7134_GPIO_GPSTATUS0, *data); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_WRITE); saa_writeb(SAA7134_GPIO_GPSTATUS2, GPIO_COMMAND_IDLE); ++data; --len; } for (i = 0; i < 100; ++i) { gpio_read(dev, HPI_ADDR_INTR_STATUS, &status_reg); if (!(status_reg & 0x0002)) break; } if (i == 100) { pr_err("saa7134-go7007: device is hung, status reg = 0x%04x\n", status_reg); return -1; } } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil194100.00%1100.00%
Total194100.00%1100.00%

static const struct go7007_hpi_ops saa7134_go7007_hpi_ops = { .interface_reset = saa7134_go7007_interface_reset, .write_interrupt = saa7134_go7007_write_interrupt, .read_interrupt = saa7134_go7007_read_interrupt, .stream_start = saa7134_go7007_stream_start, .stream_stop = saa7134_go7007_stream_stop, .send_firmware = saa7134_go7007_send_firmware, }; MODULE_FIRMWARE("go7007/go7007tv.bin"); /* --------------------------------------------------------------------------*/
static int saa7134_go7007_s_std(struct v4l2_subdev *sd, v4l2_std_id norm) { #if 0 struct saa7134_go7007 *saa = to_state(sd); struct saa7134_dev *dev = saa->dev; return saa7134_s_std_internal(dev, NULL, norm); #else return 0; #endif }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil25100.00%1100.00%
Total25100.00%1100.00%

static const struct v4l2_subdev_video_ops saa7134_go7007_video_ops = { .s_std = saa7134_go7007_s_std, }; static const struct v4l2_subdev_ops saa7134_go7007_sd_ops = { .video = &saa7134_go7007_video_ops, }; /* --------------------------------------------------------------------------*/ /********************* Add/remove functions *********************/
static int saa7134_go7007_init(struct saa7134_dev *dev) { struct go7007 *go; struct saa7134_go7007 *saa; struct v4l2_subdev *sd; pr_debug("saa7134-go7007: probing new SAA713X board\n"); go = go7007_alloc(&board_voyager, &dev->pci->dev); if (go == NULL) return -ENOMEM; saa = kzalloc(sizeof(struct saa7134_go7007), GFP_KERNEL); if (saa == NULL) { kfree(go); return -ENOMEM; } go->board_id = GO7007_BOARDID_PCI_VOYAGER; snprintf(go->bus_info, sizeof(go->bus_info), "PCI:%s", pci_name(dev->pci)); strlcpy(go->name, saa7134_boards[dev->board].name, sizeof(go->name)); go->hpi_ops = &saa7134_go7007_hpi_ops; go->hpi_context = saa; saa->dev = dev; /* Init the subdevice interface */ sd = &saa->sd; v4l2_subdev_init(sd, &saa7134_go7007_sd_ops); v4l2_set_subdevdata(sd, saa); strncpy(sd->name, "saa7134-go7007", sizeof(sd->name)); /* Allocate a couple pages for receiving the compressed stream */ saa->top = (u8 *)get_zeroed_page(GFP_KERNEL); if (!saa->top) goto allocfail; saa->bottom = (u8 *)get_zeroed_page(GFP_KERNEL); if (!saa->bottom) goto allocfail; /* Boot the GO7007 */ if (go7007_boot_encoder(go, go->board_info->flags & GO7007_BOARD_USE_ONBOARD_I2C) < 0) goto allocfail; /* Do any final GO7007 initialization, then register the * V4L2 and ALSA interfaces */ if (go7007_register_encoder(go, go->board_info->num_i2c_devs) < 0) goto allocfail; /* Register the subdevice interface with the go7007 device */ if (v4l2_device_register_subdev(&go->v4l2_dev, sd) < 0) pr_info("saa7134-go7007: register subdev failed\n"); dev->empress_dev = &go->vdev; go->status = STATUS_ONLINE; return 0; allocfail: if (saa->top) free_page((unsigned long)saa->top); if (saa->bottom) free_page((unsigned long)saa->bottom); kfree(saa); kfree(go); return -ENOMEM; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil371100.00%1100.00%
Total371100.00%1100.00%


static int saa7134_go7007_fini(struct saa7134_dev *dev) { struct go7007 *go; struct saa7134_go7007 *saa; if (NULL == dev->empress_dev) return 0; go = video_get_drvdata(dev->empress_dev); if (go->audio_enabled) go7007_snd_remove(go); saa = go->hpi_context; go->status = STATUS_SHUTDOWN; free_page((unsigned long)saa->top); free_page((unsigned long)saa->bottom); v4l2_device_unregister_subdev(&saa->sd); kfree(saa); video_unregister_device(&go->vdev); v4l2_device_put(&go->v4l2_dev); dev->empress_dev = NULL; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil124100.00%1100.00%
Total124100.00%1100.00%

static struct saa7134_mpeg_ops saa7134_go7007_ops = { .type = SAA7134_MPEG_GO7007, .init = saa7134_go7007_init, .fini = saa7134_go7007_fini, .irq_ts_done = saa7134_go7007_irq_ts_done, };
static int __init saa7134_go7007_mod_init(void) { return saa7134_ts_register(&saa7134_go7007_ops); }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil16100.00%1100.00%
Total16100.00%1100.00%


static void __exit saa7134_go7007_mod_cleanup(void) { saa7134_ts_unregister(&saa7134_go7007_ops); }

Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil15100.00%1100.00%
Total15100.00%1100.00%

module_init(saa7134_go7007_mod_init); module_exit(saa7134_go7007_mod_cleanup); MODULE_LICENSE("GPL v2");

Overall Contributors

PersonTokensPropCommitsCommitProp
Hans Verkuil235698.91%120.00%
Mauro Carvalho Chehab251.05%360.00%
Julia Lawall10.04%120.00%
Total2382100.00%5100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.