162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Support for a cx23417 mpeg encoder via cx23885 host port. 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * (c) 2004 Jelle Foks <jelle@foks.us> 762306a36Sopenharmony_ci * (c) 2004 Gerd Knorr <kraxel@bytesex.org> 862306a36Sopenharmony_ci * (c) 2008 Steven Toth <stoth@linuxtv.org> 962306a36Sopenharmony_ci * - CX23885/7/8 support 1062306a36Sopenharmony_ci * 1162306a36Sopenharmony_ci * Includes parts from the ivtv driver <http://sourceforge.net/projects/ivtv/> 1262306a36Sopenharmony_ci */ 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include "cx23885.h" 1562306a36Sopenharmony_ci#include "cx23885-ioctl.h" 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#include <linux/module.h> 1862306a36Sopenharmony_ci#include <linux/moduleparam.h> 1962306a36Sopenharmony_ci#include <linux/init.h> 2062306a36Sopenharmony_ci#include <linux/fs.h> 2162306a36Sopenharmony_ci#include <linux/delay.h> 2262306a36Sopenharmony_ci#include <linux/device.h> 2362306a36Sopenharmony_ci#include <linux/firmware.h> 2462306a36Sopenharmony_ci#include <linux/slab.h> 2562306a36Sopenharmony_ci#include <media/v4l2-common.h> 2662306a36Sopenharmony_ci#include <media/v4l2-ioctl.h> 2762306a36Sopenharmony_ci#include <media/drv-intf/cx2341x.h> 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci#define CX23885_FIRM_IMAGE_SIZE 376836 3062306a36Sopenharmony_ci#define CX23885_FIRM_IMAGE_NAME "v4l-cx23885-enc.fw" 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_cistatic unsigned int mpegbufs = 32; 3362306a36Sopenharmony_cimodule_param(mpegbufs, int, 0644); 3462306a36Sopenharmony_ciMODULE_PARM_DESC(mpegbufs, "number of mpeg buffers, range 2-32"); 3562306a36Sopenharmony_cistatic unsigned int mpeglines = 32; 3662306a36Sopenharmony_cimodule_param(mpeglines, int, 0644); 3762306a36Sopenharmony_ciMODULE_PARM_DESC(mpeglines, "number of lines in an MPEG buffer, range 2-32"); 3862306a36Sopenharmony_cistatic unsigned int mpeglinesize = 512; 3962306a36Sopenharmony_cimodule_param(mpeglinesize, int, 0644); 4062306a36Sopenharmony_ciMODULE_PARM_DESC(mpeglinesize, 4162306a36Sopenharmony_ci "number of bytes in each line of an MPEG buffer, range 512-1024"); 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_cistatic unsigned int v4l_debug; 4462306a36Sopenharmony_cimodule_param(v4l_debug, int, 0644); 4562306a36Sopenharmony_ciMODULE_PARM_DESC(v4l_debug, "enable V4L debug messages"); 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci#define dprintk(level, fmt, arg...)\ 4862306a36Sopenharmony_ci do { if (v4l_debug >= level) \ 4962306a36Sopenharmony_ci printk(KERN_DEBUG pr_fmt("%s: 417:" fmt), \ 5062306a36Sopenharmony_ci __func__, ##arg); \ 5162306a36Sopenharmony_ci } while (0) 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_cistatic struct cx23885_tvnorm cx23885_tvnorms[] = { 5462306a36Sopenharmony_ci { 5562306a36Sopenharmony_ci .name = "NTSC-M", 5662306a36Sopenharmony_ci .id = V4L2_STD_NTSC_M, 5762306a36Sopenharmony_ci }, { 5862306a36Sopenharmony_ci .name = "NTSC-JP", 5962306a36Sopenharmony_ci .id = V4L2_STD_NTSC_M_JP, 6062306a36Sopenharmony_ci }, { 6162306a36Sopenharmony_ci .name = "PAL-BG", 6262306a36Sopenharmony_ci .id = V4L2_STD_PAL_BG, 6362306a36Sopenharmony_ci }, { 6462306a36Sopenharmony_ci .name = "PAL-DK", 6562306a36Sopenharmony_ci .id = V4L2_STD_PAL_DK, 6662306a36Sopenharmony_ci }, { 6762306a36Sopenharmony_ci .name = "PAL-I", 6862306a36Sopenharmony_ci .id = V4L2_STD_PAL_I, 6962306a36Sopenharmony_ci }, { 7062306a36Sopenharmony_ci .name = "PAL-M", 7162306a36Sopenharmony_ci .id = V4L2_STD_PAL_M, 7262306a36Sopenharmony_ci }, { 7362306a36Sopenharmony_ci .name = "PAL-N", 7462306a36Sopenharmony_ci .id = V4L2_STD_PAL_N, 7562306a36Sopenharmony_ci }, { 7662306a36Sopenharmony_ci .name = "PAL-Nc", 7762306a36Sopenharmony_ci .id = V4L2_STD_PAL_Nc, 7862306a36Sopenharmony_ci }, { 7962306a36Sopenharmony_ci .name = "PAL-60", 8062306a36Sopenharmony_ci .id = V4L2_STD_PAL_60, 8162306a36Sopenharmony_ci }, { 8262306a36Sopenharmony_ci .name = "SECAM-L", 8362306a36Sopenharmony_ci .id = V4L2_STD_SECAM_L, 8462306a36Sopenharmony_ci }, { 8562306a36Sopenharmony_ci .name = "SECAM-DK", 8662306a36Sopenharmony_ci .id = V4L2_STD_SECAM_DK, 8762306a36Sopenharmony_ci } 8862306a36Sopenharmony_ci}; 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_ci/* ------------------------------------------------------------------ */ 9162306a36Sopenharmony_cienum cx23885_capture_type { 9262306a36Sopenharmony_ci CX23885_MPEG_CAPTURE, 9362306a36Sopenharmony_ci CX23885_RAW_CAPTURE, 9462306a36Sopenharmony_ci CX23885_RAW_PASSTHRU_CAPTURE 9562306a36Sopenharmony_ci}; 9662306a36Sopenharmony_cienum cx23885_capture_bits { 9762306a36Sopenharmony_ci CX23885_RAW_BITS_NONE = 0x00, 9862306a36Sopenharmony_ci CX23885_RAW_BITS_YUV_CAPTURE = 0x01, 9962306a36Sopenharmony_ci CX23885_RAW_BITS_PCM_CAPTURE = 0x02, 10062306a36Sopenharmony_ci CX23885_RAW_BITS_VBI_CAPTURE = 0x04, 10162306a36Sopenharmony_ci CX23885_RAW_BITS_PASSTHRU_CAPTURE = 0x08, 10262306a36Sopenharmony_ci CX23885_RAW_BITS_TO_HOST_CAPTURE = 0x10 10362306a36Sopenharmony_ci}; 10462306a36Sopenharmony_cienum cx23885_capture_end { 10562306a36Sopenharmony_ci CX23885_END_AT_GOP, /* stop at the end of gop, generate irq */ 10662306a36Sopenharmony_ci CX23885_END_NOW, /* stop immediately, no irq */ 10762306a36Sopenharmony_ci}; 10862306a36Sopenharmony_cienum cx23885_framerate { 10962306a36Sopenharmony_ci CX23885_FRAMERATE_NTSC_30, /* NTSC: 30fps */ 11062306a36Sopenharmony_ci CX23885_FRAMERATE_PAL_25 /* PAL: 25fps */ 11162306a36Sopenharmony_ci}; 11262306a36Sopenharmony_cienum cx23885_stream_port { 11362306a36Sopenharmony_ci CX23885_OUTPUT_PORT_MEMORY, 11462306a36Sopenharmony_ci CX23885_OUTPUT_PORT_STREAMING, 11562306a36Sopenharmony_ci CX23885_OUTPUT_PORT_SERIAL 11662306a36Sopenharmony_ci}; 11762306a36Sopenharmony_cienum cx23885_data_xfer_status { 11862306a36Sopenharmony_ci CX23885_MORE_BUFFERS_FOLLOW, 11962306a36Sopenharmony_ci CX23885_LAST_BUFFER, 12062306a36Sopenharmony_ci}; 12162306a36Sopenharmony_cienum cx23885_picture_mask { 12262306a36Sopenharmony_ci CX23885_PICTURE_MASK_NONE, 12362306a36Sopenharmony_ci CX23885_PICTURE_MASK_I_FRAMES, 12462306a36Sopenharmony_ci CX23885_PICTURE_MASK_I_P_FRAMES = 0x3, 12562306a36Sopenharmony_ci CX23885_PICTURE_MASK_ALL_FRAMES = 0x7, 12662306a36Sopenharmony_ci}; 12762306a36Sopenharmony_cienum cx23885_vbi_mode_bits { 12862306a36Sopenharmony_ci CX23885_VBI_BITS_SLICED, 12962306a36Sopenharmony_ci CX23885_VBI_BITS_RAW, 13062306a36Sopenharmony_ci}; 13162306a36Sopenharmony_cienum cx23885_vbi_insertion_bits { 13262306a36Sopenharmony_ci CX23885_VBI_BITS_INSERT_IN_XTENSION_USR_DATA, 13362306a36Sopenharmony_ci CX23885_VBI_BITS_INSERT_IN_PRIVATE_PACKETS = 0x1 << 1, 13462306a36Sopenharmony_ci CX23885_VBI_BITS_SEPARATE_STREAM = 0x2 << 1, 13562306a36Sopenharmony_ci CX23885_VBI_BITS_SEPARATE_STREAM_USR_DATA = 0x4 << 1, 13662306a36Sopenharmony_ci CX23885_VBI_BITS_SEPARATE_STREAM_PRV_DATA = 0x5 << 1, 13762306a36Sopenharmony_ci}; 13862306a36Sopenharmony_cienum cx23885_dma_unit { 13962306a36Sopenharmony_ci CX23885_DMA_BYTES, 14062306a36Sopenharmony_ci CX23885_DMA_FRAMES, 14162306a36Sopenharmony_ci}; 14262306a36Sopenharmony_cienum cx23885_dma_transfer_status_bits { 14362306a36Sopenharmony_ci CX23885_DMA_TRANSFER_BITS_DONE = 0x01, 14462306a36Sopenharmony_ci CX23885_DMA_TRANSFER_BITS_ERROR = 0x04, 14562306a36Sopenharmony_ci CX23885_DMA_TRANSFER_BITS_LL_ERROR = 0x10, 14662306a36Sopenharmony_ci}; 14762306a36Sopenharmony_cienum cx23885_pause { 14862306a36Sopenharmony_ci CX23885_PAUSE_ENCODING, 14962306a36Sopenharmony_ci CX23885_RESUME_ENCODING, 15062306a36Sopenharmony_ci}; 15162306a36Sopenharmony_cienum cx23885_copyright { 15262306a36Sopenharmony_ci CX23885_COPYRIGHT_OFF, 15362306a36Sopenharmony_ci CX23885_COPYRIGHT_ON, 15462306a36Sopenharmony_ci}; 15562306a36Sopenharmony_cienum cx23885_notification_type { 15662306a36Sopenharmony_ci CX23885_NOTIFICATION_REFRESH, 15762306a36Sopenharmony_ci}; 15862306a36Sopenharmony_cienum cx23885_notification_status { 15962306a36Sopenharmony_ci CX23885_NOTIFICATION_OFF, 16062306a36Sopenharmony_ci CX23885_NOTIFICATION_ON, 16162306a36Sopenharmony_ci}; 16262306a36Sopenharmony_cienum cx23885_notification_mailbox { 16362306a36Sopenharmony_ci CX23885_NOTIFICATION_NO_MAILBOX = -1, 16462306a36Sopenharmony_ci}; 16562306a36Sopenharmony_cienum cx23885_field1_lines { 16662306a36Sopenharmony_ci CX23885_FIELD1_SAA7114 = 0x00EF, /* 239 */ 16762306a36Sopenharmony_ci CX23885_FIELD1_SAA7115 = 0x00F0, /* 240 */ 16862306a36Sopenharmony_ci CX23885_FIELD1_MICRONAS = 0x0105, /* 261 */ 16962306a36Sopenharmony_ci}; 17062306a36Sopenharmony_cienum cx23885_field2_lines { 17162306a36Sopenharmony_ci CX23885_FIELD2_SAA7114 = 0x00EF, /* 239 */ 17262306a36Sopenharmony_ci CX23885_FIELD2_SAA7115 = 0x00F0, /* 240 */ 17362306a36Sopenharmony_ci CX23885_FIELD2_MICRONAS = 0x0106, /* 262 */ 17462306a36Sopenharmony_ci}; 17562306a36Sopenharmony_cienum cx23885_custom_data_type { 17662306a36Sopenharmony_ci CX23885_CUSTOM_EXTENSION_USR_DATA, 17762306a36Sopenharmony_ci CX23885_CUSTOM_PRIVATE_PACKET, 17862306a36Sopenharmony_ci}; 17962306a36Sopenharmony_cienum cx23885_mute { 18062306a36Sopenharmony_ci CX23885_UNMUTE, 18162306a36Sopenharmony_ci CX23885_MUTE, 18262306a36Sopenharmony_ci}; 18362306a36Sopenharmony_cienum cx23885_mute_video_mask { 18462306a36Sopenharmony_ci CX23885_MUTE_VIDEO_V_MASK = 0x0000FF00, 18562306a36Sopenharmony_ci CX23885_MUTE_VIDEO_U_MASK = 0x00FF0000, 18662306a36Sopenharmony_ci CX23885_MUTE_VIDEO_Y_MASK = 0xFF000000, 18762306a36Sopenharmony_ci}; 18862306a36Sopenharmony_cienum cx23885_mute_video_shift { 18962306a36Sopenharmony_ci CX23885_MUTE_VIDEO_V_SHIFT = 8, 19062306a36Sopenharmony_ci CX23885_MUTE_VIDEO_U_SHIFT = 16, 19162306a36Sopenharmony_ci CX23885_MUTE_VIDEO_Y_SHIFT = 24, 19262306a36Sopenharmony_ci}; 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ci/* defines below are from ivtv-driver.h */ 19562306a36Sopenharmony_ci#define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci/* Firmware API commands */ 19862306a36Sopenharmony_ci#define IVTV_API_STD_TIMEOUT 500 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci/* Registers */ 20162306a36Sopenharmony_ci/* IVTV_REG_OFFSET */ 20262306a36Sopenharmony_ci#define IVTV_REG_ENC_SDRAM_REFRESH (0x07F8) 20362306a36Sopenharmony_ci#define IVTV_REG_ENC_SDRAM_PRECHARGE (0x07FC) 20462306a36Sopenharmony_ci#define IVTV_REG_SPU (0x9050) 20562306a36Sopenharmony_ci#define IVTV_REG_HW_BLOCKS (0x9054) 20662306a36Sopenharmony_ci#define IVTV_REG_VPU (0x9058) 20762306a36Sopenharmony_ci#define IVTV_REG_APU (0xA064) 20862306a36Sopenharmony_ci 20962306a36Sopenharmony_ci/**** Bit definitions for MC417_RWD and MC417_OEN registers *** 21062306a36Sopenharmony_ci bits 31-16 21162306a36Sopenharmony_ci+-----------+ 21262306a36Sopenharmony_ci| Reserved | 21362306a36Sopenharmony_ci+-----------+ 21462306a36Sopenharmony_ci bit 15 bit 14 bit 13 bit 12 bit 11 bit 10 bit 9 bit 8 21562306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+ 21662306a36Sopenharmony_ci| MIWR# | MIRD# | MICS# |MIRDY# |MIADDR3|MIADDR2|MIADDR1|MIADDR0| 21762306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+ 21862306a36Sopenharmony_ci bit 7 bit 6 bit 5 bit 4 bit 3 bit 2 bit 1 bit 0 21962306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+ 22062306a36Sopenharmony_ci|MIDATA7|MIDATA6|MIDATA5|MIDATA4|MIDATA3|MIDATA2|MIDATA1|MIDATA0| 22162306a36Sopenharmony_ci+-------+-------+-------+-------+-------+-------+-------+-------+ 22262306a36Sopenharmony_ci***/ 22362306a36Sopenharmony_ci#define MC417_MIWR 0x8000 22462306a36Sopenharmony_ci#define MC417_MIRD 0x4000 22562306a36Sopenharmony_ci#define MC417_MICS 0x2000 22662306a36Sopenharmony_ci#define MC417_MIRDY 0x1000 22762306a36Sopenharmony_ci#define MC417_MIADDR 0x0F00 22862306a36Sopenharmony_ci#define MC417_MIDATA 0x00FF 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ci/* MIADDR* nibble definitions */ 23162306a36Sopenharmony_ci#define MCI_MEMORY_DATA_BYTE0 0x000 23262306a36Sopenharmony_ci#define MCI_MEMORY_DATA_BYTE1 0x100 23362306a36Sopenharmony_ci#define MCI_MEMORY_DATA_BYTE2 0x200 23462306a36Sopenharmony_ci#define MCI_MEMORY_DATA_BYTE3 0x300 23562306a36Sopenharmony_ci#define MCI_MEMORY_ADDRESS_BYTE2 0x400 23662306a36Sopenharmony_ci#define MCI_MEMORY_ADDRESS_BYTE1 0x500 23762306a36Sopenharmony_ci#define MCI_MEMORY_ADDRESS_BYTE0 0x600 23862306a36Sopenharmony_ci#define MCI_REGISTER_DATA_BYTE0 0x800 23962306a36Sopenharmony_ci#define MCI_REGISTER_DATA_BYTE1 0x900 24062306a36Sopenharmony_ci#define MCI_REGISTER_DATA_BYTE2 0xA00 24162306a36Sopenharmony_ci#define MCI_REGISTER_DATA_BYTE3 0xB00 24262306a36Sopenharmony_ci#define MCI_REGISTER_ADDRESS_BYTE0 0xC00 24362306a36Sopenharmony_ci#define MCI_REGISTER_ADDRESS_BYTE1 0xD00 24462306a36Sopenharmony_ci#define MCI_REGISTER_MODE 0xE00 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci/* Read and write modes */ 24762306a36Sopenharmony_ci#define MCI_MODE_REGISTER_READ 0 24862306a36Sopenharmony_ci#define MCI_MODE_REGISTER_WRITE 1 24962306a36Sopenharmony_ci#define MCI_MODE_MEMORY_READ 0 25062306a36Sopenharmony_ci#define MCI_MODE_MEMORY_WRITE 0x40 25162306a36Sopenharmony_ci 25262306a36Sopenharmony_ci/*** Bit definitions for MC417_CTL register **** 25362306a36Sopenharmony_ci bits 31-6 bits 5-4 bit 3 bits 2-1 Bit 0 25462306a36Sopenharmony_ci+--------+-------------+--------+--------------+------------+ 25562306a36Sopenharmony_ci|Reserved|MC417_SPD_CTL|Reserved|MC417_GPIO_SEL|UART_GPIO_EN| 25662306a36Sopenharmony_ci+--------+-------------+--------+--------------+------------+ 25762306a36Sopenharmony_ci***/ 25862306a36Sopenharmony_ci#define MC417_SPD_CTL(x) (((x) << 4) & 0x00000030) 25962306a36Sopenharmony_ci#define MC417_GPIO_SEL(x) (((x) << 1) & 0x00000006) 26062306a36Sopenharmony_ci#define MC417_UART_GPIO_EN 0x00000001 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci/* Values for speed control */ 26362306a36Sopenharmony_ci#define MC417_SPD_CTL_SLOW 0x1 26462306a36Sopenharmony_ci#define MC417_SPD_CTL_MEDIUM 0x0 26562306a36Sopenharmony_ci#define MC417_SPD_CTL_FAST 0x3 /* b'1x, but we use b'11 */ 26662306a36Sopenharmony_ci 26762306a36Sopenharmony_ci/* Values for GPIO select */ 26862306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO3 0x3 26962306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO2 0x2 27062306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO1 0x1 27162306a36Sopenharmony_ci#define MC417_GPIO_SEL_GPIO0 0x0 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_civoid cx23885_mc417_init(struct cx23885_dev *dev) 27462306a36Sopenharmony_ci{ 27562306a36Sopenharmony_ci u32 regval; 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_ci dprintk(2, "%s()\n", __func__); 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_ci /* Configure MC417_CTL register to defaults. */ 28062306a36Sopenharmony_ci regval = MC417_SPD_CTL(MC417_SPD_CTL_FAST) | 28162306a36Sopenharmony_ci MC417_GPIO_SEL(MC417_GPIO_SEL_GPIO3) | 28262306a36Sopenharmony_ci MC417_UART_GPIO_EN; 28362306a36Sopenharmony_ci cx_write(MC417_CTL, regval); 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_ci /* Configure MC417_OEN to defaults. */ 28662306a36Sopenharmony_ci regval = MC417_MIRDY; 28762306a36Sopenharmony_ci cx_write(MC417_OEN, regval); 28862306a36Sopenharmony_ci 28962306a36Sopenharmony_ci /* Configure MC417_RWD to defaults. */ 29062306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS; 29162306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 29262306a36Sopenharmony_ci} 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_cistatic int mc417_wait_ready(struct cx23885_dev *dev) 29562306a36Sopenharmony_ci{ 29662306a36Sopenharmony_ci u32 mi_ready; 29762306a36Sopenharmony_ci unsigned long timeout = jiffies + msecs_to_jiffies(1); 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci for (;;) { 30062306a36Sopenharmony_ci mi_ready = cx_read(MC417_RWD) & MC417_MIRDY; 30162306a36Sopenharmony_ci if (mi_ready != 0) 30262306a36Sopenharmony_ci return 0; 30362306a36Sopenharmony_ci if (time_after(jiffies, timeout)) 30462306a36Sopenharmony_ci return -1; 30562306a36Sopenharmony_ci udelay(1); 30662306a36Sopenharmony_ci } 30762306a36Sopenharmony_ci} 30862306a36Sopenharmony_ci 30962306a36Sopenharmony_ciint mc417_register_write(struct cx23885_dev *dev, u16 address, u32 value) 31062306a36Sopenharmony_ci{ 31162306a36Sopenharmony_ci u32 regval; 31262306a36Sopenharmony_ci 31362306a36Sopenharmony_ci /* Enable MC417 GPIO outputs except for MC417_MIRDY, 31462306a36Sopenharmony_ci * which is an input. 31562306a36Sopenharmony_ci */ 31662306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY); 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_ci /* Write data byte 0 */ 31962306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0 | 32062306a36Sopenharmony_ci (value & 0x000000FF); 32162306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_ci /* Transition CS/WR to effect write transaction across bus. */ 32462306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 32562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci /* Write data byte 1 */ 32862306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1 | 32962306a36Sopenharmony_ci ((value >> 8) & 0x000000FF); 33062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 33162306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 33262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 33362306a36Sopenharmony_ci 33462306a36Sopenharmony_ci /* Write data byte 2 */ 33562306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2 | 33662306a36Sopenharmony_ci ((value >> 16) & 0x000000FF); 33762306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 33862306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 33962306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci /* Write data byte 3 */ 34262306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3 | 34362306a36Sopenharmony_ci ((value >> 24) & 0x000000FF); 34462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 34562306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 34662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci /* Write address byte 0 */ 34962306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 | 35062306a36Sopenharmony_ci (address & 0xFF); 35162306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 35262306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 35362306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci /* Write address byte 1 */ 35662306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 | 35762306a36Sopenharmony_ci ((address >> 8) & 0xFF); 35862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 35962306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 36062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 36162306a36Sopenharmony_ci 36262306a36Sopenharmony_ci /* Indicate that this is a write. */ 36362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE | 36462306a36Sopenharmony_ci MCI_MODE_REGISTER_WRITE; 36562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 36662306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 36762306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci /* Wait for the trans to complete (MC417_MIRDY asserted). */ 37062306a36Sopenharmony_ci return mc417_wait_ready(dev); 37162306a36Sopenharmony_ci} 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ciint mc417_register_read(struct cx23885_dev *dev, u16 address, u32 *value) 37462306a36Sopenharmony_ci{ 37562306a36Sopenharmony_ci int retval; 37662306a36Sopenharmony_ci u32 regval; 37762306a36Sopenharmony_ci u32 tempval; 37862306a36Sopenharmony_ci u32 dataval; 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_ci /* Enable MC417 GPIO outputs except for MC417_MIRDY, 38162306a36Sopenharmony_ci * which is an input. 38262306a36Sopenharmony_ci */ 38362306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY); 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci /* Write address byte 0 */ 38662306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE0 | 38762306a36Sopenharmony_ci ((address & 0x00FF)); 38862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 38962306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 39062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 39162306a36Sopenharmony_ci 39262306a36Sopenharmony_ci /* Write address byte 1 */ 39362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_ADDRESS_BYTE1 | 39462306a36Sopenharmony_ci ((address >> 8) & 0xFF); 39562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 39662306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 39762306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 39862306a36Sopenharmony_ci 39962306a36Sopenharmony_ci /* Indicate that this is a register read. */ 40062306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_MODE | 40162306a36Sopenharmony_ci MCI_MODE_REGISTER_READ; 40262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 40362306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 40462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_ci /* Wait for the trans to complete (MC417_MIRDY asserted). */ 40762306a36Sopenharmony_ci retval = mc417_wait_ready(dev); 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci /* switch the DAT0-7 GPIO[10:3] to input mode */ 41062306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA); 41162306a36Sopenharmony_ci 41262306a36Sopenharmony_ci /* Read data byte 0 */ 41362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0; 41462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_ci /* Transition RD to effect read transaction across bus. 41762306a36Sopenharmony_ci * Transition 0x5000 -> 0x9000 correct (RD/RDY -> WR/RDY)? 41862306a36Sopenharmony_ci * Should it be 0x9000 -> 0xF000 (also why is RDY being set, its 41962306a36Sopenharmony_ci * input only...) 42062306a36Sopenharmony_ci */ 42162306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE0; 42262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci /* Collect byte */ 42562306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 42662306a36Sopenharmony_ci dataval = tempval & 0x000000FF; 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci /* Bring CS and RD high. */ 42962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 43062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ci /* Read data byte 1 */ 43362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1; 43462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 43562306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE1; 43662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 43762306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 43862306a36Sopenharmony_ci dataval |= ((tempval & 0x000000FF) << 8); 43962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 44062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 44162306a36Sopenharmony_ci 44262306a36Sopenharmony_ci /* Read data byte 2 */ 44362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2; 44462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 44562306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE2; 44662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 44762306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 44862306a36Sopenharmony_ci dataval |= ((tempval & 0x000000FF) << 16); 44962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 45062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 45162306a36Sopenharmony_ci 45262306a36Sopenharmony_ci /* Read data byte 3 */ 45362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3; 45462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 45562306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_REGISTER_DATA_BYTE3; 45662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 45762306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 45862306a36Sopenharmony_ci dataval |= ((tempval & 0x000000FF) << 24); 45962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 46062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 46162306a36Sopenharmony_ci 46262306a36Sopenharmony_ci *value = dataval; 46362306a36Sopenharmony_ci 46462306a36Sopenharmony_ci return retval; 46562306a36Sopenharmony_ci} 46662306a36Sopenharmony_ci 46762306a36Sopenharmony_ciint mc417_memory_write(struct cx23885_dev *dev, u32 address, u32 value) 46862306a36Sopenharmony_ci{ 46962306a36Sopenharmony_ci u32 regval; 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_ci /* Enable MC417 GPIO outputs except for MC417_MIRDY, 47262306a36Sopenharmony_ci * which is an input. 47362306a36Sopenharmony_ci */ 47462306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY); 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci /* Write data byte 0 */ 47762306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0 | 47862306a36Sopenharmony_ci (value & 0x000000FF); 47962306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_ci /* Transition CS/WR to effect write transaction across bus. */ 48262306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 48362306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci /* Write data byte 1 */ 48662306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1 | 48762306a36Sopenharmony_ci ((value >> 8) & 0x000000FF); 48862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 48962306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 49062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 49162306a36Sopenharmony_ci 49262306a36Sopenharmony_ci /* Write data byte 2 */ 49362306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2 | 49462306a36Sopenharmony_ci ((value >> 16) & 0x000000FF); 49562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 49662306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 49762306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 49862306a36Sopenharmony_ci 49962306a36Sopenharmony_ci /* Write data byte 3 */ 50062306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3 | 50162306a36Sopenharmony_ci ((value >> 24) & 0x000000FF); 50262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 50362306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 50462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 50562306a36Sopenharmony_ci 50662306a36Sopenharmony_ci /* Write address byte 2 */ 50762306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 | 50862306a36Sopenharmony_ci MCI_MODE_MEMORY_WRITE | ((address >> 16) & 0x3F); 50962306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 51062306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 51162306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 51262306a36Sopenharmony_ci 51362306a36Sopenharmony_ci /* Write address byte 1 */ 51462306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 | 51562306a36Sopenharmony_ci ((address >> 8) & 0xFF); 51662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 51762306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 51862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci /* Write address byte 0 */ 52162306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 | 52262306a36Sopenharmony_ci (address & 0xFF); 52362306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 52462306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 52562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_ci /* Wait for the trans to complete (MC417_MIRDY asserted). */ 52862306a36Sopenharmony_ci return mc417_wait_ready(dev); 52962306a36Sopenharmony_ci} 53062306a36Sopenharmony_ci 53162306a36Sopenharmony_ciint mc417_memory_read(struct cx23885_dev *dev, u32 address, u32 *value) 53262306a36Sopenharmony_ci{ 53362306a36Sopenharmony_ci int retval; 53462306a36Sopenharmony_ci u32 regval; 53562306a36Sopenharmony_ci u32 tempval; 53662306a36Sopenharmony_ci u32 dataval; 53762306a36Sopenharmony_ci 53862306a36Sopenharmony_ci /* Enable MC417 GPIO outputs except for MC417_MIRDY, 53962306a36Sopenharmony_ci * which is an input. 54062306a36Sopenharmony_ci */ 54162306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY); 54262306a36Sopenharmony_ci 54362306a36Sopenharmony_ci /* Write address byte 2 */ 54462306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE2 | 54562306a36Sopenharmony_ci MCI_MODE_MEMORY_READ | ((address >> 16) & 0x3F); 54662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 54762306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 54862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 54962306a36Sopenharmony_ci 55062306a36Sopenharmony_ci /* Write address byte 1 */ 55162306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE1 | 55262306a36Sopenharmony_ci ((address >> 8) & 0xFF); 55362306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 55462306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 55562306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_ci /* Write address byte 0 */ 55862306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_ADDRESS_BYTE0 | 55962306a36Sopenharmony_ci (address & 0xFF); 56062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 56162306a36Sopenharmony_ci regval |= MC417_MICS | MC417_MIWR; 56262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 56362306a36Sopenharmony_ci 56462306a36Sopenharmony_ci /* Wait for the trans to complete (MC417_MIRDY asserted). */ 56562306a36Sopenharmony_ci retval = mc417_wait_ready(dev); 56662306a36Sopenharmony_ci 56762306a36Sopenharmony_ci /* switch the DAT0-7 GPIO[10:3] to input mode */ 56862306a36Sopenharmony_ci cx_write(MC417_OEN, MC417_MIRDY | MC417_MIDATA); 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_ci /* Read data byte 3 */ 57162306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3; 57262306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 57362306a36Sopenharmony_ci 57462306a36Sopenharmony_ci /* Transition RD to effect read transaction across bus. */ 57562306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE3; 57662306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 57762306a36Sopenharmony_ci 57862306a36Sopenharmony_ci /* Collect byte */ 57962306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 58062306a36Sopenharmony_ci dataval = ((tempval & 0x000000FF) << 24); 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci /* Bring CS and RD high. */ 58362306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 58462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 58562306a36Sopenharmony_ci 58662306a36Sopenharmony_ci /* Read data byte 2 */ 58762306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2; 58862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 58962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE2; 59062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 59162306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 59262306a36Sopenharmony_ci dataval |= ((tempval & 0x000000FF) << 16); 59362306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 59462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 59562306a36Sopenharmony_ci 59662306a36Sopenharmony_ci /* Read data byte 1 */ 59762306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1; 59862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 59962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE1; 60062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 60162306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 60262306a36Sopenharmony_ci dataval |= ((tempval & 0x000000FF) << 8); 60362306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 60462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 60562306a36Sopenharmony_ci 60662306a36Sopenharmony_ci /* Read data byte 0 */ 60762306a36Sopenharmony_ci regval = MC417_MIRD | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0; 60862306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 60962306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRDY | MCI_MEMORY_DATA_BYTE0; 61062306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 61162306a36Sopenharmony_ci tempval = cx_read(MC417_RWD); 61262306a36Sopenharmony_ci dataval |= (tempval & 0x000000FF); 61362306a36Sopenharmony_ci regval = MC417_MIWR | MC417_MIRD | MC417_MICS | MC417_MIRDY; 61462306a36Sopenharmony_ci cx_write(MC417_RWD, regval); 61562306a36Sopenharmony_ci 61662306a36Sopenharmony_ci *value = dataval; 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci return retval; 61962306a36Sopenharmony_ci} 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_civoid mc417_gpio_set(struct cx23885_dev *dev, u32 mask) 62262306a36Sopenharmony_ci{ 62362306a36Sopenharmony_ci u32 val; 62462306a36Sopenharmony_ci 62562306a36Sopenharmony_ci /* Set the gpio value */ 62662306a36Sopenharmony_ci mc417_register_read(dev, 0x900C, &val); 62762306a36Sopenharmony_ci val |= (mask & 0x000ffff); 62862306a36Sopenharmony_ci mc417_register_write(dev, 0x900C, val); 62962306a36Sopenharmony_ci} 63062306a36Sopenharmony_ci 63162306a36Sopenharmony_civoid mc417_gpio_clear(struct cx23885_dev *dev, u32 mask) 63262306a36Sopenharmony_ci{ 63362306a36Sopenharmony_ci u32 val; 63462306a36Sopenharmony_ci 63562306a36Sopenharmony_ci /* Clear the gpio value */ 63662306a36Sopenharmony_ci mc417_register_read(dev, 0x900C, &val); 63762306a36Sopenharmony_ci val &= ~(mask & 0x0000ffff); 63862306a36Sopenharmony_ci mc417_register_write(dev, 0x900C, val); 63962306a36Sopenharmony_ci} 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_civoid mc417_gpio_enable(struct cx23885_dev *dev, u32 mask, int asoutput) 64262306a36Sopenharmony_ci{ 64362306a36Sopenharmony_ci u32 val; 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_ci /* Enable GPIO direction bits */ 64662306a36Sopenharmony_ci mc417_register_read(dev, 0x9020, &val); 64762306a36Sopenharmony_ci if (asoutput) 64862306a36Sopenharmony_ci val |= (mask & 0x0000ffff); 64962306a36Sopenharmony_ci else 65062306a36Sopenharmony_ci val &= ~(mask & 0x0000ffff); 65162306a36Sopenharmony_ci 65262306a36Sopenharmony_ci mc417_register_write(dev, 0x9020, val); 65362306a36Sopenharmony_ci} 65462306a36Sopenharmony_ci/* ------------------------------------------------------------------ */ 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci/* MPEG encoder API */ 65762306a36Sopenharmony_cistatic char *cmd_to_str(int cmd) 65862306a36Sopenharmony_ci{ 65962306a36Sopenharmony_ci switch (cmd) { 66062306a36Sopenharmony_ci case CX2341X_ENC_PING_FW: 66162306a36Sopenharmony_ci return "PING_FW"; 66262306a36Sopenharmony_ci case CX2341X_ENC_START_CAPTURE: 66362306a36Sopenharmony_ci return "START_CAPTURE"; 66462306a36Sopenharmony_ci case CX2341X_ENC_STOP_CAPTURE: 66562306a36Sopenharmony_ci return "STOP_CAPTURE"; 66662306a36Sopenharmony_ci case CX2341X_ENC_SET_AUDIO_ID: 66762306a36Sopenharmony_ci return "SET_AUDIO_ID"; 66862306a36Sopenharmony_ci case CX2341X_ENC_SET_VIDEO_ID: 66962306a36Sopenharmony_ci return "SET_VIDEO_ID"; 67062306a36Sopenharmony_ci case CX2341X_ENC_SET_PCR_ID: 67162306a36Sopenharmony_ci return "SET_PCR_ID"; 67262306a36Sopenharmony_ci case CX2341X_ENC_SET_FRAME_RATE: 67362306a36Sopenharmony_ci return "SET_FRAME_RATE"; 67462306a36Sopenharmony_ci case CX2341X_ENC_SET_FRAME_SIZE: 67562306a36Sopenharmony_ci return "SET_FRAME_SIZE"; 67662306a36Sopenharmony_ci case CX2341X_ENC_SET_BIT_RATE: 67762306a36Sopenharmony_ci return "SET_BIT_RATE"; 67862306a36Sopenharmony_ci case CX2341X_ENC_SET_GOP_PROPERTIES: 67962306a36Sopenharmony_ci return "SET_GOP_PROPERTIES"; 68062306a36Sopenharmony_ci case CX2341X_ENC_SET_ASPECT_RATIO: 68162306a36Sopenharmony_ci return "SET_ASPECT_RATIO"; 68262306a36Sopenharmony_ci case CX2341X_ENC_SET_DNR_FILTER_MODE: 68362306a36Sopenharmony_ci return "SET_DNR_FILTER_MODE"; 68462306a36Sopenharmony_ci case CX2341X_ENC_SET_DNR_FILTER_PROPS: 68562306a36Sopenharmony_ci return "SET_DNR_FILTER_PROPS"; 68662306a36Sopenharmony_ci case CX2341X_ENC_SET_CORING_LEVELS: 68762306a36Sopenharmony_ci return "SET_CORING_LEVELS"; 68862306a36Sopenharmony_ci case CX2341X_ENC_SET_SPATIAL_FILTER_TYPE: 68962306a36Sopenharmony_ci return "SET_SPATIAL_FILTER_TYPE"; 69062306a36Sopenharmony_ci case CX2341X_ENC_SET_VBI_LINE: 69162306a36Sopenharmony_ci return "SET_VBI_LINE"; 69262306a36Sopenharmony_ci case CX2341X_ENC_SET_STREAM_TYPE: 69362306a36Sopenharmony_ci return "SET_STREAM_TYPE"; 69462306a36Sopenharmony_ci case CX2341X_ENC_SET_OUTPUT_PORT: 69562306a36Sopenharmony_ci return "SET_OUTPUT_PORT"; 69662306a36Sopenharmony_ci case CX2341X_ENC_SET_AUDIO_PROPERTIES: 69762306a36Sopenharmony_ci return "SET_AUDIO_PROPERTIES"; 69862306a36Sopenharmony_ci case CX2341X_ENC_HALT_FW: 69962306a36Sopenharmony_ci return "HALT_FW"; 70062306a36Sopenharmony_ci case CX2341X_ENC_GET_VERSION: 70162306a36Sopenharmony_ci return "GET_VERSION"; 70262306a36Sopenharmony_ci case CX2341X_ENC_SET_GOP_CLOSURE: 70362306a36Sopenharmony_ci return "SET_GOP_CLOSURE"; 70462306a36Sopenharmony_ci case CX2341X_ENC_GET_SEQ_END: 70562306a36Sopenharmony_ci return "GET_SEQ_END"; 70662306a36Sopenharmony_ci case CX2341X_ENC_SET_PGM_INDEX_INFO: 70762306a36Sopenharmony_ci return "SET_PGM_INDEX_INFO"; 70862306a36Sopenharmony_ci case CX2341X_ENC_SET_VBI_CONFIG: 70962306a36Sopenharmony_ci return "SET_VBI_CONFIG"; 71062306a36Sopenharmony_ci case CX2341X_ENC_SET_DMA_BLOCK_SIZE: 71162306a36Sopenharmony_ci return "SET_DMA_BLOCK_SIZE"; 71262306a36Sopenharmony_ci case CX2341X_ENC_GET_PREV_DMA_INFO_MB_10: 71362306a36Sopenharmony_ci return "GET_PREV_DMA_INFO_MB_10"; 71462306a36Sopenharmony_ci case CX2341X_ENC_GET_PREV_DMA_INFO_MB_9: 71562306a36Sopenharmony_ci return "GET_PREV_DMA_INFO_MB_9"; 71662306a36Sopenharmony_ci case CX2341X_ENC_SCHED_DMA_TO_HOST: 71762306a36Sopenharmony_ci return "SCHED_DMA_TO_HOST"; 71862306a36Sopenharmony_ci case CX2341X_ENC_INITIALIZE_INPUT: 71962306a36Sopenharmony_ci return "INITIALIZE_INPUT"; 72062306a36Sopenharmony_ci case CX2341X_ENC_SET_FRAME_DROP_RATE: 72162306a36Sopenharmony_ci return "SET_FRAME_DROP_RATE"; 72262306a36Sopenharmony_ci case CX2341X_ENC_PAUSE_ENCODER: 72362306a36Sopenharmony_ci return "PAUSE_ENCODER"; 72462306a36Sopenharmony_ci case CX2341X_ENC_REFRESH_INPUT: 72562306a36Sopenharmony_ci return "REFRESH_INPUT"; 72662306a36Sopenharmony_ci case CX2341X_ENC_SET_COPYRIGHT: 72762306a36Sopenharmony_ci return "SET_COPYRIGHT"; 72862306a36Sopenharmony_ci case CX2341X_ENC_SET_EVENT_NOTIFICATION: 72962306a36Sopenharmony_ci return "SET_EVENT_NOTIFICATION"; 73062306a36Sopenharmony_ci case CX2341X_ENC_SET_NUM_VSYNC_LINES: 73162306a36Sopenharmony_ci return "SET_NUM_VSYNC_LINES"; 73262306a36Sopenharmony_ci case CX2341X_ENC_SET_PLACEHOLDER: 73362306a36Sopenharmony_ci return "SET_PLACEHOLDER"; 73462306a36Sopenharmony_ci case CX2341X_ENC_MUTE_VIDEO: 73562306a36Sopenharmony_ci return "MUTE_VIDEO"; 73662306a36Sopenharmony_ci case CX2341X_ENC_MUTE_AUDIO: 73762306a36Sopenharmony_ci return "MUTE_AUDIO"; 73862306a36Sopenharmony_ci case CX2341X_ENC_MISC: 73962306a36Sopenharmony_ci return "MISC"; 74062306a36Sopenharmony_ci default: 74162306a36Sopenharmony_ci return "UNKNOWN"; 74262306a36Sopenharmony_ci } 74362306a36Sopenharmony_ci} 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_cistatic int cx23885_mbox_func(void *priv, 74662306a36Sopenharmony_ci u32 command, 74762306a36Sopenharmony_ci int in, 74862306a36Sopenharmony_ci int out, 74962306a36Sopenharmony_ci u32 data[CX2341X_MBOX_MAX_DATA]) 75062306a36Sopenharmony_ci{ 75162306a36Sopenharmony_ci struct cx23885_dev *dev = priv; 75262306a36Sopenharmony_ci unsigned long timeout; 75362306a36Sopenharmony_ci u32 value, flag, retval = 0; 75462306a36Sopenharmony_ci int i; 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_ci dprintk(3, "%s: command(0x%X) = %s\n", __func__, command, 75762306a36Sopenharmony_ci cmd_to_str(command)); 75862306a36Sopenharmony_ci 75962306a36Sopenharmony_ci /* this may not be 100% safe if we can't read any memory location 76062306a36Sopenharmony_ci without side effects */ 76162306a36Sopenharmony_ci mc417_memory_read(dev, dev->cx23417_mailbox - 4, &value); 76262306a36Sopenharmony_ci if (value != 0x12345678) { 76362306a36Sopenharmony_ci pr_err("Firmware and/or mailbox pointer not initialized or corrupted, signature = 0x%x, cmd = %s\n", 76462306a36Sopenharmony_ci value, cmd_to_str(command)); 76562306a36Sopenharmony_ci return -1; 76662306a36Sopenharmony_ci } 76762306a36Sopenharmony_ci 76862306a36Sopenharmony_ci /* This read looks at 32 bits, but flag is only 8 bits. 76962306a36Sopenharmony_ci * Seems we also bail if CMD or TIMEOUT bytes are set??? 77062306a36Sopenharmony_ci */ 77162306a36Sopenharmony_ci mc417_memory_read(dev, dev->cx23417_mailbox, &flag); 77262306a36Sopenharmony_ci if (flag) { 77362306a36Sopenharmony_ci pr_err("ERROR: Mailbox appears to be in use (%x), cmd = %s\n", 77462306a36Sopenharmony_ci flag, cmd_to_str(command)); 77562306a36Sopenharmony_ci return -1; 77662306a36Sopenharmony_ci } 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_ci flag |= 1; /* tell 'em we're working on it */ 77962306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox, flag); 78062306a36Sopenharmony_ci 78162306a36Sopenharmony_ci /* write command + args + fill remaining with zeros */ 78262306a36Sopenharmony_ci /* command code */ 78362306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox + 1, command); 78462306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox + 3, 78562306a36Sopenharmony_ci IVTV_API_STD_TIMEOUT); /* timeout */ 78662306a36Sopenharmony_ci for (i = 0; i < in; i++) { 78762306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, data[i]); 78862306a36Sopenharmony_ci dprintk(3, "API Input %d = %d\n", i, data[i]); 78962306a36Sopenharmony_ci } 79062306a36Sopenharmony_ci for (; i < CX2341X_MBOX_MAX_DATA; i++) 79162306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox + 4 + i, 0); 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_ci flag |= 3; /* tell 'em we're done writing */ 79462306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox, flag); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci /* wait for firmware to handle the API command */ 79762306a36Sopenharmony_ci timeout = jiffies + msecs_to_jiffies(10); 79862306a36Sopenharmony_ci for (;;) { 79962306a36Sopenharmony_ci mc417_memory_read(dev, dev->cx23417_mailbox, &flag); 80062306a36Sopenharmony_ci if (0 != (flag & 4)) 80162306a36Sopenharmony_ci break; 80262306a36Sopenharmony_ci if (time_after(jiffies, timeout)) { 80362306a36Sopenharmony_ci pr_err("ERROR: API Mailbox timeout\n"); 80462306a36Sopenharmony_ci return -1; 80562306a36Sopenharmony_ci } 80662306a36Sopenharmony_ci udelay(10); 80762306a36Sopenharmony_ci } 80862306a36Sopenharmony_ci 80962306a36Sopenharmony_ci /* read output values */ 81062306a36Sopenharmony_ci for (i = 0; i < out; i++) { 81162306a36Sopenharmony_ci mc417_memory_read(dev, dev->cx23417_mailbox + 4 + i, data + i); 81262306a36Sopenharmony_ci dprintk(3, "API Output %d = %d\n", i, data[i]); 81362306a36Sopenharmony_ci } 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_ci mc417_memory_read(dev, dev->cx23417_mailbox + 2, &retval); 81662306a36Sopenharmony_ci dprintk(3, "API result = %d\n", retval); 81762306a36Sopenharmony_ci 81862306a36Sopenharmony_ci flag = 0; 81962306a36Sopenharmony_ci mc417_memory_write(dev, dev->cx23417_mailbox, flag); 82062306a36Sopenharmony_ci 82162306a36Sopenharmony_ci return retval; 82262306a36Sopenharmony_ci} 82362306a36Sopenharmony_ci 82462306a36Sopenharmony_ci/* We don't need to call the API often, so using just one 82562306a36Sopenharmony_ci * mailbox will probably suffice 82662306a36Sopenharmony_ci */ 82762306a36Sopenharmony_cistatic int cx23885_api_cmd(struct cx23885_dev *dev, 82862306a36Sopenharmony_ci u32 command, 82962306a36Sopenharmony_ci u32 inputcnt, 83062306a36Sopenharmony_ci u32 outputcnt, 83162306a36Sopenharmony_ci ...) 83262306a36Sopenharmony_ci{ 83362306a36Sopenharmony_ci u32 data[CX2341X_MBOX_MAX_DATA]; 83462306a36Sopenharmony_ci va_list vargs; 83562306a36Sopenharmony_ci int i, err; 83662306a36Sopenharmony_ci 83762306a36Sopenharmony_ci dprintk(3, "%s() cmds = 0x%08x\n", __func__, command); 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci va_start(vargs, outputcnt); 84062306a36Sopenharmony_ci for (i = 0; i < inputcnt; i++) 84162306a36Sopenharmony_ci data[i] = va_arg(vargs, int); 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci err = cx23885_mbox_func(dev, command, inputcnt, outputcnt, data); 84462306a36Sopenharmony_ci for (i = 0; i < outputcnt; i++) { 84562306a36Sopenharmony_ci int *vptr = va_arg(vargs, int *); 84662306a36Sopenharmony_ci *vptr = data[i]; 84762306a36Sopenharmony_ci } 84862306a36Sopenharmony_ci va_end(vargs); 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci return err; 85162306a36Sopenharmony_ci} 85262306a36Sopenharmony_ci 85362306a36Sopenharmony_cistatic int cx23885_api_func(void *priv, u32 cmd, int in, int out, u32 data[CX2341X_MBOX_MAX_DATA]) 85462306a36Sopenharmony_ci{ 85562306a36Sopenharmony_ci return cx23885_mbox_func(priv, cmd, in, out, data); 85662306a36Sopenharmony_ci} 85762306a36Sopenharmony_ci 85862306a36Sopenharmony_cistatic int cx23885_find_mailbox(struct cx23885_dev *dev) 85962306a36Sopenharmony_ci{ 86062306a36Sopenharmony_ci u32 signature[4] = { 86162306a36Sopenharmony_ci 0x12345678, 0x34567812, 0x56781234, 0x78123456 86262306a36Sopenharmony_ci }; 86362306a36Sopenharmony_ci int signaturecnt = 0; 86462306a36Sopenharmony_ci u32 value; 86562306a36Sopenharmony_ci int i; 86662306a36Sopenharmony_ci 86762306a36Sopenharmony_ci dprintk(2, "%s()\n", __func__); 86862306a36Sopenharmony_ci 86962306a36Sopenharmony_ci for (i = 0; i < CX23885_FIRM_IMAGE_SIZE; i++) { 87062306a36Sopenharmony_ci mc417_memory_read(dev, i, &value); 87162306a36Sopenharmony_ci if (value == signature[signaturecnt]) 87262306a36Sopenharmony_ci signaturecnt++; 87362306a36Sopenharmony_ci else 87462306a36Sopenharmony_ci signaturecnt = 0; 87562306a36Sopenharmony_ci if (4 == signaturecnt) { 87662306a36Sopenharmony_ci dprintk(1, "Mailbox signature found at 0x%x\n", i+1); 87762306a36Sopenharmony_ci return i+1; 87862306a36Sopenharmony_ci } 87962306a36Sopenharmony_ci } 88062306a36Sopenharmony_ci pr_err("Mailbox signature values not found!\n"); 88162306a36Sopenharmony_ci return -1; 88262306a36Sopenharmony_ci} 88362306a36Sopenharmony_ci 88462306a36Sopenharmony_cistatic int cx23885_load_firmware(struct cx23885_dev *dev) 88562306a36Sopenharmony_ci{ 88662306a36Sopenharmony_ci static const unsigned char magic[8] = { 88762306a36Sopenharmony_ci 0xa7, 0x0d, 0x00, 0x00, 0x66, 0xbb, 0x55, 0xaa 88862306a36Sopenharmony_ci }; 88962306a36Sopenharmony_ci const struct firmware *firmware; 89062306a36Sopenharmony_ci int i, retval = 0; 89162306a36Sopenharmony_ci u32 value = 0; 89262306a36Sopenharmony_ci u32 gpio_output = 0; 89362306a36Sopenharmony_ci u32 gpio_value; 89462306a36Sopenharmony_ci u32 checksum = 0; 89562306a36Sopenharmony_ci u32 *dataptr; 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_ci dprintk(2, "%s()\n", __func__); 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_ci /* Save GPIO settings before reset of APU */ 90062306a36Sopenharmony_ci retval |= mc417_memory_read(dev, 0x9020, &gpio_output); 90162306a36Sopenharmony_ci retval |= mc417_memory_read(dev, 0x900C, &gpio_value); 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_ci retval = mc417_register_write(dev, 90462306a36Sopenharmony_ci IVTV_REG_VPU, 0xFFFFFFED); 90562306a36Sopenharmony_ci retval |= mc417_register_write(dev, 90662306a36Sopenharmony_ci IVTV_REG_HW_BLOCKS, IVTV_CMD_HW_BLOCKS_RST); 90762306a36Sopenharmony_ci retval |= mc417_register_write(dev, 90862306a36Sopenharmony_ci IVTV_REG_ENC_SDRAM_REFRESH, 0x80000800); 90962306a36Sopenharmony_ci retval |= mc417_register_write(dev, 91062306a36Sopenharmony_ci IVTV_REG_ENC_SDRAM_PRECHARGE, 0x1A); 91162306a36Sopenharmony_ci retval |= mc417_register_write(dev, 91262306a36Sopenharmony_ci IVTV_REG_APU, 0); 91362306a36Sopenharmony_ci 91462306a36Sopenharmony_ci if (retval != 0) { 91562306a36Sopenharmony_ci pr_err("%s: Error with mc417_register_write\n", 91662306a36Sopenharmony_ci __func__); 91762306a36Sopenharmony_ci return -1; 91862306a36Sopenharmony_ci } 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci retval = request_firmware(&firmware, CX23885_FIRM_IMAGE_NAME, 92162306a36Sopenharmony_ci &dev->pci->dev); 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci if (retval != 0) { 92462306a36Sopenharmony_ci pr_err("ERROR: Hotplug firmware request failed (%s).\n", 92562306a36Sopenharmony_ci CX23885_FIRM_IMAGE_NAME); 92662306a36Sopenharmony_ci pr_err("Please fix your hotplug setup, the board will not work without firmware loaded!\n"); 92762306a36Sopenharmony_ci return -1; 92862306a36Sopenharmony_ci } 92962306a36Sopenharmony_ci 93062306a36Sopenharmony_ci if (firmware->size != CX23885_FIRM_IMAGE_SIZE) { 93162306a36Sopenharmony_ci pr_err("ERROR: Firmware size mismatch (have %zu, expected %d)\n", 93262306a36Sopenharmony_ci firmware->size, CX23885_FIRM_IMAGE_SIZE); 93362306a36Sopenharmony_ci release_firmware(firmware); 93462306a36Sopenharmony_ci return -1; 93562306a36Sopenharmony_ci } 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci if (0 != memcmp(firmware->data, magic, 8)) { 93862306a36Sopenharmony_ci pr_err("ERROR: Firmware magic mismatch, wrong file?\n"); 93962306a36Sopenharmony_ci release_firmware(firmware); 94062306a36Sopenharmony_ci return -1; 94162306a36Sopenharmony_ci } 94262306a36Sopenharmony_ci 94362306a36Sopenharmony_ci /* transfer to the chip */ 94462306a36Sopenharmony_ci dprintk(2, "Loading firmware ...\n"); 94562306a36Sopenharmony_ci dataptr = (u32 *)firmware->data; 94662306a36Sopenharmony_ci for (i = 0; i < (firmware->size >> 2); i++) { 94762306a36Sopenharmony_ci value = *dataptr; 94862306a36Sopenharmony_ci checksum += ~value; 94962306a36Sopenharmony_ci if (mc417_memory_write(dev, i, value) != 0) { 95062306a36Sopenharmony_ci pr_err("ERROR: Loading firmware failed!\n"); 95162306a36Sopenharmony_ci release_firmware(firmware); 95262306a36Sopenharmony_ci return -1; 95362306a36Sopenharmony_ci } 95462306a36Sopenharmony_ci dataptr++; 95562306a36Sopenharmony_ci } 95662306a36Sopenharmony_ci 95762306a36Sopenharmony_ci /* read back to verify with the checksum */ 95862306a36Sopenharmony_ci dprintk(1, "Verifying firmware ...\n"); 95962306a36Sopenharmony_ci for (i--; i >= 0; i--) { 96062306a36Sopenharmony_ci if (mc417_memory_read(dev, i, &value) != 0) { 96162306a36Sopenharmony_ci pr_err("ERROR: Reading firmware failed!\n"); 96262306a36Sopenharmony_ci release_firmware(firmware); 96362306a36Sopenharmony_ci return -1; 96462306a36Sopenharmony_ci } 96562306a36Sopenharmony_ci checksum -= ~value; 96662306a36Sopenharmony_ci } 96762306a36Sopenharmony_ci if (checksum) { 96862306a36Sopenharmony_ci pr_err("ERROR: Firmware load failed (checksum mismatch).\n"); 96962306a36Sopenharmony_ci release_firmware(firmware); 97062306a36Sopenharmony_ci return -1; 97162306a36Sopenharmony_ci } 97262306a36Sopenharmony_ci release_firmware(firmware); 97362306a36Sopenharmony_ci dprintk(1, "Firmware upload successful.\n"); 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci retval |= mc417_register_write(dev, IVTV_REG_HW_BLOCKS, 97662306a36Sopenharmony_ci IVTV_CMD_HW_BLOCKS_RST); 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci /* F/W power up disturbs the GPIOs, restore state */ 97962306a36Sopenharmony_ci retval |= mc417_register_write(dev, 0x9020, gpio_output); 98062306a36Sopenharmony_ci retval |= mc417_register_write(dev, 0x900C, gpio_value); 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci retval |= mc417_register_read(dev, IVTV_REG_VPU, &value); 98362306a36Sopenharmony_ci retval |= mc417_register_write(dev, IVTV_REG_VPU, value & 0xFFFFFFE8); 98462306a36Sopenharmony_ci 98562306a36Sopenharmony_ci /* Hardcoded GPIO's here */ 98662306a36Sopenharmony_ci retval |= mc417_register_write(dev, 0x9020, 0x4000); 98762306a36Sopenharmony_ci retval |= mc417_register_write(dev, 0x900C, 0x4000); 98862306a36Sopenharmony_ci 98962306a36Sopenharmony_ci mc417_register_read(dev, 0x9020, &gpio_output); 99062306a36Sopenharmony_ci mc417_register_read(dev, 0x900C, &gpio_value); 99162306a36Sopenharmony_ci 99262306a36Sopenharmony_ci if (retval < 0) 99362306a36Sopenharmony_ci pr_err("%s: Error with mc417_register_write\n", 99462306a36Sopenharmony_ci __func__); 99562306a36Sopenharmony_ci return 0; 99662306a36Sopenharmony_ci} 99762306a36Sopenharmony_ci 99862306a36Sopenharmony_civoid cx23885_417_check_encoder(struct cx23885_dev *dev) 99962306a36Sopenharmony_ci{ 100062306a36Sopenharmony_ci u32 status, seq; 100162306a36Sopenharmony_ci 100262306a36Sopenharmony_ci status = seq = 0; 100362306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_GET_SEQ_END, 0, 2, &status, &seq); 100462306a36Sopenharmony_ci dprintk(1, "%s() status = %d, seq = %d\n", __func__, status, seq); 100562306a36Sopenharmony_ci} 100662306a36Sopenharmony_ci 100762306a36Sopenharmony_cistatic void cx23885_codec_settings(struct cx23885_dev *dev) 100862306a36Sopenharmony_ci{ 100962306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 101062306a36Sopenharmony_ci 101162306a36Sopenharmony_ci /* Dynamically change the height based on video standard */ 101262306a36Sopenharmony_ci if (dev->encodernorm.id & V4L2_STD_525_60) 101362306a36Sopenharmony_ci dev->ts1.height = 480; 101462306a36Sopenharmony_ci else 101562306a36Sopenharmony_ci dev->ts1.height = 576; 101662306a36Sopenharmony_ci 101762306a36Sopenharmony_ci /* assign frame size */ 101862306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0, 101962306a36Sopenharmony_ci dev->ts1.height, dev->ts1.width); 102062306a36Sopenharmony_ci 102162306a36Sopenharmony_ci dev->cxhdl.width = dev->ts1.width; 102262306a36Sopenharmony_ci dev->cxhdl.height = dev->ts1.height; 102362306a36Sopenharmony_ci dev->cxhdl.is_50hz = 102462306a36Sopenharmony_ci (dev->encodernorm.id & V4L2_STD_625_50) != 0; 102562306a36Sopenharmony_ci 102662306a36Sopenharmony_ci cx2341x_handler_setup(&dev->cxhdl); 102762306a36Sopenharmony_ci 102862306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 3, 1); 102962306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_MISC, 2, 0, 4, 1); 103062306a36Sopenharmony_ci} 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_cistatic int cx23885_initialize_codec(struct cx23885_dev *dev, int startencoder) 103362306a36Sopenharmony_ci{ 103462306a36Sopenharmony_ci int version; 103562306a36Sopenharmony_ci int retval; 103662306a36Sopenharmony_ci u32 i, data[7]; 103762306a36Sopenharmony_ci 103862306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0); /* ping */ 104162306a36Sopenharmony_ci if (retval < 0) { 104262306a36Sopenharmony_ci dprintk(2, "%s() PING OK\n", __func__); 104362306a36Sopenharmony_ci retval = cx23885_load_firmware(dev); 104462306a36Sopenharmony_ci if (retval < 0) { 104562306a36Sopenharmony_ci pr_err("%s() f/w load failed\n", __func__); 104662306a36Sopenharmony_ci return retval; 104762306a36Sopenharmony_ci } 104862306a36Sopenharmony_ci retval = cx23885_find_mailbox(dev); 104962306a36Sopenharmony_ci if (retval < 0) { 105062306a36Sopenharmony_ci pr_err("%s() mailbox < 0, error\n", 105162306a36Sopenharmony_ci __func__); 105262306a36Sopenharmony_ci return -1; 105362306a36Sopenharmony_ci } 105462306a36Sopenharmony_ci dev->cx23417_mailbox = retval; 105562306a36Sopenharmony_ci retval = cx23885_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0); 105662306a36Sopenharmony_ci if (retval < 0) { 105762306a36Sopenharmony_ci pr_err("ERROR: cx23417 firmware ping failed!\n"); 105862306a36Sopenharmony_ci return -1; 105962306a36Sopenharmony_ci } 106062306a36Sopenharmony_ci retval = cx23885_api_cmd(dev, CX2341X_ENC_GET_VERSION, 0, 1, 106162306a36Sopenharmony_ci &version); 106262306a36Sopenharmony_ci if (retval < 0) { 106362306a36Sopenharmony_ci pr_err("ERROR: cx23417 firmware get encoder :version failed!\n"); 106462306a36Sopenharmony_ci return -1; 106562306a36Sopenharmony_ci } 106662306a36Sopenharmony_ci dprintk(1, "cx23417 firmware version is 0x%08x\n", version); 106762306a36Sopenharmony_ci msleep(200); 106862306a36Sopenharmony_ci } 106962306a36Sopenharmony_ci 107062306a36Sopenharmony_ci cx23885_codec_settings(dev); 107162306a36Sopenharmony_ci msleep(60); 107262306a36Sopenharmony_ci 107362306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_NUM_VSYNC_LINES, 2, 0, 107462306a36Sopenharmony_ci CX23885_FIELD1_SAA7115, CX23885_FIELD2_SAA7115); 107562306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_PLACEHOLDER, 12, 0, 107662306a36Sopenharmony_ci CX23885_CUSTOM_EXTENSION_USR_DATA, 0, 0, 0, 0, 0, 0, 0, 0, 0, 107762306a36Sopenharmony_ci 0, 0); 107862306a36Sopenharmony_ci 107962306a36Sopenharmony_ci /* Setup to capture VBI */ 108062306a36Sopenharmony_ci data[0] = 0x0001BD00; 108162306a36Sopenharmony_ci data[1] = 1; /* frames per interrupt */ 108262306a36Sopenharmony_ci data[2] = 4; /* total bufs */ 108362306a36Sopenharmony_ci data[3] = 0x91559155; /* start codes */ 108462306a36Sopenharmony_ci data[4] = 0x206080C0; /* stop codes */ 108562306a36Sopenharmony_ci data[5] = 6; /* lines */ 108662306a36Sopenharmony_ci data[6] = 64; /* BPL */ 108762306a36Sopenharmony_ci 108862306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_CONFIG, 7, 0, data[0], data[1], 108962306a36Sopenharmony_ci data[2], data[3], data[4], data[5], data[6]); 109062306a36Sopenharmony_ci 109162306a36Sopenharmony_ci for (i = 2; i <= 24; i++) { 109262306a36Sopenharmony_ci int valid; 109362306a36Sopenharmony_ci 109462306a36Sopenharmony_ci valid = ((i >= 19) && (i <= 21)); 109562306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0, i, 109662306a36Sopenharmony_ci valid, 0 , 0, 0); 109762306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_SET_VBI_LINE, 5, 0, 109862306a36Sopenharmony_ci i | 0x80000000, valid, 0, 0, 0); 109962306a36Sopenharmony_ci } 110062306a36Sopenharmony_ci 110162306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_MUTE_AUDIO, 1, 0, CX23885_UNMUTE); 110262306a36Sopenharmony_ci msleep(60); 110362306a36Sopenharmony_ci 110462306a36Sopenharmony_ci /* initialize the video input */ 110562306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_INITIALIZE_INPUT, 0, 0); 110662306a36Sopenharmony_ci msleep(60); 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci /* Enable VIP style pixel invalidation so we work with scaled mode */ 110962306a36Sopenharmony_ci mc417_memory_write(dev, 2120, 0x00000080); 111062306a36Sopenharmony_ci 111162306a36Sopenharmony_ci /* start capturing to the host interface */ 111262306a36Sopenharmony_ci if (startencoder) { 111362306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_START_CAPTURE, 2, 0, 111462306a36Sopenharmony_ci CX23885_MPEG_CAPTURE, CX23885_RAW_BITS_NONE); 111562306a36Sopenharmony_ci msleep(10); 111662306a36Sopenharmony_ci } 111762306a36Sopenharmony_ci 111862306a36Sopenharmony_ci return 0; 111962306a36Sopenharmony_ci} 112062306a36Sopenharmony_ci 112162306a36Sopenharmony_ci/* ------------------------------------------------------------------ */ 112262306a36Sopenharmony_ci 112362306a36Sopenharmony_cistatic int queue_setup(struct vb2_queue *q, 112462306a36Sopenharmony_ci unsigned int *num_buffers, unsigned int *num_planes, 112562306a36Sopenharmony_ci unsigned int sizes[], struct device *alloc_devs[]) 112662306a36Sopenharmony_ci{ 112762306a36Sopenharmony_ci struct cx23885_dev *dev = q->drv_priv; 112862306a36Sopenharmony_ci 112962306a36Sopenharmony_ci dev->ts1.ts_packet_size = mpeglinesize; 113062306a36Sopenharmony_ci dev->ts1.ts_packet_count = mpeglines; 113162306a36Sopenharmony_ci *num_planes = 1; 113262306a36Sopenharmony_ci sizes[0] = mpeglinesize * mpeglines; 113362306a36Sopenharmony_ci *num_buffers = mpegbufs; 113462306a36Sopenharmony_ci return 0; 113562306a36Sopenharmony_ci} 113662306a36Sopenharmony_ci 113762306a36Sopenharmony_cistatic int buffer_prepare(struct vb2_buffer *vb) 113862306a36Sopenharmony_ci{ 113962306a36Sopenharmony_ci struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 114062306a36Sopenharmony_ci struct cx23885_dev *dev = vb->vb2_queue->drv_priv; 114162306a36Sopenharmony_ci struct cx23885_buffer *buf = 114262306a36Sopenharmony_ci container_of(vbuf, struct cx23885_buffer, vb); 114362306a36Sopenharmony_ci 114462306a36Sopenharmony_ci return cx23885_buf_prepare(buf, &dev->ts1); 114562306a36Sopenharmony_ci} 114662306a36Sopenharmony_ci 114762306a36Sopenharmony_cistatic void buffer_finish(struct vb2_buffer *vb) 114862306a36Sopenharmony_ci{ 114962306a36Sopenharmony_ci struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 115062306a36Sopenharmony_ci struct cx23885_dev *dev = vb->vb2_queue->drv_priv; 115162306a36Sopenharmony_ci struct cx23885_buffer *buf = container_of(vbuf, 115262306a36Sopenharmony_ci struct cx23885_buffer, vb); 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_ci cx23885_free_buffer(dev, buf); 115562306a36Sopenharmony_ci} 115662306a36Sopenharmony_ci 115762306a36Sopenharmony_cistatic void buffer_queue(struct vb2_buffer *vb) 115862306a36Sopenharmony_ci{ 115962306a36Sopenharmony_ci struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 116062306a36Sopenharmony_ci struct cx23885_dev *dev = vb->vb2_queue->drv_priv; 116162306a36Sopenharmony_ci struct cx23885_buffer *buf = container_of(vbuf, 116262306a36Sopenharmony_ci struct cx23885_buffer, vb); 116362306a36Sopenharmony_ci 116462306a36Sopenharmony_ci cx23885_buf_queue(&dev->ts1, buf); 116562306a36Sopenharmony_ci} 116662306a36Sopenharmony_ci 116762306a36Sopenharmony_cistatic int cx23885_start_streaming(struct vb2_queue *q, unsigned int count) 116862306a36Sopenharmony_ci{ 116962306a36Sopenharmony_ci struct cx23885_dev *dev = q->drv_priv; 117062306a36Sopenharmony_ci struct cx23885_dmaqueue *dmaq = &dev->ts1.mpegq; 117162306a36Sopenharmony_ci unsigned long flags; 117262306a36Sopenharmony_ci int ret; 117362306a36Sopenharmony_ci 117462306a36Sopenharmony_ci ret = cx23885_initialize_codec(dev, 1); 117562306a36Sopenharmony_ci if (ret == 0) { 117662306a36Sopenharmony_ci struct cx23885_buffer *buf = list_entry(dmaq->active.next, 117762306a36Sopenharmony_ci struct cx23885_buffer, queue); 117862306a36Sopenharmony_ci 117962306a36Sopenharmony_ci cx23885_start_dma(&dev->ts1, dmaq, buf); 118062306a36Sopenharmony_ci return 0; 118162306a36Sopenharmony_ci } 118262306a36Sopenharmony_ci spin_lock_irqsave(&dev->slock, flags); 118362306a36Sopenharmony_ci while (!list_empty(&dmaq->active)) { 118462306a36Sopenharmony_ci struct cx23885_buffer *buf = list_entry(dmaq->active.next, 118562306a36Sopenharmony_ci struct cx23885_buffer, queue); 118662306a36Sopenharmony_ci 118762306a36Sopenharmony_ci list_del(&buf->queue); 118862306a36Sopenharmony_ci vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_QUEUED); 118962306a36Sopenharmony_ci } 119062306a36Sopenharmony_ci spin_unlock_irqrestore(&dev->slock, flags); 119162306a36Sopenharmony_ci return ret; 119262306a36Sopenharmony_ci} 119362306a36Sopenharmony_ci 119462306a36Sopenharmony_cistatic void cx23885_stop_streaming(struct vb2_queue *q) 119562306a36Sopenharmony_ci{ 119662306a36Sopenharmony_ci struct cx23885_dev *dev = q->drv_priv; 119762306a36Sopenharmony_ci 119862306a36Sopenharmony_ci /* stop mpeg capture */ 119962306a36Sopenharmony_ci cx23885_api_cmd(dev, CX2341X_ENC_STOP_CAPTURE, 3, 0, 120062306a36Sopenharmony_ci CX23885_END_NOW, CX23885_MPEG_CAPTURE, 120162306a36Sopenharmony_ci CX23885_RAW_BITS_NONE); 120262306a36Sopenharmony_ci 120362306a36Sopenharmony_ci msleep(500); 120462306a36Sopenharmony_ci cx23885_417_check_encoder(dev); 120562306a36Sopenharmony_ci cx23885_cancel_buffers(&dev->ts1); 120662306a36Sopenharmony_ci} 120762306a36Sopenharmony_ci 120862306a36Sopenharmony_cistatic const struct vb2_ops cx23885_qops = { 120962306a36Sopenharmony_ci .queue_setup = queue_setup, 121062306a36Sopenharmony_ci .buf_prepare = buffer_prepare, 121162306a36Sopenharmony_ci .buf_finish = buffer_finish, 121262306a36Sopenharmony_ci .buf_queue = buffer_queue, 121362306a36Sopenharmony_ci .wait_prepare = vb2_ops_wait_prepare, 121462306a36Sopenharmony_ci .wait_finish = vb2_ops_wait_finish, 121562306a36Sopenharmony_ci .start_streaming = cx23885_start_streaming, 121662306a36Sopenharmony_ci .stop_streaming = cx23885_stop_streaming, 121762306a36Sopenharmony_ci}; 121862306a36Sopenharmony_ci 121962306a36Sopenharmony_ci/* ------------------------------------------------------------------ */ 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_cistatic int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *id) 122262306a36Sopenharmony_ci{ 122362306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 122462306a36Sopenharmony_ci 122562306a36Sopenharmony_ci *id = dev->tvnorm; 122662306a36Sopenharmony_ci return 0; 122762306a36Sopenharmony_ci} 122862306a36Sopenharmony_ci 122962306a36Sopenharmony_cistatic int vidioc_s_std(struct file *file, void *priv, v4l2_std_id id) 123062306a36Sopenharmony_ci{ 123162306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 123262306a36Sopenharmony_ci unsigned int i; 123362306a36Sopenharmony_ci int ret; 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(cx23885_tvnorms); i++) 123662306a36Sopenharmony_ci if (id & cx23885_tvnorms[i].id) 123762306a36Sopenharmony_ci break; 123862306a36Sopenharmony_ci if (i == ARRAY_SIZE(cx23885_tvnorms)) 123962306a36Sopenharmony_ci return -EINVAL; 124062306a36Sopenharmony_ci 124162306a36Sopenharmony_ci ret = cx23885_set_tvnorm(dev, id); 124262306a36Sopenharmony_ci if (!ret) 124362306a36Sopenharmony_ci dev->encodernorm = cx23885_tvnorms[i]; 124462306a36Sopenharmony_ci return ret; 124562306a36Sopenharmony_ci} 124662306a36Sopenharmony_ci 124762306a36Sopenharmony_cistatic int vidioc_enum_input(struct file *file, void *priv, 124862306a36Sopenharmony_ci struct v4l2_input *i) 124962306a36Sopenharmony_ci{ 125062306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 125162306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 125262306a36Sopenharmony_ci return cx23885_enum_input(dev, i); 125362306a36Sopenharmony_ci} 125462306a36Sopenharmony_ci 125562306a36Sopenharmony_cistatic int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 125662306a36Sopenharmony_ci{ 125762306a36Sopenharmony_ci return cx23885_get_input(file, priv, i); 125862306a36Sopenharmony_ci} 125962306a36Sopenharmony_ci 126062306a36Sopenharmony_cistatic int vidioc_s_input(struct file *file, void *priv, unsigned int i) 126162306a36Sopenharmony_ci{ 126262306a36Sopenharmony_ci return cx23885_set_input(file, priv, i); 126362306a36Sopenharmony_ci} 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_cistatic int vidioc_g_tuner(struct file *file, void *priv, 126662306a36Sopenharmony_ci struct v4l2_tuner *t) 126762306a36Sopenharmony_ci{ 126862306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 126962306a36Sopenharmony_ci 127062306a36Sopenharmony_ci if (dev->tuner_type == TUNER_ABSENT) 127162306a36Sopenharmony_ci return -EINVAL; 127262306a36Sopenharmony_ci if (0 != t->index) 127362306a36Sopenharmony_ci return -EINVAL; 127462306a36Sopenharmony_ci strscpy(t->name, "Television", sizeof(t->name)); 127562306a36Sopenharmony_ci call_all(dev, tuner, g_tuner, t); 127662306a36Sopenharmony_ci 127762306a36Sopenharmony_ci dprintk(1, "VIDIOC_G_TUNER: tuner type %d\n", t->type); 127862306a36Sopenharmony_ci 127962306a36Sopenharmony_ci return 0; 128062306a36Sopenharmony_ci} 128162306a36Sopenharmony_ci 128262306a36Sopenharmony_cistatic int vidioc_s_tuner(struct file *file, void *priv, 128362306a36Sopenharmony_ci const struct v4l2_tuner *t) 128462306a36Sopenharmony_ci{ 128562306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 128662306a36Sopenharmony_ci 128762306a36Sopenharmony_ci if (dev->tuner_type == TUNER_ABSENT) 128862306a36Sopenharmony_ci return -EINVAL; 128962306a36Sopenharmony_ci 129062306a36Sopenharmony_ci /* Update the A/V core */ 129162306a36Sopenharmony_ci call_all(dev, tuner, s_tuner, t); 129262306a36Sopenharmony_ci 129362306a36Sopenharmony_ci return 0; 129462306a36Sopenharmony_ci} 129562306a36Sopenharmony_ci 129662306a36Sopenharmony_cistatic int vidioc_g_frequency(struct file *file, void *priv, 129762306a36Sopenharmony_ci struct v4l2_frequency *f) 129862306a36Sopenharmony_ci{ 129962306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 130062306a36Sopenharmony_ci 130162306a36Sopenharmony_ci if (dev->tuner_type == TUNER_ABSENT) 130262306a36Sopenharmony_ci return -EINVAL; 130362306a36Sopenharmony_ci f->type = V4L2_TUNER_ANALOG_TV; 130462306a36Sopenharmony_ci f->frequency = dev->freq; 130562306a36Sopenharmony_ci 130662306a36Sopenharmony_ci call_all(dev, tuner, g_frequency, f); 130762306a36Sopenharmony_ci 130862306a36Sopenharmony_ci return 0; 130962306a36Sopenharmony_ci} 131062306a36Sopenharmony_ci 131162306a36Sopenharmony_cistatic int vidioc_s_frequency(struct file *file, void *priv, 131262306a36Sopenharmony_ci const struct v4l2_frequency *f) 131362306a36Sopenharmony_ci{ 131462306a36Sopenharmony_ci return cx23885_set_frequency(file, priv, f); 131562306a36Sopenharmony_ci} 131662306a36Sopenharmony_ci 131762306a36Sopenharmony_cistatic int vidioc_querycap(struct file *file, void *priv, 131862306a36Sopenharmony_ci struct v4l2_capability *cap) 131962306a36Sopenharmony_ci{ 132062306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 132162306a36Sopenharmony_ci struct cx23885_tsport *tsport = &dev->ts1; 132262306a36Sopenharmony_ci 132362306a36Sopenharmony_ci strscpy(cap->driver, dev->name, sizeof(cap->driver)); 132462306a36Sopenharmony_ci strscpy(cap->card, cx23885_boards[tsport->dev->board].name, 132562306a36Sopenharmony_ci sizeof(cap->card)); 132662306a36Sopenharmony_ci sprintf(cap->bus_info, "PCIe:%s", pci_name(dev->pci)); 132762306a36Sopenharmony_ci cap->capabilities = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_READWRITE | 132862306a36Sopenharmony_ci V4L2_CAP_STREAMING | V4L2_CAP_VBI_CAPTURE | 132962306a36Sopenharmony_ci V4L2_CAP_AUDIO | V4L2_CAP_DEVICE_CAPS; 133062306a36Sopenharmony_ci if (dev->tuner_type != TUNER_ABSENT) 133162306a36Sopenharmony_ci cap->capabilities |= V4L2_CAP_TUNER; 133262306a36Sopenharmony_ci 133362306a36Sopenharmony_ci return 0; 133462306a36Sopenharmony_ci} 133562306a36Sopenharmony_ci 133662306a36Sopenharmony_cistatic int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 133762306a36Sopenharmony_ci struct v4l2_fmtdesc *f) 133862306a36Sopenharmony_ci{ 133962306a36Sopenharmony_ci if (f->index != 0) 134062306a36Sopenharmony_ci return -EINVAL; 134162306a36Sopenharmony_ci 134262306a36Sopenharmony_ci f->pixelformat = V4L2_PIX_FMT_MPEG; 134362306a36Sopenharmony_ci 134462306a36Sopenharmony_ci return 0; 134562306a36Sopenharmony_ci} 134662306a36Sopenharmony_ci 134762306a36Sopenharmony_cistatic int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 134862306a36Sopenharmony_ci struct v4l2_format *f) 134962306a36Sopenharmony_ci{ 135062306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 135162306a36Sopenharmony_ci 135262306a36Sopenharmony_ci f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; 135362306a36Sopenharmony_ci f->fmt.pix.bytesperline = 0; 135462306a36Sopenharmony_ci f->fmt.pix.sizeimage = 135562306a36Sopenharmony_ci dev->ts1.ts_packet_size * dev->ts1.ts_packet_count; 135662306a36Sopenharmony_ci f->fmt.pix.colorspace = 0; 135762306a36Sopenharmony_ci f->fmt.pix.width = dev->ts1.width; 135862306a36Sopenharmony_ci f->fmt.pix.height = dev->ts1.height; 135962306a36Sopenharmony_ci f->fmt.pix.field = V4L2_FIELD_INTERLACED; 136062306a36Sopenharmony_ci dprintk(1, "VIDIOC_G_FMT: w: %d, h: %d\n", 136162306a36Sopenharmony_ci dev->ts1.width, dev->ts1.height); 136262306a36Sopenharmony_ci return 0; 136362306a36Sopenharmony_ci} 136462306a36Sopenharmony_ci 136562306a36Sopenharmony_cistatic int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 136662306a36Sopenharmony_ci struct v4l2_format *f) 136762306a36Sopenharmony_ci{ 136862306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 136962306a36Sopenharmony_ci 137062306a36Sopenharmony_ci f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; 137162306a36Sopenharmony_ci f->fmt.pix.bytesperline = 0; 137262306a36Sopenharmony_ci f->fmt.pix.sizeimage = 137362306a36Sopenharmony_ci dev->ts1.ts_packet_size * dev->ts1.ts_packet_count; 137462306a36Sopenharmony_ci f->fmt.pix.colorspace = 0; 137562306a36Sopenharmony_ci f->fmt.pix.field = V4L2_FIELD_INTERLACED; 137662306a36Sopenharmony_ci dprintk(1, "VIDIOC_TRY_FMT: w: %d, h: %d\n", 137762306a36Sopenharmony_ci dev->ts1.width, dev->ts1.height); 137862306a36Sopenharmony_ci return 0; 137962306a36Sopenharmony_ci} 138062306a36Sopenharmony_ci 138162306a36Sopenharmony_cistatic int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 138262306a36Sopenharmony_ci struct v4l2_format *f) 138362306a36Sopenharmony_ci{ 138462306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; 138762306a36Sopenharmony_ci f->fmt.pix.bytesperline = 0; 138862306a36Sopenharmony_ci f->fmt.pix.sizeimage = 138962306a36Sopenharmony_ci dev->ts1.ts_packet_size * dev->ts1.ts_packet_count; 139062306a36Sopenharmony_ci f->fmt.pix.colorspace = 0; 139162306a36Sopenharmony_ci f->fmt.pix.field = V4L2_FIELD_INTERLACED; 139262306a36Sopenharmony_ci dprintk(1, "VIDIOC_S_FMT: w: %d, h: %d, f: %d\n", 139362306a36Sopenharmony_ci f->fmt.pix.width, f->fmt.pix.height, f->fmt.pix.field); 139462306a36Sopenharmony_ci return 0; 139562306a36Sopenharmony_ci} 139662306a36Sopenharmony_ci 139762306a36Sopenharmony_cistatic int vidioc_log_status(struct file *file, void *priv) 139862306a36Sopenharmony_ci{ 139962306a36Sopenharmony_ci struct cx23885_dev *dev = video_drvdata(file); 140062306a36Sopenharmony_ci char name[32 + 2]; 140162306a36Sopenharmony_ci 140262306a36Sopenharmony_ci snprintf(name, sizeof(name), "%s/2", dev->name); 140362306a36Sopenharmony_ci call_all(dev, core, log_status); 140462306a36Sopenharmony_ci v4l2_ctrl_handler_log_status(&dev->cxhdl.hdl, name); 140562306a36Sopenharmony_ci return 0; 140662306a36Sopenharmony_ci} 140762306a36Sopenharmony_ci 140862306a36Sopenharmony_cistatic const struct v4l2_file_operations mpeg_fops = { 140962306a36Sopenharmony_ci .owner = THIS_MODULE, 141062306a36Sopenharmony_ci .open = v4l2_fh_open, 141162306a36Sopenharmony_ci .release = vb2_fop_release, 141262306a36Sopenharmony_ci .read = vb2_fop_read, 141362306a36Sopenharmony_ci .poll = vb2_fop_poll, 141462306a36Sopenharmony_ci .unlocked_ioctl = video_ioctl2, 141562306a36Sopenharmony_ci .mmap = vb2_fop_mmap, 141662306a36Sopenharmony_ci}; 141762306a36Sopenharmony_ci 141862306a36Sopenharmony_cistatic const struct v4l2_ioctl_ops mpeg_ioctl_ops = { 141962306a36Sopenharmony_ci .vidioc_g_std = vidioc_g_std, 142062306a36Sopenharmony_ci .vidioc_s_std = vidioc_s_std, 142162306a36Sopenharmony_ci .vidioc_enum_input = vidioc_enum_input, 142262306a36Sopenharmony_ci .vidioc_g_input = vidioc_g_input, 142362306a36Sopenharmony_ci .vidioc_s_input = vidioc_s_input, 142462306a36Sopenharmony_ci .vidioc_g_tuner = vidioc_g_tuner, 142562306a36Sopenharmony_ci .vidioc_s_tuner = vidioc_s_tuner, 142662306a36Sopenharmony_ci .vidioc_g_frequency = vidioc_g_frequency, 142762306a36Sopenharmony_ci .vidioc_s_frequency = vidioc_s_frequency, 142862306a36Sopenharmony_ci .vidioc_querycap = vidioc_querycap, 142962306a36Sopenharmony_ci .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 143062306a36Sopenharmony_ci .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 143162306a36Sopenharmony_ci .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 143262306a36Sopenharmony_ci .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 143362306a36Sopenharmony_ci .vidioc_reqbufs = vb2_ioctl_reqbufs, 143462306a36Sopenharmony_ci .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 143562306a36Sopenharmony_ci .vidioc_querybuf = vb2_ioctl_querybuf, 143662306a36Sopenharmony_ci .vidioc_qbuf = vb2_ioctl_qbuf, 143762306a36Sopenharmony_ci .vidioc_dqbuf = vb2_ioctl_dqbuf, 143862306a36Sopenharmony_ci .vidioc_streamon = vb2_ioctl_streamon, 143962306a36Sopenharmony_ci .vidioc_streamoff = vb2_ioctl_streamoff, 144062306a36Sopenharmony_ci .vidioc_log_status = vidioc_log_status, 144162306a36Sopenharmony_ci#ifdef CONFIG_VIDEO_ADV_DEBUG 144262306a36Sopenharmony_ci .vidioc_g_chip_info = cx23885_g_chip_info, 144362306a36Sopenharmony_ci .vidioc_g_register = cx23885_g_register, 144462306a36Sopenharmony_ci .vidioc_s_register = cx23885_s_register, 144562306a36Sopenharmony_ci#endif 144662306a36Sopenharmony_ci}; 144762306a36Sopenharmony_ci 144862306a36Sopenharmony_cistatic struct video_device cx23885_mpeg_template = { 144962306a36Sopenharmony_ci .name = "cx23885", 145062306a36Sopenharmony_ci .fops = &mpeg_fops, 145162306a36Sopenharmony_ci .ioctl_ops = &mpeg_ioctl_ops, 145262306a36Sopenharmony_ci .tvnorms = CX23885_NORMS, 145362306a36Sopenharmony_ci}; 145462306a36Sopenharmony_ci 145562306a36Sopenharmony_civoid cx23885_417_unregister(struct cx23885_dev *dev) 145662306a36Sopenharmony_ci{ 145762306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 145862306a36Sopenharmony_ci 145962306a36Sopenharmony_ci if (dev->v4l_device) { 146062306a36Sopenharmony_ci if (video_is_registered(dev->v4l_device)) 146162306a36Sopenharmony_ci video_unregister_device(dev->v4l_device); 146262306a36Sopenharmony_ci else 146362306a36Sopenharmony_ci video_device_release(dev->v4l_device); 146462306a36Sopenharmony_ci v4l2_ctrl_handler_free(&dev->cxhdl.hdl); 146562306a36Sopenharmony_ci dev->v4l_device = NULL; 146662306a36Sopenharmony_ci } 146762306a36Sopenharmony_ci} 146862306a36Sopenharmony_ci 146962306a36Sopenharmony_cistatic struct video_device *cx23885_video_dev_alloc( 147062306a36Sopenharmony_ci struct cx23885_tsport *tsport, 147162306a36Sopenharmony_ci struct pci_dev *pci, 147262306a36Sopenharmony_ci struct video_device *template, 147362306a36Sopenharmony_ci char *type) 147462306a36Sopenharmony_ci{ 147562306a36Sopenharmony_ci struct video_device *vfd; 147662306a36Sopenharmony_ci struct cx23885_dev *dev = tsport->dev; 147762306a36Sopenharmony_ci 147862306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 147962306a36Sopenharmony_ci 148062306a36Sopenharmony_ci vfd = video_device_alloc(); 148162306a36Sopenharmony_ci if (NULL == vfd) 148262306a36Sopenharmony_ci return NULL; 148362306a36Sopenharmony_ci *vfd = *template; 148462306a36Sopenharmony_ci snprintf(vfd->name, sizeof(vfd->name), "%s (%s)", 148562306a36Sopenharmony_ci cx23885_boards[tsport->dev->board].name, type); 148662306a36Sopenharmony_ci vfd->v4l2_dev = &dev->v4l2_dev; 148762306a36Sopenharmony_ci vfd->release = video_device_release; 148862306a36Sopenharmony_ci return vfd; 148962306a36Sopenharmony_ci} 149062306a36Sopenharmony_ci 149162306a36Sopenharmony_ciint cx23885_417_register(struct cx23885_dev *dev) 149262306a36Sopenharmony_ci{ 149362306a36Sopenharmony_ci /* FIXME: Port1 hardcoded here */ 149462306a36Sopenharmony_ci int err = -ENODEV; 149562306a36Sopenharmony_ci struct cx23885_tsport *tsport = &dev->ts1; 149662306a36Sopenharmony_ci struct vb2_queue *q; 149762306a36Sopenharmony_ci 149862306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 149962306a36Sopenharmony_ci 150062306a36Sopenharmony_ci if (cx23885_boards[dev->board].portb != CX23885_MPEG_ENCODER) 150162306a36Sopenharmony_ci return err; 150262306a36Sopenharmony_ci 150362306a36Sopenharmony_ci /* Set default TV standard */ 150462306a36Sopenharmony_ci dev->encodernorm = cx23885_tvnorms[0]; 150562306a36Sopenharmony_ci 150662306a36Sopenharmony_ci if (dev->encodernorm.id & V4L2_STD_525_60) 150762306a36Sopenharmony_ci tsport->height = 480; 150862306a36Sopenharmony_ci else 150962306a36Sopenharmony_ci tsport->height = 576; 151062306a36Sopenharmony_ci 151162306a36Sopenharmony_ci tsport->width = 720; 151262306a36Sopenharmony_ci dev->cxhdl.port = CX2341X_PORT_SERIAL; 151362306a36Sopenharmony_ci err = cx2341x_handler_init(&dev->cxhdl, 50); 151462306a36Sopenharmony_ci if (err) 151562306a36Sopenharmony_ci return err; 151662306a36Sopenharmony_ci dev->cxhdl.priv = dev; 151762306a36Sopenharmony_ci dev->cxhdl.func = cx23885_api_func; 151862306a36Sopenharmony_ci cx2341x_handler_set_50hz(&dev->cxhdl, tsport->height == 576); 151962306a36Sopenharmony_ci v4l2_ctrl_add_handler(&dev->ctrl_handler, &dev->cxhdl.hdl, NULL, false); 152062306a36Sopenharmony_ci 152162306a36Sopenharmony_ci /* Allocate and initialize V4L video device */ 152262306a36Sopenharmony_ci dev->v4l_device = cx23885_video_dev_alloc(tsport, 152362306a36Sopenharmony_ci dev->pci, &cx23885_mpeg_template, "mpeg"); 152462306a36Sopenharmony_ci q = &dev->vb2_mpegq; 152562306a36Sopenharmony_ci q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 152662306a36Sopenharmony_ci q->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF | VB2_READ; 152762306a36Sopenharmony_ci q->gfp_flags = GFP_DMA32; 152862306a36Sopenharmony_ci q->min_buffers_needed = 2; 152962306a36Sopenharmony_ci q->drv_priv = dev; 153062306a36Sopenharmony_ci q->buf_struct_size = sizeof(struct cx23885_buffer); 153162306a36Sopenharmony_ci q->ops = &cx23885_qops; 153262306a36Sopenharmony_ci q->mem_ops = &vb2_dma_sg_memops; 153362306a36Sopenharmony_ci q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 153462306a36Sopenharmony_ci q->lock = &dev->lock; 153562306a36Sopenharmony_ci q->dev = &dev->pci->dev; 153662306a36Sopenharmony_ci 153762306a36Sopenharmony_ci err = vb2_queue_init(q); 153862306a36Sopenharmony_ci if (err < 0) 153962306a36Sopenharmony_ci return err; 154062306a36Sopenharmony_ci video_set_drvdata(dev->v4l_device, dev); 154162306a36Sopenharmony_ci dev->v4l_device->lock = &dev->lock; 154262306a36Sopenharmony_ci dev->v4l_device->queue = q; 154362306a36Sopenharmony_ci dev->v4l_device->device_caps = V4L2_CAP_VIDEO_CAPTURE | 154462306a36Sopenharmony_ci V4L2_CAP_READWRITE | V4L2_CAP_STREAMING; 154562306a36Sopenharmony_ci if (dev->tuner_type != TUNER_ABSENT) 154662306a36Sopenharmony_ci dev->v4l_device->device_caps |= V4L2_CAP_TUNER; 154762306a36Sopenharmony_ci err = video_register_device(dev->v4l_device, 154862306a36Sopenharmony_ci VFL_TYPE_VIDEO, -1); 154962306a36Sopenharmony_ci if (err < 0) { 155062306a36Sopenharmony_ci pr_info("%s: can't register mpeg device\n", dev->name); 155162306a36Sopenharmony_ci return err; 155262306a36Sopenharmony_ci } 155362306a36Sopenharmony_ci 155462306a36Sopenharmony_ci pr_info("%s: registered device %s [mpeg]\n", 155562306a36Sopenharmony_ci dev->name, video_device_node_name(dev->v4l_device)); 155662306a36Sopenharmony_ci 155762306a36Sopenharmony_ci /* ST: Configure the encoder parameters, but don't begin 155862306a36Sopenharmony_ci * encoding, this resolves an issue where the first time the 155962306a36Sopenharmony_ci * encoder is started video can be choppy. 156062306a36Sopenharmony_ci */ 156162306a36Sopenharmony_ci cx23885_initialize_codec(dev, 0); 156262306a36Sopenharmony_ci 156362306a36Sopenharmony_ci return 0; 156462306a36Sopenharmony_ci} 156562306a36Sopenharmony_ci 156662306a36Sopenharmony_ciMODULE_FIRMWARE(CX23885_FIRM_IMAGE_NAME); 1567