diff options
Diffstat (limited to 'target/device/Atmel/misc-patches/linux-2.6.24-500-v4l-avr32-isi.patch')
| -rw-r--r-- | target/device/Atmel/misc-patches/linux-2.6.24-500-v4l-avr32-isi.patch | 2954 |
1 files changed, 2954 insertions, 0 deletions
diff --git a/target/device/Atmel/misc-patches/linux-2.6.24-500-v4l-avr32-isi.patch b/target/device/Atmel/misc-patches/linux-2.6.24-500-v4l-avr32-isi.patch new file mode 100644 index 000000000..f79ab82a2 --- /dev/null +++ b/target/device/Atmel/misc-patches/linux-2.6.24-500-v4l-avr32-isi.patch @@ -0,0 +1,2954 @@ +diff --git a/include/linux/videodev2.h b/include/linux/videodev2.h +index 441b877..3a85a5e 100644 +--- a/include/linux/videodev2.h ++++ b/include/linux/videodev2.h +@@ -298,6 +298,9 @@ struct v4l2_pix_format + #define V4L2_PIX_FMT_PWC2 v4l2_fourcc('P','W','C','2') /* pwc newer webcam */ + #define V4L2_PIX_FMT_ET61X251 v4l2_fourcc('E','6','2','5') /* ET61X251 compression */ + ++/* Byte-swapped YUYV */ ++#define V4L2_PIX_FMT_VYUY v4l2_fourcc('V','Y','U','Y') /* 16 YUV 4:2:2 */ ++#define V4L2_PIX_FMT_YVYU v4l2_fourcc('Y','V','Y','U') /* 16 YUV 4:2:2 */ + /* + * F O R M A T E N U M E R A T I O N + */ +diff --git a/drivers/media/video/Makefile b/drivers/media/video/Makefile +index 44ccaed..78e38d0 100644 +--- a/drivers/media/video/Makefile ++++ b/drivers/media/video/Makefile +@@ -77,6 +77,7 @@ obj-$(CONFIG_VIDEO_HEXIUM_ORION) += hexium_orion.o + obj-$(CONFIG_VIDEO_HEXIUM_GEMINI) += hexium_gemini.o + obj-$(CONFIG_VIDEO_DPC) += dpc7146.o + obj-$(CONFIG_TUNER_3036) += tuner-3036.o ++obj-$(CONFIG_VIDEO_AVR32_ISI) += atmel-isi.o + + obj-$(CONFIG_VIDEO_TUNER) += tuner.o + obj-$(CONFIG_VIDEO_BUF) += video-buf.o +diff --git a/drivers/media/video/atmel-isi.c b/drivers/media/video/atmel-isi.c +new file mode 100644 +index 0000000..a53a3c0 +--- /dev/null ++++ b/drivers/media/video/atmel-isi.c +@@ -0,0 +1,1868 @@ ++/* ++ * Copyright (c) 2007 Atmel Corporation ++ * ++ * Based on the bttv driver for Bt848 with respective copyright holders ++ * ++ * 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. ++ */ ++#define DEBUG ++#include <linux/clk.h> ++#include <linux/completion.h> ++#include <linux/dma-mapping.h> ++#include <linux/fs.h> ++#include <linux/init.h> ++#include <linux/interrupt.h> ++#include <linux/ioctl.h> ++#include <linux/kernel.h> ++#include <linux/mm.h> ++#include <linux/module.h> ++#include <linux/moduleparam.h> ++#include <linux/platform_device.h> ++#include <linux/slab.h> ++#include <linux/version.h> ++#include <linux/videodev2.h> ++#include <linux/wait.h> ++ ++#include <linux/kfifo.h> ++ ++#include <asm/io.h> ++ ++#include <media/v4l2-common.h> ++ ++#include "atmel-isi.h" ++ ++#define ATMEL_ISI_VERSION KERNEL_VERSION(0, 1, 0) ++#define ISI_CODEC 0 ++ ++/* Default ISI capture buffer size */ ++#define ISI_CAPTURE_BUFFER_SIZE 800*600*2 ++/* Default ISI video frame size */ ++#define ISI_VIDEO_BUFFER_SIZE 320*240*2 ++/* Default number of ISI video buffers */ ++#define ISI_VIDEO_BUFFERS 4 ++/* Maximum number of video buffers */ ++#define ISI_VIDEO_BUFFERS_MAX 8 ++ ++/* Interrupt mask for a single capture */ ++#define ISI_CAPTURE_MASK (ISI_BIT(SOF) | ISI_BIT(FO_C_EMP)) ++ ++/* ISI capture buffer size */ ++static int capture_buffer_size = ISI_CAPTURE_BUFFER_SIZE; ++/* Number of buffers used for streaming video */ ++static int video_buffers = 4; ++static int video_buffer_size = ISI_VIDEO_BUFFER_SIZE; ++ ++/* Preview path horizontal size */ ++static int prev_hsize = 320; ++/* Preview path vertical size */ ++static int prev_vsize = 240; ++/* Scaling factor of the preview path */ ++static int prev_decimation_factor = 1; ++ ++/* Input image horizontal size */ ++static int image_hsize = 320; ++ ++/* Input image vertical size */ ++static int image_vsize = 240; ++ ++/* Frame rate scaler ++ * 1 = capture every second frame ++ * 2 = capture every third frame ++ * ... ++ * */ ++static int frame_rate_scaler = 2; ++ ++/* Set this value if we want to pretend a specific V4L2 output format ++ * This format is for the capturing interface ++ */ ++static int capture_v4l2_fmt = V4L2_PIX_FMT_YUYV; ++/* Set this value if we want to pretend a specific V4L2 output format ++ * This format is for the streaming interface ++ */ ++static int streaming_v4l2_fmt = V4L2_PIX_FMT_YUYV; ++ ++MODULE_PARM_DESC(video_buffers,"Number of frame buffers used for streaming"); ++module_param(video_buffers, int, 0664); ++MODULE_PARM_DESC(capture_buffer_size,"Capture buffer size"); ++module_param(capture_buffer_size, int, 0664); ++MODULE_PARM_DESC(image_hsize,"Horizontal size of input image"); ++module_param(image_hsize, int, 0664); ++MODULE_PARM_DESC(image_vsize,"Vertical size of input image"); ++module_param(image_vsize, int, 0664); ++MODULE_PARM_DESC(frame_rate_scaler, "Frame rate scaler"); ++module_param(frame_rate_scaler, int, 0664); ++MODULE_PARM_DESC(prev_hsize, "Horizontal image size of preview path output"); ++module_param(prev_hsize, int, 0664); ++MODULE_PARM_DESC(prev_vsize, "Vertical image size of preview path output"); ++module_param(prev_vsize, int, 0664); ++MODULE_PARM_DESC(prev_decimation_factor, "Preview path decimaion factor"); ++module_param(prev_decimation_factor, int, 0664); ++/* Single frame capturing states */ ++enum { ++ STATE_IDLE = 0, ++ STATE_CAPTURE_READY, ++ STATE_CAPTURE_WAIT_SOF, ++ STATE_CAPTURE_IN_PROGRESS, ++ STATE_CAPTURE_DONE, ++ STATE_CAPTURE_ERROR, ++}; ++ ++/* Frame buffer states ++ * FRAME_UNUSED Frame(buffer) is not used by the ISI module -> an application ++ * can usually read out data in this state ++ * FRAME_QUEUED An application has queued the buffer in the incoming queue ++ * FRAME_DONE The ISI module has filled the buffer with data and placed is on ++ * the outgoing queue ++ * FRAME_ERROR Not used at the moment ++ * */ ++enum frame_status { ++ FRAME_UNUSED, ++ FRAME_QUEUED, ++ FRAME_DONE, ++ FRAME_ERROR, ++}; ++/* Frame buffer descriptor ++ * Used by the ISI module as a linked list for the DMA controller. ++ */ ++struct fbd { ++ /* Physical address of the frame buffer */ ++ dma_addr_t fb_address; ++ /* Physical address of the next fbd */ ++ dma_addr_t next_fbd_address; ++}; ++ ++/* Frame buffer data ++ */ ++struct frame_buffer { ++ /* Frame buffer descriptor ++ * Used by the ISI DMA controller to provide linked list DMA operation ++ */ ++ struct fbd fb_desc; ++ /* Pointer to the start of the frame buffer */ ++ void *frame_buffer; ++ /* Timestamp of the captured frame */ ++ struct timeval timestamp; ++ /* Frame number of the frame */ ++ unsigned long sequence; ++ /* Buffer number*/ ++ int index; ++ /* Bytes used in the buffer for data, needed as buffers are always ++ * aligned to pages and thus may be bigger than the amount of data*/ ++ int bytes_used; ++ /* Mmap count ++ * Counter to measure how often this buffer is mmapped ++ */ ++ int mmap_count; ++ /* Buffer status */ ++ enum frame_status status; ++}; ++ ++struct atmel_isi { ++ /* ISI module spin lock. Protects against concurrent access of variables ++ * that are shared with the ISR */ ++ spinlock_t lock; ++ void __iomem *regs; ++ /* Pointer to the start of the fbd list */ ++ dma_addr_t fbd_list_start; ++ /* Frame buffers */ ++ struct frame_buffer video_buffer[ISI_VIDEO_BUFFERS_MAX]; ++ /* Frame buffer currently used by the ISI module */ ++ struct frame_buffer *current_buffer; ++ /* Size of a frame buffer */ ++ size_t capture_buffer_size; ++ /* Streaming status ++ * If set ISI is in streaming mode */ ++ int streaming; ++ /* Queue for incoming buffers ++ * The buffer number (index) is stored in the fifo as reference ++ */ ++ struct kfifo *grabq; ++ /* Spinlock for the incoming queue */ ++ spinlock_t grabq_lock; ++ /* Queue for outgoing buffers ++ * Buffer number is stored in the fifo as reference ++ */ ++ struct kfifo *doneq; ++ /* Spinlock for the incoming queue */ ++ spinlock_t doneq_lock; ++ ++ /* State of the ISI module in capturing mode */ ++ int state; ++ /* Pointer to ISI buffer */ ++ void *capture_buf; ++ /* Physical address of the capture buffer */ ++ dma_addr_t capture_phys; ++ /* Size of the ISI buffer */ ++ size_t capture_buf_size; ++ /* Capture/streaming wait queue */ ++ wait_queue_head_t capture_wq; ++ ++ struct atmel_isi_camera *camera; ++ struct atmel_isi_format format; ++ struct atmel_isi_format streaming_format; ++ ++ struct mutex mutex; ++ /* User counter for the streaming interface */ ++ int stream_users; ++ /* User counter of the capture interface */ ++ int capture_users; ++ /* Video device for capturing (Codec path) */ ++ struct video_device cdev; ++ /* Video device for streaming (Preview path) */ ++ struct video_device vdev; ++ struct completion reset_complete; ++ struct clk *pclk; ++ struct clk *hclk; ++ struct platform_device *pdev; ++ unsigned int irq; ++}; ++ ++#define to_atmel_isi(vdev) container_of(vdev, struct atmel_isi, vdev) ++ ++struct atmel_isi_fh { ++ struct atmel_isi *isi; ++ unsigned int read_off; ++}; ++ ++/*----------------------------------------------------------------------------- ++ * Interface to the actual camera. ++ */ ++static LIST_HEAD(camera_list); ++static DEFINE_MUTEX(camera_list_mutex); ++ ++static void avr32_isi_release_camera(struct atmel_isi *isi, ++ struct atmel_isi_camera *cam) ++{ ++ mutex_lock(&camera_list_mutex); ++ cam->isi = NULL; ++ isi->camera = NULL; ++ module_put(cam->owner); ++ mutex_unlock(&camera_list_mutex); ++} ++ ++int atmel_isi_register_camera(struct atmel_isi_camera *cam) ++{ ++ pr_debug("atmel_isi: register camera %s\n", cam->name); ++ ++ mutex_lock(&camera_list_mutex); ++ list_add_tail(&cam->list, &camera_list); ++ mutex_unlock(&camera_list_mutex); ++ ++ return 0; ++} ++EXPORT_SYMBOL_GPL(atmel_isi_register_camera); ++ ++void atmel_isi_unregister_camera(struct atmel_isi_camera *cam) ++{ ++ pr_debug("atmel_isi: unregister camera %s\n", cam->name); ++ ++ mutex_lock(&camera_list_mutex); ++ if (cam->isi) ++ cam->isi->camera = NULL; ++ list_del(&cam->list); ++ mutex_unlock(&camera_list_mutex); ++} ++EXPORT_SYMBOL_GPL(atmel_isi_unregister_camera); ++ ++static struct atmel_isi_camera * avr32_isi_grab_camera(struct atmel_isi *isi) ++{ ++ struct atmel_isi_camera *entry, *cam = NULL; ++ ++ mutex_lock(&camera_list_mutex); ++ list_for_each_entry(entry, &camera_list, list) { ++ /* Just grab the first camera available */ ++ if (!entry->isi) { ++ if (!try_module_get(entry->owner)) ++ continue; ++ ++ cam = entry; ++ cam->isi = isi; ++ pr_debug("%s: got camera: %s\n", ++ isi->vdev.name, cam->name); ++ break; ++ } ++ } ++ mutex_unlock(&camera_list_mutex); ++ ++ return cam; ++} ++ ++static int avr32_isi_set_camera_input(struct atmel_isi *isi) ++{ ++ struct atmel_isi_camera *cam = isi->camera; ++ int ret; ++ u32 cr1; ++ u32 cr2; ++ ++ isi->format.pix.width = image_hsize; ++ isi->format.pix.height = image_vsize; ++ isi->format.pix.bytesperline = 0; ++ ++ ret = cam->set_format(cam, &isi->format); ++ if (ret) ++ return ret; ++ ++ ++ switch (isi->format.input_format) { ++ case ATMEL_ISI_PIXFMT_GREY: ++ cr2 = ISI_BIT(GRAYSCALE); ++ break; ++ case ATMEL_ISI_PIXFMT_CbYCrY: ++ cr2 = ISI_BF(YCC_SWAP, 0); ++ break; ++ case ATMEL_ISI_PIXFMT_CrYCbY: ++ cr2 = ISI_BF(YCC_SWAP, 1); ++ break; ++ case ATMEL_ISI_PIXFMT_YCbYCr: ++ cr2 = ISI_BF(YCC_SWAP, 2); ++ break; ++ case ATMEL_ISI_PIXFMT_YCrYCb: ++ cr2 = ISI_BF(YCC_SWAP, 3); ++ break; ++ case ATMEL_ISI_PIXFMT_RGB24: ++ cr2 = ISI_BIT(COL_SPACE) | ISI_BF(RGB_CFG, 0); ++ break; ++ case ATMEL_ISI_PIXFMT_BGR24: ++ cr2 = ISI_BIT(COL_SPACE) | ISI_BF(RGB_CFG, 1); ++ break; ++ case ATMEL_ISI_PIXFMT_RGB16: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_MODE) ++ | ISI_BF(RGB_CFG, 0)); ++ break; ++ case ATMEL_ISI_PIXFMT_BGR16: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_MODE) ++ | ISI_BF(RGB_CFG, 1)); ++ break; ++ case ATMEL_ISI_PIXFMT_GRB16: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_MODE) ++ | ISI_BF(RGB_CFG, 2)); ++ break; ++ case ATMEL_ISI_PIXFMT_GBR16: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_MODE) ++ | ISI_BF(RGB_CFG, 3)); ++ break; ++ case ATMEL_ISI_PIXFMT_RGB24_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BF(RGB_CFG, 0)); ++ break; ++ case ATMEL_ISI_PIXFMT_BGR24_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BF(RGB_CFG, 1)); ++ break; ++ case ATMEL_ISI_PIXFMT_RGB16_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BIT(RGB_MODE) | ISI_BF(RGB_CFG, 0)); ++ break; ++ case ATMEL_ISI_PIXFMT_BGR16_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BIT(RGB_MODE) | ISI_BF(RGB_CFG, 1)); ++ break; ++ case ATMEL_ISI_PIXFMT_GRB16_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BIT(RGB_MODE) | ISI_BF(RGB_CFG, 2)); ++ break; ++ case ATMEL_ISI_PIXFMT_GBR16_REV: ++ cr2 = (ISI_BIT(COL_SPACE) | ISI_BIT(RGB_SWAP) ++ | ISI_BIT(RGB_MODE) | ISI_BF(RGB_CFG, 3)); ++ break; ++ default: ++ return -EINVAL; ++ } ++ ++ ++ cr1 = ISI_BF(EMB_SYNC, cam->has_emb_sync) ++ | ISI_BF(HSYNC_POL, cam->hsync_act_low) ++ | ISI_BF(VSYNC_POL, cam->vsync_act_low) ++ | ISI_BF(PIXCLK_POL, cam->pclk_act_falling) ++ | ISI_BIT(DIS); ++ ++ isi_writel(isi, CR1, cr1); ++ isi_writel(isi, CR2, cr2); ++ ++ return 0; ++} ++ ++static int avr32_isi_capture_set_format(struct atmel_isi *isi, ++ struct atmel_isi_format *fmt) ++{ ++ u32 cr2; ++ ++ fmt->pix.width = min(2048U, fmt->pix.width); ++ fmt->pix.height = min(2048U, fmt->pix.height); ++ fmt->pix.bytesperline = 0; ++ ++ /* Set format if we have specified one */ ++ if(capture_v4l2_fmt){ ++ fmt->pix.pixelformat = capture_v4l2_fmt; ++ } ++ else { ++ /* Codec path output format */ ++ fmt->pix.pixelformat = V4L2_PIX_FMT_YVYU; ++ } ++ ++ /* The ISI module outputs either YUV 4:2:2 (codec path) ++ * or RGB 5:5:5 (preview path) (ISI grayscale mode is not supported ++ * by V4L2). Therefore two pixels will be in a 32bit word */ ++ fmt->pix.bytesperline = ALIGN(fmt->pix.width * 2, 4); ++ fmt->pix.sizeimage = fmt->pix.bytesperline * fmt->pix.height; ++ ++ cr2 = isi_readl(isi, CR2); ++ cr2 = ISI_BFINS(IM_VSIZE, fmt->pix.height - 1, cr2); ++ cr2 = ISI_BFINS(IM_HSIZE, fmt->pix.width - 1, cr2); ++ isi_writel(isi, CR2, cr2); ++ ++ pr_debug("set capture format: width=%d height=%d\n", ++ fmt->pix.width, fmt->pix.height); ++ ++ return 0; ++} ++ ++static int avr32_isi_streaming_set_format(struct atmel_isi *isi, ++ struct atmel_isi_format *fmt) ++{ ++ memcpy(&isi->streaming_format, &isi->format, ++ sizeof(struct atmel_isi_format)); ++#ifndef ISI_CODEC ++ fmt->pix.width = min(640U, prev_hsize); ++ fmt->pix.height = min(480U, prev_vsize); ++ fmt->pix.bytesperline = 0; ++ ++ /* Set format if we have specified one */ ++ if(streaming_v4l2_fmt){ ++ fmt->pix.pixelformat = streaming_v4l2_fmt; ++ } ++ else { ++ /* Preview path output format ++ * Would be logically V4L2_PIX_FMT_BGR555X ++ * but this format does not exist in the specification ++ * So for now we pretend V4L2_PIX_FMT_RGB555X ++ */ ++ fmt->pix.pixelformat = V4L2_PIX_FMT_RGB555X; ++ } ++ ++ /* The ISI module outputs either YUV 4:2:2 (codec path) ++ * or RGB 5:5:5 (preview path) (ISI grayscale mode is not ++ * supported yet. Therefore two pixels will be in a 32bit word ++ */ ++ fmt->pix.bytesperline = ALIGN(fmt->pix.width * 2, 4); ++ fmt->pix.sizeimage = fmt->pix.bytesperline * fmt->pix.height; ++ ++ /* These values depend on the sensor output image size */ ++ isi_writel(isi, PDECF, prev_decimation_factor);/* 1/16 * 16 = 1*/ ++ isi_writel(isi,PSIZE , ISI_BF(PREV_HSIZE,prev_hsize - 1) ++ | ISI_BF(PREV_VSIZE, prev_vsize - 1)); ++ ++ pr_debug("set_format: cr1=0x%08x cr2=0x%08x\n", ++ isi_readl(isi, CR1), isi_readl(isi, CR2)); ++#else ++ avr32_isi_capture_set_format(isi, &isi->streaming_format); ++#endif ++ return 0; ++} ++ ++static int avr32_isi_start_capture(struct atmel_isi *isi) ++{ ++ u32 cr1; ++ int ret; ++ ++ spin_lock_irq(&isi->lock); ++ isi->state = STATE_IDLE; ++ isi_readl(isi, SR); /* clear any pending SOF interrupt */ ++ isi_writel(isi, IER, ISI_BIT(SOF)); ++ isi_writel(isi, CR1, isi_readl(isi, CR1) & ~ISI_BIT(DIS)); ++ spin_unlock_irq(&isi->lock); ++ ++ pr_debug("isi: waiting for SOF\n"); ++ ret = wait_event_interruptible(isi->capture_wq, ++ isi->state != STATE_IDLE); ++ if (ret) ++ return ret; ++ if (isi->state != STATE_CAPTURE_READY) ++ return -EIO; ++ ++ /* ++ * Do a codec request. Next SOF indicates start of capture, ++ * the one after that indicates end of capture. ++ */ ++ pr_debug("isi: starting capture\n"); ++ isi_writel(isi, CDBA, isi->capture_phys); ++ ++ spin_lock_irq(&isi->lock); ++ isi->state = STATE_CAPTURE_WAIT_SOF; ++ cr1 = isi_readl(isi, CR1); ++ cr1 |= ISI_BIT(CODEC_ON); ++ isi_writel(isi, CR1, cr1); ++ isi_writel(isi, IER, ISI_CAPTURE_MASK); ++ spin_unlock_irq(&isi->lock); ++ ++ return 0; ++} ++ ++static void avr32_isi_capture_done(struct atmel_isi *isi, ++ int state) ++{ ++ u32 cr1; ++ ++ cr1 = isi_readl(isi, CR1); ++ cr1 &= ~ISI_BIT(CODEC_ON); ++ isi_writel(isi, CR1, cr1); ++ ++ isi->state = state; ++ wake_up_interruptible(&isi->capture_wq); ++ isi_writel(isi, IDR, ISI_CAPTURE_MASK); ++} ++ ++static irqreturn_t avr32_isi_handle_streaming(struct atmel_isi *isi, ++ int sequence){ ++ ++ int reqnr; ++ ++ if(kfifo_get(isi->grabq, (unsigned char *) &reqnr, ++ sizeof(int)) != sizeof(int)){ ++ ++ /* as no new buffer is available we keep the ++ * current one ++ */ ++ pr_debug("isi: dropping frame\n"); ++#ifdef ISI_CODEC ++ isi_writel(isi, CDBA, ++ isi->current_buffer->fb_desc.fb_address); ++ ++ isi_writel(isi, CR1, ISI_BIT(CODEC_ON) | ++ isi_readl(isi, CR1)); ++#else ++ /* TEST this has to be tested if it messes up the ISI ++ * streaming process */ ++ isi_writel(isi, PPFBD, (unsigned long) ++ &isi->video_buffer[isi->current_buffer->index]); ++#endif ++ } ++ else{ ++ isi->current_buffer->status = FRAME_DONE; ++ isi->current_buffer->sequence = sequence; ++ ++ do_gettimeofday(&isi->current_buffer->timestamp); ++ ++ /*isi->current_buffer->bytes_used = ++ ISI_VIDEO_MAX_FRAME_SIZE; */ ++ ++ kfifo_put(isi->doneq, (unsigned char *) ++ &(isi->current_buffer->index), sizeof(int)); ++ ++ isi->current_buffer = &(isi->video_buffer[reqnr]); ++#ifdef ISI_CODEC ++ isi_writel(isi, CDBA, ++ isi->current_buffer->fb_desc.fb_address); ++ isi_writel(isi, CR1, ISI_BIT(CODEC_ON) | ++ isi_readl(isi, CR1)); ++#else ++ /*TODO check if fbd corresponds to frame buffer */ ++#endif ++ wake_up_interruptible(&isi->capture_wq); ++ } ++ return IRQ_HANDLED; ++} ++ ++/* FIXME move code from ISR here ++static irqreturn_t avr32_isi_handle_capturing(struct atmel_isi *isi){ ++ ++}*/ ++/* isi interrupt service routine */ ++static irqreturn_t isi_interrupt(int irq, void *dev_id) ++{ ++ struct atmel_isi *isi = dev_id; ++ u32 status, mask, pending; ++ irqreturn_t ret = IRQ_NONE; ++ static int sequence = 0; ++ ++ spin_lock(&isi->lock); ++ ++ status = isi_readl(isi, SR); ++ mask = isi_readl(isi, IMR); ++ pending = status & mask; ++ ++ pr_debug("isi: interrupt status %x pending %x\n", ++ status, pending); ++ if(isi->streaming){ ++ if(likely(pending & (ISI_BIT(FO_C_EMP) | ISI_BIT(FO_P_EMP)))){ ++ ++ sequence++; ++ ret = avr32_isi_handle_streaming(isi, sequence); ++ } ++ } ++ else{ ++ while (pending) { ++ if (pending & (ISI_BIT(FO_C_OVF) | ISI_BIT(FR_OVR))) { ++ avr32_isi_capture_done(isi, STATE_CAPTURE_ERROR); ++ pr_debug("%s: FIFO overrun (status=0x%x)\n", ++ isi->vdev.name, status); ++ } else if (pending & ISI_BIT(SOF)) { ++ switch (isi->state) { ++ case STATE_IDLE: ++ isi->state = STATE_CAPTURE_READY; ++ wake_up_interruptible(&isi->capture_wq); ++ break; ++ case STATE_CAPTURE_READY: ++ break; ++ case STATE_CAPTURE_WAIT_SOF: ++ isi->state = STATE_CAPTURE_IN_PROGRESS; ++ break; ++ /* ++ case STATE_CAPTURE_IN_PROGRESS: ++ avr32_isi_capture_done(isi, STATE_CAPTURE_DONE); ++ break; ++ */ ++ } ++ } ++ if (pending & ISI_BIT(FO_C_EMP)){ ++ if( isi->state == STATE_CAPTURE_IN_PROGRESS) ++ avr32_isi_capture_done(isi, STATE_CAPTURE_DONE); ++ } ++ ++ if (pending & ISI_BIT(SOFTRST)) { ++ complete(&isi->reset_complete); ++ isi_writel(isi, IDR, ISI_BIT(SOFTRST)); ++ } ++ ++ status = isi_readl(isi, SR); ++ mask = isi_readl(isi, IMR); ++ pending = status & mask; ++ ret = IRQ_HANDLED; ++ } ++ } ++ spin_unlock(&isi->lock); ++ ++ return ret; ++} ++ ++/* ------------------------------------------------------------------------ ++ * IOCTL videoc handling ++ * ----------------------------------------------------------------------*/ ++ ++/* --------Capture ioctls ------------------------------------------------*/ ++/* Device capabilities callback function. ++ */ ++static int avr32_isi_capture_querycap(struct file *file, void *priv, ++ struct v4l2_capability *cap) ++{ ++ strcpy(cap->driver, "atmel-isi"); ++ strcpy(cap->card, "Atmel Image Sensor Interface"); ++ cap->version = ATMEL_ISI_VERSION; ++ /* V4L2_CAP_VIDEO_CAPTURE -> This is a capture device ++ * V4L2_CAP_READWRITE -> read/write interface used ++ */ ++ cap->capabilities = (V4L2_CAP_VIDEO_CAPTURE ++ | V4L2_CAP_READWRITE ++ ); ++ return 0; ++} ++ ++/* Input enumeration callback function. ++ * Enumerates available input devices. ++ * This can be called many times from the V4L2-layer by ++ * incrementing the index to get all avaliable input devices. ++ */ ++static int avr32_isi_capture_enum_input(struct file *file, void *priv, ++ struct v4l2_input *input) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /* Just one input (ISI) is available */ ++ if (input->index != 0) ++ return -EINVAL; ++ ++ /* Set input name as camera name */ ++ strlcpy(input->name, isi->camera->name, sizeof(input->name)); ++ input->type = V4L2_INPUT_TYPE_CAMERA; ++ ++ /* Set to this value just because this should be set to a ++ * defined value ++ */ ++ input->std = V4L2_STD_PAL; ++ ++ return 0; ++} ++/* Selects an input device. ++ * One input device (ISI) currently supported. ++ */ ++static int avr32_isi_capture_s_input(struct file *file, void *priv, ++ unsigned int index) ++{ ++ if (index != 0) ++ return -EINVAL; ++ return 0; ++} ++ ++/* Gets current input device. ++ */ ++static int avr32_isi_capture_g_input(struct file *file, void *priv, ++ unsigned int *index) ++{ ++ *index = 0; ++ return 0; ++} ++ ++/* Format callback function ++ * Returns a v4l2_fmtdesc structure with according values to a ++ * index. ++ * This function is called from user space until it returns ++ * -EINVAL. ++ */ ++static int avr32_isi_capture_enum_fmt_cap(struct file *file, void *priv, ++ struct v4l2_fmtdesc *fmt) ++{ ++ if (fmt->index != 0) ++ return -EINVAL; ++ ++ /* if we want to pretend another ISI output ++ * this is usefull if we input an other input format from a camera ++ * than specified in the ISI -> makes it possible to swap bytes ++ * in the ISI output format but messes up the preview path output ++ */ ++ if(capture_v4l2_fmt){ ++ fmt->pixelformat = capture_v4l2_fmt; ++ } ++ else { ++ /* This is the format the ISI tries to output */ ++ strcpy(fmt->description, "YCbYCr (YUYV) 4:2:2"); ++ fmt->pixelformat = V4L2_PIX_FMT_YUYV; ++ } ++ ++ return 0; ++} ++ ++static int avr32_isi_capture_try_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /* Just return the current format for now */ ++ memcpy(&vfmt->fmt.pix, &isi->format.pix, ++ sizeof(struct v4l2_pix_format)); ++ ++ return 0; ++} ++ ++/* Gets current hardware configuration ++ * For capture devices the pixel format settings are ++ * important. ++ */ ++static int avr32_isi_capture_g_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /* Return current pixel format */ ++ memcpy(&vfmt->fmt.pix, &isi->format.pix, ++ sizeof(struct v4l2_pix_format)); ++ ++ return 0; ++} ++ ++static int avr32_isi_capture_s_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ int ret = 0; ++ ++ /* We have a fixed format so just copy the current format ++ * back ++ */ ++ memcpy(&vfmt->fmt.pix, &isi->format.pix, ++ sizeof(struct v4l2_pix_format)); ++ ++ return ret; ++} ++ ++/* ------------ Preview path ioctls ------------------------------*/ ++/* Device capabilities callback function. ++ */ ++static int avr32_isi_querycap(struct file *file, void *priv, ++ struct v4l2_capability *cap) ++{ ++ strcpy(cap->driver, "atmel-isi"); ++ strcpy(cap->card, "Atmel Image Sensor Interface"); ++ cap->version = ATMEL_ISI_VERSION; ++ /* V4L2_CAP_VIDEO_CAPTURE -> This is a capture device ++ * V4L2_CAP_READWRITE -> read/write interface used ++ * V4L2_CAP_STREAMING -> ioctl + mmap interface used ++ */ ++ cap->capabilities = (V4L2_CAP_VIDEO_CAPTURE ++ | V4L2_CAP_READWRITE ++ | V4L2_CAP_STREAMING ++ ); ++ return 0; ++} ++ ++/* Input enumeration callback function. ++ * Enumerates available input devices. ++ * This can be called many times from the V4L2-layer by ++ * incrementing the index to get all avaliable input devices. ++ */ ++static int avr32_isi_enum_input(struct file *file, void *priv, ++ struct v4l2_input *input) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /* Just one input (ISI) is available */ ++ if (input->index != 0) ++ return -EINVAL; ++ ++ /* Set input name as camera name */ ++ strlcpy(input->name, isi->camera->name, sizeof(input->name)); ++ input->type = V4L2_INPUT_TYPE_CAMERA; ++ ++ /* Set to this value just because this should be set to a ++ * defined value ++ */ ++ input->std = V4L2_STD_PAL; ++ ++ return 0; ++} ++ ++/* Selects an input device. ++ * One input device (ISI) currently supported. ++ */ ++static int avr32_isi_s_input(struct file *file, void *priv, ++ unsigned int index) ++{ ++ if (index != 0) ++ return -EINVAL; ++ ++ return 0; ++} ++ ++/* Gets current input device. ++ */ ++static int avr32_isi_g_input(struct file *file, void *priv, ++ unsigned int *index) ++{ ++ *index = 0; ++ return 0; ++} ++ ++/* Format callback function ++ * Returns a v4l2_fmtdesc structure with according values to a ++ * index. ++ * This function is called from user space until it returns ++ * -EINVAL. ++ */ ++static int avr32_isi_enum_fmt_cap(struct file *file, void *priv, ++ struct v4l2_fmtdesc *fmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ if (fmt->index != 0) ++ return -EINVAL; ++ ++ /* TODO: Return all possible formats ++ * This depends on ISI and camera. ++ * A enum_fmt function or a data structure should be ++ * added to the camera driver. ++ * For now just one format supported ++ */ ++ if(streaming_v4l2_fmt){ ++ strcpy(fmt->description, "Pretended format"); ++ } ++ else{ ++ strcpy(fmt->description, "Normal format"); ++ } ++ fmt->pixelformat = isi->streaming_format.pix.pixelformat;//V4L2_PIX_FMT_UYVY; ++ ++ return 0; ++} ++ ++static int avr32_isi_try_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /* FIXME For now we just return the current format*/ ++ memcpy(&vfmt->fmt.pix, &isi->streaming_format.pix, ++ sizeof(struct v4l2_pix_format)); ++ return 0; ++} ++ ++/* Gets current hardware configuration ++ * For capture devices the pixel format settings are ++ * important. ++ */ ++static int avr32_isi_g_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ ++ /*Copy current pixel format structure to user space*/ ++ memcpy(&vfmt->fmt.pix, &isi->streaming_format.pix, ++ sizeof(struct v4l2_pix_format)); ++ ++ return 0; ++} ++ ++static int avr32_isi_s_fmt_cap(struct file *file, void *priv, ++ struct v4l2_format *vfmt) ++{ ++ struct atmel_isi_fh *fh = priv; ++ struct atmel_isi *isi = fh->isi; ++ int ret = 0; ++ ++ /* Just return the current format as we do not support ++ * format switching */ ++ memcpy(&vfmt->fmt.pix, &isi->streaming_format.pix, ++ sizeof(struct v4l2_pix_format)); ++ ++ return ret; ++} ++ ++/* Checks if control is supported in driver ++ * No controls currently supported yet ++ */ ++static int avr32_isi_queryctrl(struct file *file, void *priv, ++ struct v4l2_queryctrl *qc) ++{ ++ switch(qc->id){ ++ case V4L2_CID_BRIGHTNESS: ++ strcpy(qc->name, "Brightness"); ++ qc->minimum = 0; ++ qc->maximum = 100; ++ qc->step = 1; ++ qc->default_value = 50; ++ qc->flags = 0; ++ break; ++ default: ++ return -EINVAL; ++ } ++ return 0; ++} ++ ++static int avr32_isi_g_ctrl(struct file *file, void *priv, ++ struct v4l2_control *ctrl) ++{ ++ switch(ctrl->id){ ++ case V4L2_CID_BRIGHTNESS: ++ ctrl->value = 0; ++ break; ++ default: ++ return -EINVAL; ++ } ++ return 0; ++} ++ ++static int avr32_isi_s_ctrl(struct file *file, void *priv, ++ struct v4l2_control *ctrl) ++{ ++ switch(ctrl->id){ ++ case V4L2_CID_BRIGHTNESS: ++ break; ++ default: ++ return -EINVAL; ++ } ++ return 0; ++} ++ ++static int avr32_isi_reqbufs(struct file *file, void *private_data, ++ struct v4l2_requestbuffers *req) ++{ ++ /* Only memory mapped buffers supported*/ ++ if(req->memory != V4L2_MEMORY_MMAP){ ++ pr_debug("atmel_isi: buffer format not supported\n"); ++ return -EINVAL; ++ } ++ pr_debug("atmel_isi: Requested %d buffers. Using %d buffers\n", ++ req->count, video_buffers); ++ /* buffer number is fixed for now as it is difficult to get ++ * that memory at runtime */ ++ req->count = video_buffers; ++ memset(&req->reserved, 0, sizeof(req->reserved)); ++ return 0; ++} ++ ++static int avr32_isi_querybuf(struct file *file, void *private_data, ++ struct v4l2_buffer *buf) ++{ ++ struct atmel_isi_fh *fh = private_data; ++ struct atmel_isi *isi = fh->isi; ++ struct frame_buffer *buffer; ++ ++ if(unlikely(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)) ++ return -EINVAL; ++ if(unlikely(buf->index >= video_buffers)) ++ return -EINVAL; ++ ++ buffer = &(isi->video_buffer[buf->index]); ++ ++ buf->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; ++ buf->length = video_buffer_size; ++ buf->memory = V4L2_MEMORY_MMAP; ++ ++ /* set index as mmap reference to the buffer */ ++ buf->m.offset = buf->index << PAGE_SHIFT; ++ ++ switch(buffer->status){ ++ case FRAME_UNUSED: ++ case FRAME_ERROR: ++ case FRAME_QUEUED: ++ buf->flags |= V4L2_BUF_FLAG_QUEUED; ++ buf->bytesused = buffer->bytes_used; ++ break; ++ case FRAME_DONE: ++ buf->flags |= V4L2_BUF_FLAG_DONE; ++ buf->bytesused = buffer->bytes_used; ++ buf->sequence = buffer->sequence; ++ buf->timestamp = buffer->timestamp; ++ break; ++ } ++ ++ buf->field = V4L2_FIELD_NONE; /* no interlacing stuff */ ++ ++ if(buffer->mmap_count) ++ buf->flags |= V4L2_BUF_FLAG_MAPPED; ++ else ++ buf->flags &= ~V4L2_BUF_FLAG_MAPPED; ++ ++ pr_debug("atmel_isi: querybuf index:%d offset:%d\n", ++ buf->index, buf->m.offset); ++ ++ return 0; ++} ++ ++static int avr32_isi_qbuf(struct file *file, void *private_data, ++ struct v4l2_buffer *buf) ++{ ++ struct atmel_isi_fh *fh = private_data; ++ struct atmel_isi *isi = fh->isi; ++ struct frame_buffer *buffer; ++ ++ if(unlikely(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)) ++ return -EINVAL; ++ if(unlikely(buf->index >= video_buffers || buf->index < 0)) ++ return -EINVAL; ++ if(unlikely(buf->memory != V4L2_MEMORY_MMAP)) ++ return -EINVAL; ++ ++ buffer = &(isi->video_buffer[buf->index]); ++ if(unlikely(buffer->status != FRAME_UNUSED)) ++ return -EINVAL; ++ ++ mutex_lock(&isi->mutex); ++ buf->flags |= V4L2_BUF_FLAG_QUEUED; ++ buf->flags &= ~V4L2_BUF_FLAG_DONE; ++ buffer->status = FRAME_QUEUED; ++ kfifo_put(isi->grabq, (unsigned char*) &buf->index, sizeof(int)); ++ mutex_unlock(&isi->mutex); ++ ++ return 0; ++} ++ ++static int avr32_isi_dqbuf(struct file *file, void *private_data, ++ struct v4l2_buffer *buf) ++{ ++ struct atmel_isi_fh *fh = private_data; ++ struct atmel_isi *isi = fh->isi; ++ struct frame_buffer *buffer; ++ int reqnr = 0; ++ ++ if(unlikely(buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)) ++ return -EINVAL; ++ /* Mencoder does not set this flag ++ * ++ if(unlikely(buf->memory != V4L2_MEMORY_MMAP)){ ++ pr_debug("isi: dequeue failed buffer not of mmapped type\n"); ++ return -EINVAL; ++ }*/ ++ if((kfifo_len(isi->doneq) == 0) && (file->f_flags & O_NONBLOCK)){ ++ pr_debug("Done-queue is empty\n"); ++ return -EAGAIN; ++ } ++ /* ++ if(wait_event_interruptible(isi->capture_wq, ++ kfifo_len(isi->doneq) != 0) < 0){ ++ pr_debug("Done-queue interrupted\n"); ++ return -EINTR; ++ } ++ */ ++ if(!kfifo_get(isi->doneq, (unsigned char*) &reqnr, sizeof(int))){ ++ return -EBUSY; ++ } ++ buffer = &(isi->video_buffer[reqnr]); ++ ++ if(unlikely(buffer->status != FRAME_DONE)){ ++ pr_debug("isi: error, dequeued buffer not ready\n"); ++ return -EINVAL; ++ } ++ buf->index = reqnr; ++ buf->bytesused = buffer->bytes_used; ++ buf->timestamp = buffer->timestamp; ++ buf->sequence = buffer->sequence; ++ buf->m.offset = reqnr << PAGE_SHIFT; ++ buffer->status = FRAME_UNUSED; ++ buf->flags = V4L2_BUF_FLAG_MAPPED | V4L2_BUF_FLAG_DONE; ++ ++ buf->length = isi->capture_buffer_size; ++ buf->field = V4L2_FIELD_NONE; ++ buf->memory = V4L2_MEMORY_MMAP; ++ return 0; ++} ++ ++static int avr32_isi_streamon(struct file *file, void *private_data, ++ enum v4l2_buf_type type) ++{ ++ struct atmel_isi_fh *fh = private_data; ++ struct atmel_isi *isi = fh->isi; ++ int reqnr; ++ struct frame_buffer *buffer; ++ u32 cr1; ++ ++ if(unlikely(type != V4L2_BUF_TYPE_VIDEO_CAPTURE)) ++ return -EINVAL; ++ ++ if(!kfifo_get(isi->grabq, (unsigned char*) &reqnr, sizeof(int))){ ++ mutex_unlock(&isi->mutex); ++ pr_debug("atmel_isi: No buffer in IN-Queue, start of streaming\ ++ aborted (one buffer is required in IN-Queue)\n"); ++ return -EINVAL; ++ } ++ buffer = &(isi->video_buffer[reqnr]); ++ ++ ++ spin_lock_irq(isi->lock); ++ isi->streaming = 1; ++ isi->current_buffer = buffer; ++ cr1 = isi_readl(isi, CR1); ++#ifdef ISI_CODEC ++ isi_writel(isi, CDBA, buffer->fb_desc.fb_address); ++ /* Enable codec path */ ++ cr1 |= ISI_BIT(CODEC_ON) | ISI_BIT(DIS); ++#else ++ isi_writel(isi, PPFBD, isi->fbd_list_start); ++#endif ++ /* Enable interrupts */ ++ isi_readl(isi, SR); ++ /* FIXME enable codec/preview path according to setup */ ++ isi_writel(isi, IER, ISI_BIT(FO_C_EMP) | ISI_BIT(FO_P_EMP)); ++ ++ cr1 |= ISI_BF(FRATE, frame_rate_scaler); ++ ++ /* Enable ISI module*/ ++ cr1 &= ~ISI_BIT(DIS); ++ isi_writel(isi, CR1, cr1); ++ spin_unlock_irq(isi->lock); ++ ++ isi->camera->start_capture(isi->camera); ++ ++ return 0; ++} ++ ++static int avr32_isi_streamoff(struct file *file, void *private_data, ++ enum v4l2_buf_type type) ++{ ++ struct atmel_isi_fh *fh = private_data; ++ struct atmel_isi *isi = fh->isi; ++ ++ if(unlikely(type != V4L2_BUF_TYPE_VIDEO_CAPTURE)) ++ return -EINVAL; ++ ++ spin_lock_irq(isi->lock); ++ isi->streaming = 0; ++#ifdef ISI_CODEC ++ /* Disble codec path */ ++ isi_writel(isi, CR1, isi_readl(isi, CR1) & (~ISI_BIT(CODEC_ON))); ++#endif ++ /* Disable interrupts */ ++ isi_writel(isi, IDR, ISI_BIT(FO_C_EMP) | ISI_BIT(FO_P_EMP)); ++ ++ /* Disable ISI module*/ ++ isi_writel(isi, CR1, isi_readl(isi, CR1) | ISI_BIT(DIS)); ++ spin_unlock_irq(isi->lock); ++ ++ isi->camera->stop_capture(isi->camera); ++ pr_debug("atmel_isi: Stream off\n"); ++ ++ return 0; ++} ++ ++/*----------------------------------------------------------------------------*/ ++static int avr32_isi_capture_close (struct inode *inode, struct file *file) ++{ ++ struct atmel_isi_fh *fh = file->private_data; ++ struct atmel_isi *isi = fh->isi; ++ u32 cr1; ++ ++ mutex_lock(&isi->mutex); ++ ++ isi->capture_users--; ++ kfree(fh); ++ ++ /* Stop camera and ISI if driver has no users */ ++ if(!isi->stream_users) { ++ isi->camera->stop_capture(isi->camera); ++ ++ spin_lock_irq(&isi->lock); ++ cr1 = isi_readl(isi, CR1); ++ cr1 |= ISI_BIT(DIS); ++ isi_writel(isi, CR1, cr1); ++ spin_unlock_irq(&isi->lock); ++ } ++ mutex_unlock(&isi->mutex); ++ ++ return 0; ++} ++ ++static int avr32_isi_capture_open (struct inode *inode, struct file *file) ++{ ++ struct video_device *vdev = video_devdata(file); ++ struct atmel_isi *isi = to_atmel_isi(vdev); ++ struct atmel_isi_fh *fh; ++ int ret = -EBUSY; ++ unsigned long timeout; ++ ++ mutex_lock(&isi->mutex); ++ ++ ++ if (isi->capture_users) { ++ pr_debug("%s: open(): device busy\n", vdev->name); ++ goto out; ++ } ++ ++ if (!isi->camera) { ++ ++ ret = -ENODEV; ++ isi->camera = avr32_isi_grab_camera(isi); ++ if (!isi->camera) ++ goto out; ++ ++ ret = avr32_isi_set_camera_input(isi); ++ if(ret) ++ goto out; ++ } ++ ++ avr32_isi_capture_set_format(isi, &isi->format); ++ ++ /* ++ * Reset the controller and wait for completion. The ++ * reset will only succeed if we have a pixel clock ++ * from the camera. ++ */ ++ if(isi->stream_users == 0){ ++ ++ init_completion(&isi->reset_complete); ++ isi_writel(isi, IER, ISI_BIT(SOFTRST)); ++ isi_writel(isi, CR1, ISI_BIT(RST)); ++ ++ timeout = wait_for_completion_timeout(&isi->reset_complete, ++ msecs_to_jiffies(100)); ++ ++ isi_writel(isi, IDR, ~0UL); ++ if (timeout == 0) { ++ ret = -ETIMEDOUT; ++ goto out; ++ } ++ } ++ ++ ret = -ENOMEM; ++ fh = kzalloc(sizeof(struct atmel_isi_fh), GFP_KERNEL); ++ if (!fh) { ++ pr_debug("%s: open(): out of memory\n", vdev->name); ++ goto out; ++ } ++ ++ fh->isi = isi; ++ file->private_data = fh; ++ isi->capture_users++; ++ ++ ret = 0; ++ ++out: ++ mutex_unlock(&isi->mutex); ++ return ret; ++} ++ ++static ssize_t avr32_isi_capture_read(struct file *file, char __user *data, ++ size_t count, loff_t *ppos) ++{ ++ struct atmel_isi_fh *fh = file->private_data; ++ struct atmel_isi *isi = fh->isi; ++ int state; ++ int ret; ++ ++ state = STATE_IDLE; ++ ++ pr_debug("isi: read %zu bytes read_off=%u state=%u sizeimage=%u\n", ++ count, fh->read_off, state, isi->format.pix.sizeimage); ++ isi->camera->start_capture(isi->camera); ++ ++ ++ avr32_isi_start_capture(isi); ++ ++ ret = wait_event_interruptible( isi->capture_wq, ++ (isi->state == STATE_CAPTURE_DONE) ++ || (isi->state == STATE_CAPTURE_ERROR)); ++ if (ret) ++ return ret; ++ if (isi->state == STATE_CAPTURE_ERROR) { ++ isi->state = STATE_IDLE; ++ return -EIO; ++ } ++ ++ fh->read_off = 0; ++ ++ count = min(count, (size_t)isi->format.pix.sizeimage - fh->read_off); ++ ret = copy_to_user(data, isi->capture_buf + fh->read_off, count); ++ if (ret) ++ return -EFAULT; ++ ++ fh->read_off += count; ++ if (fh->read_off >= isi->format.pix.sizeimage) ++ isi->state = STATE_IDLE; ++ ++ return count; ++} ++ ++static void avr32_isi_capture_release (struct video_device *vdev) ++{ ++ pr_debug("%s: release\n", vdev->name); ++} ++ ++/* ----------------- Streaming interface -------------------------------------*/ ++static void avr32_isi_vm_open(struct vm_area_struct *vma){ ++ struct frame_buffer *buffer = ++ (struct frame_buffer *) vma->vm_private_data; ++ buffer->mmap_count++; ++ pr_debug("atmel_isi: vm_open count=%d\n",buffer->mmap_count); ++} ++ ++static void avr32_isi_vm_close(struct vm_area_struct *vma){ ++ struct frame_buffer *buffer = ++ (struct frame_buffer *) vma->vm_private_data; ++ pr_debug("atmel_isi: vm_close count=%d\n",buffer->mmap_count); ++ buffer->mmap_count--; ++ if(buffer->mmap_count < 0) ++ printk("atmel_isi: mmap_count went negative\n"); ++} ++ ++/* FIXME remove this function ++struct page *avr32_isi_vm_nopage( struct vm_area_struct *vma, ++ unsigned long address, int *type ) ++{ ++ return NOPAGE_SIGBUS; ++} ++*/ ++ ++static struct vm_operations_struct avr32_isi_vm_ops = { ++ .open = avr32_isi_vm_open, ++ .close = avr32_isi_vm_close, ++ //.nopage = avr32_isi_vm_nopage, ++}; ++ ++static int avr32_isi_mmap(struct file *file, struct vm_area_struct *vma) ++{ ++ unsigned long pfn; ++ int ret; ++ struct atmel_isi_fh *fh = file->private_data; ++ struct atmel_isi * isi = fh->isi; ++ struct frame_buffer *buffer = &(isi->video_buffer[vma->vm_pgoff]); ++ unsigned long size = vma->vm_end - vma->vm_start; ++ ++ pr_debug("atmel_isi: mmap called pgoff=%ld size=%ld \n", ++ vma->vm_pgoff, size); ++ ++ if(size > video_buffer_size){ ++ pr_debug("atmel_isi: mmap requested buffer is to large\n"); ++ return -EINVAL; ++ } ++ if(vma->vm_pgoff > video_buffers){ ++ pr_debug("atmel_isi: invalid mmap page offset\n"); ++ return -EINVAL; ++ } ++ pfn = isi->video_buffer[vma->vm_pgoff].fb_desc.fb_address >> PAGE_SHIFT; ++ ++ ret = remap_pfn_range(vma, vma->vm_start, pfn, ++ vma->vm_end - vma->vm_start, vma->vm_page_prot); ++ if(ret){ ++ return ret; ++ } ++ ++ vma->vm_ops = &avr32_isi_vm_ops; ++ vma->vm_flags = VM_DONTEXPAND; /* fixed size */ ++ vma->vm_flags |= VM_RESERVED;/* do not swap out */ ++ vma->vm_flags |= VM_DONTCOPY; ++ vma->vm_flags |= VM_SHARED; ++ vma->vm_private_data = (void *) buffer; ++ avr32_isi_vm_open(vma); ++ ++ pr_debug("atmel_isi: vma start=0x%08lx, size=%ld phys=%ld \n", ++ (unsigned long) vma->vm_start, ++ (unsigned long) vma->vm_end - (unsigned long) vma->vm_start, ++ pfn << PAGE_SHIFT); ++ return 0; ++} ++ ++static unsigned int avr32_isi_poll(struct file *file, poll_table *wait) ++{ ++ struct atmel_isi_fh *fh = file->private_data; ++ struct atmel_isi *isi = fh->isi; ++ unsigned int ret = 0; ++ ++ mutex_lock(&isi->mutex); ++ poll_wait(file, &isi->capture_wq, wait); ++ if(kfifo_len(isi->doneq)) ++ ret = POLLIN | POLLRDNORM; ++ mutex_unlock(&isi->mutex); ++ ++ return ret; ++} ++ ++static int avr32_isi_stream_close (struct inode *inode, struct file *file) ++{ ++ struct atmel_isi_fh *fh = file->private_data; ++ struct atmel_isi *isi = fh->isi; ++ u32 cr1; ++ ++ mutex_lock(&isi->mutex); ++ ++ isi->stream_users--; ++ kfree(fh); ++ ++ /* Stop camera and ISI if driver has no users */ ++ if(!isi->capture_users) { ++ isi->camera->stop_capture(isi->camera); ++ ++ spin_lock_irq(&isi->lock); ++ cr1 = isi_readl(isi, CR1); ++ cr1 |= ISI_BIT(DIS); ++ isi_writel(isi, CR1, cr1); ++ spin_unlock_irq(&isi->lock); ++ } ++ ++ mutex_unlock(&isi->mutex); ++ ++ return 0; ++} ++ ++static int avr32_isi_stream_open (struct inode *inode, struct file *file) ++{ ++ struct video_device *vdev = video_devdata(file); ++ struct atmel_isi *isi = to_atmel_isi(vdev); ++ struct atmel_isi_fh *fh; ++ int ret = -EBUSY; ++ unsigned long timeout; ++ ++ mutex_lock(&isi->mutex); ++ ++ ++ if (isi->stream_users) { ++ pr_debug("%s: open(): device busy\n", vdev->name); ++ goto out; ++ } ++ ++ if (!isi->camera) { ++ ret = -ENODEV; ++ isi->camera = avr32_isi_grab_camera(isi); ++ if (!isi->camera) ++ goto out; ++ ret = -EINVAL; ++ ret = avr32_isi_set_camera_input(isi); ++ if(ret) ++ goto out; ++ } ++ avr32_isi_streaming_set_format(isi, &isi->format); ++ kfifo_reset(isi->grabq); ++ kfifo_reset(isi->doneq); ++ ++ /* ++ * Reset the controller and wait for completion. The ++ * reset will only succeed if we have a pixel clock ++ * from the camera. ++ */ ++ if(isi->stream_users == 0){ ++ ++ init_completion(&isi->reset_complete); ++ isi_writel(isi, IER, ISI_BIT(SOFTRST)); ++ isi_writel(isi, CR1, ISI_BIT(RST)); ++ ++ timeout = wait_for_completion_timeout(&isi->reset_complete, ++ msecs_to_jiffies(100)); ++ ++ if (timeout == 0) { ++ ret = -ETIMEDOUT; ++ goto out; ++ } ++ isi_writel(isi, IDR, ~0UL); ++ } ++ ++ ret = -ENOMEM; ++ fh = kzalloc(sizeof(struct atmel_isi_fh), GFP_KERNEL); ++ if (!fh) { ++ pr_debug("%s: open(): out of memory\n", vdev->name); ++ goto out; ++ } ++ ++ fh->isi = isi; ++ file->private_data = fh; ++ isi->stream_users++; ++ ++ ret = 0; ++ ++out: ++ mutex_unlock(&isi->mutex); ++ return ret; ++} ++ ++static void avr32_isi_stream_release (struct video_device *vdev) ++{ ++ struct atmel_isi *isi = to_atmel_isi(vdev); ++ pr_debug("%s: release\n", vdev->name); ++ kfree(isi); ++} ++ ++/* -----------------------------------------------------------------------*/ ++ ++/* Streaming v4l2 device file operations */ ++static struct file_operations avr32_isi_streaming_fops = { ++ .owner = THIS_MODULE, ++ .ioctl = video_ioctl2, ++ .open = avr32_isi_stream_open, ++ .release = avr32_isi_stream_close, ++ .mmap = avr32_isi_mmap, ++ .poll = avr32_isi_poll, ++}; ++ ++/* Capture v4l2 device file operations */ ++static struct file_operations avr32_isi_capture_fops = { ++ .owner = THIS_MODULE, ++ .open = avr32_isi_capture_open, ++ .release = avr32_isi_capture_close, ++ .read = avr32_isi_capture_read, ++ .ioctl = video_ioctl2, ++}; ++ ++static int __exit avr32_isi_remove(struct platform_device *pdev) ++{ ++ struct atmel_isi *isi = platform_get_drvdata(pdev); ++ int i; ++ ++ if (isi->camera) ++ isi->camera->stop_capture(isi->camera); ++ ++ if (isi->camera) ++ avr32_isi_release_camera(isi, isi->camera); ++ video_unregister_device(&isi->cdev); ++ video_unregister_device(&isi->vdev); ++ ++ platform_set_drvdata(pdev, NULL); ++ ++ /* release capture buffer */ ++ dma_free_coherent(&pdev->dev, capture_buffer_size, ++ isi->capture_buf, isi->capture_phys); ++ ++ /* release frame buffers */ ++ for(i = 0; i < video_buffers; i++){ ++ dma_free_coherent(&pdev->dev, ++ video_buffer_size, ++ isi->video_buffer[i].frame_buffer, ++ isi->video_buffer[i].fb_desc.fb_address); ++ } ++ ++ kfifo_free(isi->doneq); ++ kfifo_free(isi->grabq); ++ ++ free_irq(isi->irq, isi); ++ iounmap(isi->regs); ++ clk_disable(isi->hclk); ++ clk_disable(isi->pclk); ++ clk_put(isi->hclk); ++ clk_put(isi->pclk); ++ ++ /* ++ * Don't free isi here -- it will be taken care of by the ++ * release() callback. ++ */ ++ ++ return 0; ++} ++ ++ ++static int __init avr32_isi_probe(struct platform_device *pdev) ++{ ++ unsigned int irq; ++ struct atmel_isi *isi; ++ struct clk *pclk, *hclk; ++ struct resource *regs; ++ int ret; ++ int i; ++ int video_bytes_used = video_buffer_size; ++ ++ regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); ++ if(!regs) ++ return -ENXIO; ++ ++ pclk = clk_get(&pdev->dev, "pclk"); ++ if (IS_ERR(pclk)) ++ return PTR_ERR(pclk); ++ hclk = clk_get(&pdev->dev, "hclk"); ++ if (IS_ERR(hclk)) { ++ ret = PTR_ERR(hclk); ++ goto err_hclk; ++ } ++ clk_enable(pclk); ++ clk_enable(hclk); ++ ++ isi = kzalloc(sizeof(struct atmel_isi), GFP_KERNEL); ++ if(!isi){ ++ ret = -ENOMEM; ++ dev_err(&pdev->dev, "can't allocate interface!\n"); ++ goto err_alloc_isi; ++ } ++ ++ isi->pclk = pclk; ++ isi->hclk = hclk; ++ ++ /* Round up buffer sizes to the next page if needed */ ++ video_buffer_size = PAGE_ALIGN(video_buffer_size); ++ capture_buffer_size = PAGE_ALIGN(capture_buffer_size); ++ ++ spin_lock_init(&isi->lock); ++ mutex_init(&isi->mutex); ++ init_waitqueue_head(&isi->capture_wq); ++ ++ /* Initialize v4l2 capture device */ ++ isi->cdev.fops = &avr32_isi_capture_fops; ++ strcpy(isi->cdev.name, "atmel_isi_capture"); ++ isi->cdev.type = VFL_TYPE_GRABBER; ++ isi->cdev.type2 = VID_TYPE_CAPTURE; ++ isi->cdev.minor = -1; ++ isi->cdev.release =avr32_isi_capture_release; ++ isi->cdev.vidioc_querycap = avr32_isi_capture_querycap; ++ isi->cdev.vidioc_enum_fmt_cap = avr32_isi_capture_enum_fmt_cap; ++ isi->cdev.vidioc_try_fmt_cap = avr32_isi_capture_try_fmt_cap; ++ isi->cdev.vidioc_g_fmt_cap = avr32_isi_capture_g_fmt_cap; ++ isi->cdev.vidioc_s_fmt_cap = avr32_isi_capture_s_fmt_cap; ++ isi->cdev.vidioc_enum_input = avr32_isi_capture_enum_input; ++ isi->cdev.vidioc_g_input = avr32_isi_capture_g_input; ++ isi->cdev.vidioc_s_input = avr32_isi_capture_s_input; ++#ifdef DEBUG ++ isi->cdev.debug = V4L2_DEBUG_IOCTL | V4L2_DEBUG_IOCTL_ARG; ++#endif ++ ++ /* Initialize v4l2 streaming device */ ++ isi->vdev.fops = &avr32_isi_streaming_fops; ++ strcpy(isi->vdev.name, "atmel-isi"); ++ isi->vdev.type = VFL_TYPE_GRABBER; ++ isi->vdev.type2 = VID_TYPE_CAPTURE; ++ isi->vdev.minor = -1; ++ isi->vdev.release = avr32_isi_stream_release; ++#ifdef DEBUG ++ isi->vdev.debug = V4L2_DEBUG_IOCTL | V4L2_DEBUG_IOCTL_ARG; ++#endif ++ ++ isi->vdev.vidioc_querycap = avr32_isi_querycap; ++ isi->vdev.vidioc_enum_fmt_cap = avr32_isi_enum_fmt_cap; ++ isi->vdev.vidioc_try_fmt_cap = avr32_isi_try_fmt_cap; ++ isi->vdev.vidioc_g_fmt_cap = avr32_isi_g_fmt_cap; ++ isi->vdev.vidioc_s_fmt_cap = avr32_isi_s_fmt_cap; ++ isi->vdev.vidioc_enum_input = avr32_isi_enum_input; ++ isi->vdev.vidioc_g_input = avr32_isi_g_input; ++ isi->vdev.vidioc_s_input = avr32_isi_s_input; ++ isi->vdev.vidioc_queryctrl = avr32_isi_queryctrl; ++ isi->vdev.vidioc_g_ctrl = avr32_isi_g_ctrl; ++ isi->vdev.vidioc_s_ctrl = avr32_isi_s_ctrl; ++ isi->vdev.vidioc_querybuf = avr32_isi_querybuf; ++ isi->vdev.vidioc_reqbufs = avr32_isi_reqbufs; ++ isi->vdev.vidioc_qbuf = avr32_isi_qbuf; ++ isi->vdev.vidioc_dqbuf = avr32_isi_dqbuf; ++ isi->vdev.vidioc_streamon = avr32_isi_streamon; ++ isi->vdev.vidioc_streamoff = avr32_isi_streamoff; ++ ++ isi->regs = ioremap(regs->start, regs->end - regs->start + 1); ++ if (!isi->regs) { ++ ret = -ENOMEM; ++ goto err_ioremap; ++ } ++ ++ irq = platform_get_irq(pdev,0); ++ ret = request_irq(irq, isi_interrupt, 0, "isi", isi); ++ if (ret) { ++ dev_err(&pdev->dev, "unable to request irq %d\n", irq); ++ goto err_req_irq; ++ } ++ isi->irq = irq; ++ ++ /* Allocate ISI capture buffer */ ++ isi->capture_buf = dma_alloc_coherent(&pdev->dev, ++ capture_buffer_size, ++ &isi->capture_phys, ++ GFP_KERNEL); ++ if (!isi->capture_buf) { ++ ret = -ENOMEM; ++ dev_err(&pdev->dev, "failed to allocate capture buffer\n"); ++ goto err_alloc_cbuf; ++ } ++ ++ /* Allocate and initialize video buffers */ ++ for(i=0;i < video_buffers; i++){ ++ memset(&isi->video_buffer[i], 0, sizeof(struct frame_buffer)); ++ isi->video_buffer[i].frame_buffer = ++ dma_alloc_coherent(&pdev->dev, ++ video_buffer_size, ++ (dma_addr_t *) ++ &(isi->video_buffer[i].fb_desc.fb_address), ++ GFP_KERNEL); ++ if(!isi->video_buffer[i].frame_buffer){ ++ ret = -ENOMEM; ++ dev_err(&pdev->dev, ++ "failed to allocate video buffer\n"); ++ goto err_alloc_vbuf; ++ } ++ ++ isi->video_buffer[i].bytes_used = video_bytes_used; ++ isi->video_buffer[i].status = FRAME_UNUSED; ++ isi->video_buffer[i].index = i; ++ ++#ifdef DEBUG ++ /* Put some color into the buffers */ ++ /* ++ memset(isi->video_buffer[i].frame_buffer, (i*4)%0xFF, ++ video_buffer_size); ++ */ ++#endif ++ } ++ /* set up frame buffer descriptor list for ISI module*/ ++ /* FIXME ++ isi->fbd_list_start = dma_map_single(&pdev->dev, ++ &isi->video_buffer[0].fb_desc, ++ sizeof(struct fbd), ++ DMA_NONE); ++ */ ++ isi->fbd_list_start = __pa(&isi->video_buffer[0].fb_desc); ++ for(i=0; i < (video_buffers - 1); i++){ ++ isi->video_buffer[i].fb_desc.next_fbd_address = ++ /* ++ dma_map_single(&pdev->dev, ++ &isi->video_buffer[i+1].fb_desc, ++ sizeof(struct fbd), ++ DMA_NONE);*/ ++ __pa(&isi->video_buffer[i+1]); ++ } ++ /* FIXME ++ * isi->video_buffer[i].fb_desc.next_fbd_address = ++ * isi->fbd_list_start; ++ */ ++ isi->video_buffer[i].fb_desc.next_fbd_address = ++ __pa(&isi->video_buffer[0]); ++ ++#ifdef DEBUG ++ for(i=0;i < video_buffers; i++){ ++ pr_debug("atmel_isi: fbd at %08lx video buffer at \ ++phys addr %08lx \n", __pa(&isi->video_buffer[i]), ++ (unsigned long) isi->video_buffer[i].fb_desc.fb_address); ++ } ++#endif ++ dev_info(&pdev->dev, ++ "capture buffer: %d bytes at %p (phys 0x%08x)\n", ++ capture_buffer_size, isi->capture_buf, ++ isi->capture_phys); ++ ++ spin_lock_init(&isi->grabq_lock); ++ isi->grabq = kfifo_alloc(sizeof(int) * video_buffers, GFP_KERNEL, ++ &isi->grabq_lock); ++ if(IS_ERR(isi->grabq)){ ++ dev_err(&pdev->dev, "fifo allocation failed\n"); ++ goto err_fifo_alloc1; ++ } ++ spin_lock_init(&isi->doneq_lock); ++ isi->doneq = kfifo_alloc(sizeof(int) * video_buffers, GFP_KERNEL, ++ &isi->doneq_lock); ++ if(IS_ERR(isi->doneq)){ ++ dev_err(&pdev->dev, "fifo allocation failed\n"); ++ goto err_fifo_alloc2; ++ } ++ ++ isi_writel(isi, CR1, ISI_BIT(DIS)); ++ ++ ret = video_register_device(&isi->cdev, VFL_TYPE_GRABBER, -1); ++ if(ret) ++ goto err_register1; ++ ++ ret = video_register_device(&isi->vdev, VFL_TYPE_GRABBER, -1); ++ if (ret) ++ goto err_register2; ++ ++ platform_set_drvdata(pdev, isi); ++ ++ dev_info(&pdev->dev, "Atmel ISI V4L2 device at 0x%08lx\n", ++ (unsigned long)regs->start); ++ ++ return 0; ++ ++err_register2: ++ video_unregister_device(&isi->cdev); ++err_register1: ++ kfifo_free(isi->doneq); ++err_fifo_alloc2: ++ kfifo_free(isi->grabq); ++err_fifo_alloc1: ++err_alloc_vbuf: ++ while(i--) ++ dma_free_coherent(&pdev->dev, video_buffer_size, ++ isi->video_buffer[i].frame_buffer, ++ isi->video_buffer[i].fb_desc.fb_address); ++ dma_free_coherent(&pdev->dev, capture_buffer_size, ++ isi->capture_buf, ++ isi->capture_phys); ++err_alloc_cbuf: ++ free_irq(isi->irq, isi); ++err_req_irq: ++ iounmap(isi->regs); ++err_ioremap: ++ kfree(isi); ++err_alloc_isi: ++ clk_disable(hclk); ++ clk_disable(pclk); ++ clk_put(hclk); ++err_hclk: ++ clk_put(pclk); ++ ++ return ret; ++ ++} ++ ++static struct platform_driver avr32_isi_driver = { ++ .probe = avr32_isi_probe, ++ .remove = __exit_p(avr32_isi_remove), ++ .driver = { ++ .name = "atmel_isi", ++ .owner = THIS_MODULE, ++ }, ++}; ++ ++static int __init avr32_isi_init(void) ++{ ++ return platform_driver_probe(&avr32_isi_driver, &avr32_isi_probe); ++ ++/*FIXME return platform_driver_register(&avr32_isi_driver);*/ ++} ++ ++ ++static void __exit avr32_isi_exit(void) ++{ ++ platform_driver_unregister(&avr32_isi_driver); ++} ++ ++ ++module_init(avr32_isi_init); ++module_exit(avr32_isi_exit); ++ ++MODULE_AUTHOR("Lars Häring <lharing@atmel.com>"); ++MODULE_DESCRIPTION("The V4L2 driver for AVR32 Linux"); ++MODULE_LICENSE("GPL"); ++MODULE_SUPPORTED_DEVICE("video"); +diff --git a/drivers/media/video/atmel-isi.h b/drivers/media/video/atmel-isi.h +new file mode 100644 +index 0000000..2aa3c14 +--- /dev/null ++++ b/drivers/media/video/atmel-isi.h +@@ -0,0 +1,252 @@ ++/* ++ * Register definitions for the Atmel Image Sensor Interface. ++ * ++ * Copyright (C) 2006 Atmel Corporation ++ * ++ * 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. ++ */ ++#ifndef __ASM_AVR32_ISI_H__ ++#define __ASM_AVR32_ISI_H__ ++ ++#include <linux/videodev2.h> ++ ++/* ISI register offsets */ ++#define ISI_CR1 0x0000 ++#define ISI_CR2 0x0004 ++#define ISI_SR 0x0008 ++#define ISI_IER 0x000c ++#define ISI_IDR 0x0010 ++#define ISI_IMR 0x0014 ++#define ISI_PSIZE 0x0020 ++#define ISI_PDECF 0x0024 ++#define ISI_PPFBD 0x0028 ++#define ISI_CDBA 0x002c ++#define ISI_Y2R_SET0 0x0030 ++#define ISI_Y2R_SET1 0x0034 ++#define ISI_R2Y_SET0 0x0038 ++#define ISI_R2Y_SET1 0x003c ++#define ISI_R2Y_SET2 0x0040 ++ ++/* Bitfields in CR1 */ ++#define ISI_RST_OFFSET 0 ++#define ISI_RST_SIZE 1 ++#define ISI_DIS_OFFSET 1 ++#define ISI_DIS_SIZE 1 ++#define ISI_HSYNC_POL_OFFSET 2 ++#define ISI_HSYNC_POL_SIZE 1 ++#define ISI_VSYNC_POL_OFFSET 3 ++#define ISI_VSYNC_POL_SIZE 1 ++#define ISI_PIXCLK_POL_OFFSET 4 ++#define ISI_PIXCLK_POL_SIZE 1 ++#define ISI_EMB_SYNC_OFFSET 6 ++#define ISI_EMB_SYNC_SIZE 1 ++#define ISI_CRC_SYNC_OFFSET 7 ++#define ISI_CRC_SYNC_SIZE 1 ++#define ISI_FRATE_OFFSET 8 ++#define ISI_FRATE_SIZE 3 ++#define ISI_FULL_OFFSET 12 ++#define ISI_FULL_SIZE 1 ++#define ISI_THMASK_OFFSET 13 ++#define ISI_THMASK_SIZE 2 ++#define ISI_CODEC_ON_OFFSET 15 ++#define ISI_CODEC_ON_SIZE 1 ++#define ISI_SLD_OFFSET 16 ++#define ISI_SLD_SIZE 8 ++#define ISI_SFD_OFFSET 24 ++#define ISI_SFD_SIZE 8 ++ ++/* Bitfields in CR2 */ ++#define ISI_IM_VSIZE_OFFSET 0 ++#define ISI_IM_VSIZE_SIZE 11 ++#define ISI_GS_MODE_OFFSET 11 ++#define ISI_GS_MODE_SIZE 1 ++#define ISI_RGB_MODE_OFFSET 12 ++#define ISI_RGB_MODE_SIZE 1 ++#define ISI_GRAYSCALE_OFFSET 13 ++#define ISI_GRAYSCALE_SIZE 1 ++#define ISI_RGB_SWAP_OFFSET 14 ++#define ISI_RGB_SWAP_SIZE 1 ++#define ISI_COL_SPACE_OFFSET 15 ++#define ISI_COL_SPACE_SIZE 1 ++#define ISI_IM_HSIZE_OFFSET 16 ++#define ISI_IM_HSIZE_SIZE 11 ++#define ISI_YCC_SWAP_OFFSET 28 ++#define ISI_YCC_SWAP_SIZE 2 ++#define ISI_RGB_CFG_OFFSET 30 ++#define ISI_RGB_CFG_SIZE 2 ++ ++/* Bitfields in SR */ ++#define ISI_CDC_STATUS_OFFSET 3 ++#define ISI_CDC_STATUS_SIZE 1 ++ ++/* Bitfields in SR/IER/IDR/IMR */ ++#define ISI_SOF_OFFSET 0 ++#define ISI_SOF_SIZE 1 ++#define ISI_SOFTRST_OFFSET 2 ++#define ISI_SOFTRST_SIZE 1 ++#define ISI_CRC_ERR_OFFSET 4 ++#define ISI_CRC_ERR_SIZE 1 ++#define ISI_FO_C_OVF_OFFSET 5 ++#define ISI_FO_C_OVF_SIZE 1 ++#define ISI_FO_P_OVF_OFFSET 6 ++#define ISI_FO_P_OVF_SIZE 1 ++#define ISI_FO_P_EMP_OFFSET 7 ++#define ISI_FO_P_EMP_SIZE 1 ++#define ISI_FO_C_EMP_OFFSET 8 ++#define ISI_FO_C_EMP_SIZE 1 ++#define ISI_FR_OVR_OFFSET 9 ++#define ISI_FR_OVR_SIZE 1 ++ ++/* Bitfields in PSIZE */ ++#define ISI_PREV_VSIZE_OFFSET 0 ++#define ISI_PREV_VSIZE_SIZE 10 ++#define ISI_PREV_HSIZE_OFFSET 16 ++#define ISI_PREV_HSIZE_SIZE 10 ++ ++/* Bitfields in PCDEF */ ++#define ISI_DEC_FACTOR_OFFSET 0 ++#define ISI_DEC_FACTOR_SIZE 8 ++ ++/* Bitfields in PPFBD */ ++#define ISI_PREV_FBD_ADDR_OFFSET 0 ++#define ISI_PREV_FBD_ADDR_SIZE 32 ++ ++/* Bitfields in CDBA */ ++#define ISI_CODEC_DMA_ADDR_OFFSET 0 ++#define ISI_CODEC_DMA_ADDR_SIZE 32 ++ ++/* Bitfields in Y2R_SET0 */ ++#define ISI_Y2R_SET0_C3_OFFSET 24 ++#define ISI_Y2R_SET0_C3_SIZE 8 ++ ++/* Bitfields in Y2R_SET1 */ ++#define ISI_Y2R_SET1_C4_OFFSET 0 ++#define ISI_Y2R_SET1_C4_SIZE 9 ++#define ISI_YOFF_OFFSET 12 ++#define ISI_YOFF_SIZE 1 ++#define ISI_CROFF_OFFSET 13 ++#define ISI_CROFF_SIZE 1 ++#define ISI_CBOFF_OFFSET 14 ++#define ISI_CBOFF_SIZE 1 ++ ++/* Bitfields in R2Y_SET0 */ ++#define ISI_C0_OFFSET 0 ++#define ISI_C0_SIZE 8 ++#define ISI_C1_OFFSET 8 ++#define ISI_C1_SIZE 8 ++#define ISI_C2_OFFSET 16 ++#define ISI_C2_SIZE 8 ++#define ISI_ROFF_OFFSET 24 ++#define ISI_ROFF_SIZE 1 ++ ++/* Bitfields in R2Y_SET1 */ ++#define ISI_R2Y_SET1_C3_OFFSET 0 ++#define ISI_R2Y_SET1_C3_SIZE 8 ++#define ISI_R2Y_SET1_C4_OFFSET 8 ++#define ISI_R2Y_SET1_C4_SIZE 8 ++#define ISI_C5_OFFSET 16 ++#define ISI_C5_SIZE 8 ++#define ISI_GOFF_OFFSET 24 ++#define ISI_GOFF_SIZE 1 ++ ++/* Bitfields in R2Y_SET2 */ ++#define ISI_C6_OFFSET 0 ++#define ISI_C6_SIZE 8 ++#define ISI_C7_OFFSET 8 ++#define ISI_C7_SIZE 8 ++#define ISI_C8_OFFSET 16 ++#define ISI_C8_SIZE 8 ++#define ISI_BOFF_OFFSET 24 ++#define ISI_BOFF_SIZE 1 ++ ++/* Constants for FRATE */ ++#define ISI_FRATE_CAPTURE_ALL 0 ++ ++/* Constants for YCC_SWAP */ ++#define ISI_YCC_SWAP_DEFAULT 0 ++#define ISI_YCC_SWAP_MODE_1 1 ++#define ISI_YCC_SWAP_MODE_2 2 ++#define ISI_YCC_SWAP_MODE_3 3 ++ ++/* Constants for RGB_CFG */ ++#define ISI_RGB_CFG_DEFAULT 0 ++#define ISI_RGB_CFG_MODE_1 1 ++#define ISI_RGB_CFG_MODE_2 2 ++#define ISI_RGB_CFG_MODE_3 3 ++ ++/* Bit manipulation macros */ ++#define ISI_BIT(name) \ ++ (1 << ISI_##name##_OFFSET) ++#define ISI_BF(name,value) \ ++ (((value) & ((1 << ISI_##name##_SIZE) - 1)) \ ++ << ISI_##name##_OFFSET) ++#define ISI_BFEXT(name,value) \ ++ (((value) >> ISI_##name##_OFFSET) \ ++ & ((1 << ISI_##name##_SIZE) - 1)) ++#define ISI_BFINS(name,value,old) \ ++ (((old) & ~(((1 << ISI_##name##_SIZE) - 1) \ ++ << ISI_##name##_OFFSET))\ ++ | ISI_BF(name,value)) ++ ++/* Register access macros */ ++#define isi_readl(port,reg) \ ++ __raw_readl((port)->regs + ISI_##reg) ++#define isi_writel(port,reg,value) \ ++ __raw_writel((value), (port)->regs + ISI_##reg) ++ ++#define ATMEL_V4L2_VID_FLAGS ( V4L2_CAP_VIDEO_OUTPUT ) ++ ++struct atmel_isi; ++ ++enum atmel_isi_pixfmt { ++ ATMEL_ISI_PIXFMT_GREY, /* Greyscale */ ++ ATMEL_ISI_PIXFMT_CbYCrY, ++ ATMEL_ISI_PIXFMT_CrYCbY, ++ ATMEL_ISI_PIXFMT_YCbYCr, ++ ATMEL_ISI_PIXFMT_YCrYCb, ++ ATMEL_ISI_PIXFMT_RGB24, ++ ATMEL_ISI_PIXFMT_BGR24, ++ ATMEL_ISI_PIXFMT_RGB16, ++ ATMEL_ISI_PIXFMT_BGR16, ++ ATMEL_ISI_PIXFMT_GRB16, /* G[2:0] R[4:0]/B[4:0] G[5:3] */ ++ ATMEL_ISI_PIXFMT_GBR16, /* G[2:0] B[4:0]/R[4:0] G[5:3] */ ++ ATMEL_ISI_PIXFMT_RGB24_REV, ++ ATMEL_ISI_PIXFMT_BGR24_REV, ++ ATMEL_ISI_PIXFMT_RGB16_REV, ++ ATMEL_ISI_PIXFMT_BGR16_REV, ++ ATMEL_ISI_PIXFMT_GRB16_REV, /* G[2:0] R[4:0]/B[4:0] G[5:3] */ ++ ATMEL_ISI_PIXFMT_GBR16_REV, /* G[2:0] B[4:0]/R[4:0] G[5:3] */ ++}; ++ ++struct atmel_isi_format { ++ struct v4l2_pix_format pix; ++ enum atmel_isi_pixfmt input_format; ++}; ++ ++struct atmel_isi_camera { ++ const char *name; ++ struct module *owner; ++ struct list_head list; ++ unsigned int hsync_act_low:1; ++ unsigned int vsync_act_low:1; ++ unsigned int pclk_act_falling:1; ++ unsigned int has_emb_sync:1; ++ /* ISI supports up to 17 formats */ ++ unsigned int pixelformats[17]; ++ int (*get_format)(struct atmel_isi_camera *cam, ++ struct atmel_isi_format *fmt); ++ int (*set_format)(struct atmel_isi_camera *cam, ++ struct atmel_isi_format *fmt); ++ int (*start_capture)(struct atmel_isi_camera *cam); ++ int (*stop_capture)(struct atmel_isi_camera *cam); ++ struct atmel_isi *isi; ++}; ++ ++extern int atmel_isi_register_camera(struct atmel_isi_camera *cam); ++extern void atmel_isi_unregister_camera(struct atmel_isi_camera *cam); ++ ++ ++#endif /* __ASM_AVR32_ISI_H__ */ ++ +diff --git a/drivers/media/video/Kconfig b/drivers/media/video/Kconfig +index 7558484..a8cdf42 100644 +--- a/drivers/media/video/Kconfig ++++ b/drivers/media/video/Kconfig +@@ -13,6 +13,20 @@ menuconfig VIDEO_CAPTURE_DRIVERS + + if VIDEO_CAPTURE_DRIVERS && VIDEO_DEV + ++config VIDEO_AVR32_ISI ++ tristate "AVR32 video support" ++ depends on VIDEO_DEV ++ ---help--- ++ This module makes the AVR32 Image Sensor Interface available ++ ++config VIDEO_MT9M112 ++ tristate "Micron MT9M112 camera" ++ default n ++ depends on VIDEO_AVR32_ISI && I2C ++ ---help--- ++ This will add support for the Micron MT9M112 camera. ++ as a v4l2 device. ++ + config VIDEO_ADV_DEBUG + bool "Enable advanced debug functionality" + default n +diff --git a/drivers/media/video/Makefile b/drivers/media/video/Makefile +index 78e38d0..3156969 100644 +--- a/drivers/media/video/Makefile ++++ b/drivers/media/video/Makefile +@@ -77,7 +77,8 @@ obj-$(CONFIG_VIDEO_HEXIUM_ORION) += hexium_orion.o + obj-$(CONFIG_VIDEO_HEXIUM_GEMINI) += hexium_gemini.o + obj-$(CONFIG_VIDEO_DPC) += dpc7146.o + obj-$(CONFIG_TUNER_3036) += tuner-3036.o + obj-$(CONFIG_VIDEO_AVR32_ISI) += atmel-isi.o ++obj-$(CONFIG_VIDEO_MT9M112) += tm13m3.o + + obj-$(CONFIG_VIDEO_TUNER) += tuner.o + obj-$(CONFIG_VIDEO_BUF) += video-buf.o +diff --git a/drivers/media/video/tm13m3.c b/drivers/media/video/tm13m3.c +new file mode 100644 +index 0000000..42f0fd3 +--- /dev/null ++++ b/drivers/media/video/tm13m3.c +@@ -0,0 +1,631 @@ ++/* ++ * Micron Mt9M112 camera driver. ++ * ++ * Copyright (C) 2005-2007 Atmel Corporation ++ * ++ * 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. ++ */ ++//#define DEBUG ++ ++#include <linux/clk.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/interrupt.h> ++#include <linux/io.h> ++#include <linux/device.h> ++#include <linux/list.h> ++#include <linux/delay.h> ++#include <linux/i2c.h> ++ ++#include <linux/err.h> ++#include <asm/gpio.h> ++#include <asm/arch/board.h> ++#include <asm/arch/at32ap700x.h> ++ ++#include "atmel-isi.h" ++ ++/* camera standby pin */ ++#define CAM_STANDBY GPIO_PIN_PA(9) ++/* camera reset pin */ ++#define CAM_RESET GPIO_PIN_PA(8) ++ ++/*! Maximum number of pixels in a row */ ++#define TM13M3_MAX_WIDTH 1280 ++/*! Maximum number of rows */ ++#define TM13M3_MAX_HEIGHT 1024 ++ ++/*! Clock for image sensor CLKIN signal */ ++static char mclk_name[32] = "gclk0"; ++/*! Parent clock of gclk0 ++ * Either osc0 or pll0 ++ * We use osc0 with 20MHz quarz. ++ */ ++static char mclk_parent_name[32] = "osc0"; ++ ++static struct clk *mclk; ++static struct clk *mclk_parent; ++module_param_string(mclk, mclk_name, sizeof(mclk_name), 0644); ++MODULE_PARM_DESC(mclk, "Name of the clock used as camera clock input"); ++ ++module_param_string(mclk_parent, mclk_parent_name, ++ sizeof(mclk_parent_name), 0644); ++MODULE_PARM_DESC(mclk, "Name of mclk parent clock"); ++ ++ ++/* Register adresses */ ++#define CHIP_VERSION 0x0 ++#define PROGRAM_CONTROL 0x2CC ++#define READ_MODE_CONTEXT_B 0x20 ++#define CONTEXT_CONTROL 0xC8 ++#define COLUMN_WIDTH 0x4 ++#define HORIZONTAL_OUTPUT_SIZE_B 0x1A1 ++#define VERTICAL_OUTPUT_SIZE_B 0x1A4 ++#define ROW_WIDTH 0x3 ++#define PAGE_MAP 0xF0 ++#define OUTPUT_FORMAT_CONTROL_A 0x13A ++#define HORIZONTAL_ZOOM 0x1A6 ++#define VERTICAL_ZOOM 0x1A9 ++#define PLL_CONTROL_1 0x66 ++#define PLL_CONTROL_2 0x67 ++#define CLOCK_CONTROL 0x65 ++ ++/* Chip ID stored in CHIP_VERSION register */ ++#define MT9M112_CHIP_ID 0x148C ++/* I2C address of camera module */ ++#define I2C_TM13M3 0x5D ++ ++static unsigned short normal_i2c[] = { ++ I2C_TM13M3, ++ I2C_CLIENT_END ++}; ++I2C_CLIENT_INSMOD; ++ ++#ifdef CONFIG_DEBUG_FS ++struct reg_dbg { ++ struct tm13m3 *is; ++ struct dentry *dentry; ++ unsigned int offset; ++}; ++#endif ++ ++struct tm13m3 { ++ struct mutex mutex; ++ u16 current_page; ++ u32 current_format; ++ u16 pll_avr_ctrl; ++ struct clk *mclk; ++ struct i2c_client client; ++ struct atmel_isi_camera cam; ++#ifdef CONFIG_DEBUG_FS ++ struct dentry *debugfs_root; ++ struct reg_dbg debugfs_reg[37]; ++#endif ++}; ++ ++ ++#define to_tm13m3(cam) container_of(cam, struct tm13m3, cam) ++ ++static struct i2c_driver tm13m3_driver; ++ ++static int tm13m3_write_16(struct tm13m3 *is, u16 reg, u16 value) ++{ ++ int ret = 0; ++ u16 register_page = 0; ++ ++ register_page = reg >> 8; ++ ++ if ((register_page != is->current_page) ++ && (reg != PAGE_MAP)){ ++ ++ if( 0 <= (ret = i2c_smbus_write_word_data(&is->client, PAGE_MAP, cpu_to_le16(register_page)))) ++ is->current_page = register_page; ++ } ++ ++ if(ret >= 0){ ++ ret = i2c_smbus_write_word_data(&is->client, (u8) reg, cpu_to_le16(value)); ++ } ++ return ret; ++} ++ ++static int tm13m3_read_16(struct tm13m3 *is, u16 reg) ++{ ++ int ret = 0; ++ u16 register_page = 0; ++ ++ register_page = reg >> 8; ++ ++ if ((register_page != is->current_page) ++ && (reg != PAGE_MAP)){ ++ ++ if( 0 <= (ret = i2c_smbus_write_word_data(&is->client, PAGE_MAP, cpu_to_le16(register_page)))) ++ is->current_page = register_page; ++ } ++ ++if(ret >= 0){ ++ ret = i2c_smbus_read_word_data(&is->client, (u8) reg); ++ } ++ ++ if (ret < 0) ++ return -EIO; ++ ++ return le16_to_cpu(ret); ++} ++ ++#ifdef CONFIG_DEBUG_FS ++#include <linux/debugfs.h> ++#include <linux/uaccess.h> ++ ++struct tm13m3_reg { ++ u16 address; ++ const char *name; ++}; ++ ++static struct tm13m3_reg tm13m3_registers[38] = { ++ { .address = CHIP_VERSION, .name = "chip_version"}, ++ { .address = 0x1, .name = "row_start"}, ++ { .address = 0x2, .name = "column_start"}, ++ { .address = 0x3, .name = "row_width"}, ++ { .address = 0x4, .name = "column_width"}, ++ { .address = 0x5, .name = "horizontal_blanking_b"}, ++ { .address = 0x6, .name = "vertical_blanking_b"}, ++ { .address = 0x7, .name = "horizontal_blanking_a"}, ++ { .address = 0x8, .name = "vertical_blanking_a"}, ++ { .address = 0x0D, .name = "reset"}, ++ { .address = 0x20, .name = "read_mode_context_b"}, ++ { .address = 0x21, .name = "read_mode_context_a"}, ++ { .address = 0x22, .name = "dark_col_row"}, ++ { .address = 0x65, .name = "clock_control"}, ++ { .address = 0x66, .name = "pll_control_1"}, ++ { .address = 0x67, .name = "pll_control_2"}, ++ { .address = 0xC8, .name = "context_control"}, ++ { .address = 0x106, .name = "mode_control"}, ++ { .address = 0x108, .name = "format_control"}, ++ { .address = 0x13A, .name = "output_format_control_a"}, ++ { .address = 0x148, .name = "test_pattern_generator"}, ++ { .address = 0x19B, .name = "output_format_control_b"}, ++ { .address = 0x1A1, .name = "horizontal_output_size_b"}, ++ { .address = 0x1A4, .name = "vertical_output_size_b"}, ++ { .address = 0x1A5, .name = "horizontal_pan"}, ++ { .address = 0x1A6, .name = "horizontal_zoom"}, ++ { .address = 0x1A7, .name = "horizontal_output_size_a"}, ++ { .address = 0x1A8, .name = "vertical_pan"}, ++ { .address = 0x1A9, .name = "vertical_zoom"}, ++ { .address = 0x1AA, .name = "vertical_output_size_a"}, ++ { .address = 240, .name = "page_map"}, ++ { .address = 0x2C8, .name = "global_context_control"}, ++ { .address = 0x2CB, .name = "program_advance"}, ++ { .address = 0x2CC, .name = "program_control"}, ++ { .address = 0x2D2, .name = "default_program_conf"}, ++ { .address = 0x2D3, .name = "user_global_context_control"}, ++ { .address = (0x100 | 0), .name = "module_id"}, ++ { .address = (0x200 | 2), .name = "mode_control"}, ++}; ++ ++static u64 reg_dbg_get(void *data) ++{ ++ struct reg_dbg *reg = data; ++ int ret = 0; ++ ++ mutex_lock(®->is->mutex); ++ ret = tm13m3_read_16(reg->is, tm13m3_registers[reg->offset].address); ++ mutex_unlock(®->is->mutex); ++ ++ if (ret < 0) { ++ printk("%s: failed to read reg 0x%02x: %d\n", ++ reg->is->cam.name, ++ tm13m3_registers[reg->offset].address, ret); ++ return ~0ULL; ++ } ++ return ret; ++} ++ ++static void reg_dbg_set(void *data, u64 val) ++{ ++ struct reg_dbg *reg = data; ++ int ret = 0; ++ ++ mutex_lock(®->is->mutex); ++ ret = tm13m3_write_16(reg->is, tm13m3_registers[reg->offset].address, (u16) val); ++ mutex_unlock(®->is->mutex); ++ ++ if (ret < 0){ ++ printk("%s: failed to write reg 0x%02x: %d\n", ++ reg->is->cam.name, ++ tm13m3_registers[reg->offset].address, ret); ++ } ++} ++DEFINE_SIMPLE_ATTRIBUTE(reg_dbg_fops, reg_dbg_get, reg_dbg_set, "%04llx\n"); ++ ++static void tm13m3_init_debugfs(struct tm13m3 *is) ++{ ++ struct dentry *root, *reg; ++ unsigned int i; ++ ++ root = debugfs_create_dir(is->cam.name, NULL); ++ if (IS_ERR(root) || !root) ++ goto err_root; ++ is->debugfs_root = root; ++ ++ for (i = 0; i < ARRAY_SIZE(is->debugfs_reg); i++) { ++ if (!tm13m3_registers[i].name) ++ continue; ++ ++ is->debugfs_reg[i].is = is; ++ is->debugfs_reg[i].offset = i; ++ ++ reg = debugfs_create_file(tm13m3_registers[i].name, S_IRUGO | S_IWUSR, ++ root, &is->debugfs_reg[i], ++ ®_dbg_fops); ++ if (!reg) ++ goto err_reg; ++ is->debugfs_reg[i].dentry = reg; ++ } ++ ++ return; ++ ++err_reg: ++ while (i--) ++ debugfs_remove(is->debugfs_reg[i].dentry); ++ debugfs_remove(root); ++err_root: ++ is->debugfs_root = NULL; ++ printk(KERN_ERR "%s: failed to initialize debugfs\n", ++ is->cam.name); ++} ++ ++static void tm13m3_cleanup_debugfs(struct tm13m3 *is) ++{ ++ unsigned int i; ++ ++ if (is->debugfs_root) { ++ for (i = 0; i < ARRAY_SIZE(is->debugfs_reg); i++) ++ debugfs_remove(is->debugfs_reg[i].dentry); ++ debugfs_remove(is->debugfs_root); ++ } ++} ++#else ++static inline void tm13m3_init_debugfs(struct tm13m3 *is) ++{ ++ ++} ++ ++static inline void tm13m3_cleanup_debugfs(struct tm13m3 *is) ++{ ++ ++} ++#endif /* CONFIG_DEBUG_FS */ ++ ++static int tm13m3_get_format(struct atmel_isi_camera *cam, ++ struct atmel_isi_format *fmt) ++{ ++ struct tm13m3 *is = to_tm13m3(cam); ++ int ret = 0; ++ ++ fmt->pix.colorspace = V4L2_COLORSPACE_SMPTE170M; ++ fmt->input_format = ATMEL_ISI_PIXFMT_CbYCrY; ++ fmt->input_format = is->current_format; ++ ++ fmt->pix.width = 320; ++ fmt->pix.height = 240; ++ ++ return ret; ++} ++ ++static int tm13m3_set_format(struct atmel_isi_camera *cam, ++ struct atmel_isi_format *fmt) ++{ ++ struct tm13m3 *is = to_tm13m3(cam); ++ int ret = 0; ++ ++ fmt->pix.colorspace = V4L2_COLORSPACE_SMPTE170M; ++/* ++ switch(fmt->input_format){ ++ case ATMEL_ISI_PIXFMT_CbYCrY: ++ is->current_format = ATMEL_ISI_PIXFMT_CbYCrY; ++ break; ++ case ATMEL_ISI_PIXFMT_YCbYCr: ++ is->current_format = ATMEL_ISI_PIXFMT_YCbYCr; ++ break; ++ case ATMEL_ISI_PIXFMT_CrYCbY: ++ is->current_format = ATMEL_ISI_PIXFMT_CrYCbY; ++ break; ++ case ATMEL_ISI_PIXFMT_YCrYCb: ++ is->current_format = ATMEL_ISI_PIXFMT_YCrYCb; ++ break; ++ default: ++ // force a valid format ++ fmt->input_format = ATMEL_ISI_PIXFMT_CbYCrY; ++ is->current_format = ATMEL_ISI_PIXFMT_CbYCrY; ++ pr_debug("%s: Not supported format, forcing default format\n", ++ cam->name); ++ break; ++ } ++*/ ++ fmt->input_format = ATMEL_ISI_PIXFMT_CrYCbY; ++ is->current_format = ATMEL_ISI_PIXFMT_CrYCbY; ++ ++ /* adjust picture width and height */ ++ if (fmt->pix.width > TM13M3_MAX_WIDTH) ++ fmt->pix.width = TM13M3_MAX_WIDTH; ++ if (fmt->pix.height > TM13M3_MAX_HEIGHT) ++ fmt->pix.height = TM13M3_MAX_HEIGHT; ++ ++ //tm13m3_write_16(is, COLUMN_WIDTH, fmt->pix.width); ++ //tm13m3_write_16(is, ROW_WIDTH, fmt->pix.height); ++ //tm13m3_write_16(is, HORIZONTAL_ZOOM, fmt->pix.width); ++ //tm13m3_write_16(is, VERTICAL_ZOOM, fmt->pix.height); ++ ++ //tm13m3_write_16(is, HORIZONTAL_OUTPUT_SIZE_B, fmt->pix.width); ++ //tm13m3_write_16(is, VERTICAL_OUTPUT_SIZE_B, fmt->pix.height); ++ ++ /* FIXME Set context output width needed ??*/ ++ ++ pr_debug("%s: set_format %ux%u\n", cam->name, ++ fmt->pix.width, fmt->pix.height); ++ return ret; ++} ++ ++static void tm13m3_reset_soft(struct tm13m3 *is) ++{ ++ tm13m3_write_16(is, 0x0D, 0x0001); ++ /*FIXME test if toggling is really needed */ ++ tm13m3_write_16(is, 0x0D, 0x0000); ++} ++ ++static void tm13m3_reset_hardware(struct tm13m3 *is) ++{ ++ gpio_set_value(CAM_RESET, 0); ++ //FIXME : set correct reset interval usleep(); ++ gpio_set_value(CAM_RESET, 1); ++} ++ ++static int tm13m3_start_capture(struct atmel_isi_camera *cam) ++{ ++ struct tm13m3 *is = to_tm13m3(cam); ++ int ret = 0; ++ ++ return ret; ++} ++ ++static int tm13m3_stop_capture(struct atmel_isi_camera *cam) ++{ ++ struct tm13m3 *is = to_tm13m3(cam); ++ int ret = 0; ++ ++ ++ return ret; ++} ++ ++static int tm13m3_init_hardware(struct tm13m3 *is) ++{ ++ int chip_id; ++ ++ tm13m3_reset_hardware(is); ++ /* set register page to reset value*/ ++ is->current_page = 0; ++ is->current_format = ATMEL_ISI_PIXFMT_CbYCrY; ++ ++ pr_debug("tm13m3: Init sensor\n"); ++ /* Try to identify the camera */ ++ chip_id = tm13m3_read_16(is, CHIP_VERSION); ++ if (chip_id < 0) ++ return -EIO; ++ ++ if (chip_id != MT9M112_CHIP_ID) { ++ printk(KERN_ERR "%s: Unknown chip ID 0x%04x\n", ++ is->cam.name, chip_id); ++ return -ENODEV; ++ } ++#if 0 ++ /* Configure pll for 36,8 MHz with CLKIN = 20MHz ++ * fout = fclkin * M * 1 /( 2* (N+1) * (P+1)) ++ */ ++ /* Set P = 2 */ ++ tm13m3_write_16(is, PLL_CONTROL_2, 0x0502); ++ /* M = 22, N = 1*/ ++ tm13m3_write_16(is, PLL_CONTROL_1, 0x1601); ++ /* wake up pll*/ ++ tm13m3_write_16(is, CLOCK_CONTROL, 0x8000); ++ /* wait until pll has stabilized */ ++ mdelay(1); ++ /* set pll as master clock*/ ++ tm13m3_write_16(is, CLOCK_CONTROL, 0x0000); ++ ++#endif ++ /* Set semi-auto mode program mode*/ ++ tm13m3_write_16(is, PROGRAM_CONTROL, 0x0010); ++ /* set context B read mode */ ++ tm13m3_write_16(is, READ_MODE_CONTEXT_B, 0x0100); ++ /* switch to read+resize context B */ ++ tm13m3_write_16(is, CONTEXT_CONTROL, 0x0408); ++ /* set ITU-R BT.656 codes */ ++ tm13m3_write_16(is, OUTPUT_FORMAT_CONTROL_A, 0x0A00); ++ /* set sensor image size */ ++ tm13m3_write_16(is, HORIZONTAL_ZOOM, 320); ++ tm13m3_write_16(is, VERTICAL_ZOOM, 240); ++ tm13m3_write_16(is, HORIZONTAL_OUTPUT_SIZE_B, 320); ++ tm13m3_write_16(is, VERTICAL_OUTPUT_SIZE_B, 240); ++ tm13m3_write_16(is, COLUMN_WIDTH, 320); ++ tm13m3_write_16(is, ROW_WIDTH, 240); ++ return 0; ++} ++static int tm13m3_detect_client(struct i2c_adapter *adapter, ++ int address, int kind) ++{ ++ struct i2c_client *client; ++ struct tm13m3 *is; ++ int ret; ++ ++ pr_debug("tm13m3: detecting client on address 0x%x\n", address); ++ ++ /* Check if the adapter supports the needed features */ ++ if (!i2c_check_functionality(adapter, ++ (I2C_FUNC_SMBUS_READ_BYTE_DATA ++ | I2C_FUNC_SMBUS_WRITE_BYTE_DATA ++ | I2C_FUNC_SMBUS_READ_WORD_DATA ++ | I2C_FUNC_SMBUS_WRITE_WORD_DATA))) ++ return 0; ++ ++ is = kzalloc(sizeof(struct tm13m3), GFP_KERNEL); ++ if (!is) ++ return -ENOMEM; ++ ++ client = &is->client; ++ client->addr = address; ++ client->adapter = adapter; ++ client->driver = &tm13m3_driver; ++ strcpy(client->name, "tm13m3"); ++ ++ is->cam.name = client->name; ++ is->cam.hsync_act_low = 0; ++ is->cam.vsync_act_low = 0; ++ is->cam.pclk_act_falling = 0; ++ /* no SAV/EAV sync -> HSYNC and VSYNC used */ ++ /*is->cam.has_emb_sync = 0;*/ ++ is->cam.has_emb_sync = 1; ++ ++ is->cam.get_format = tm13m3_get_format; ++ is->cam.set_format = tm13m3_set_format; ++ is->cam.start_capture = tm13m3_start_capture; ++ is->cam.stop_capture = tm13m3_stop_capture; ++ ++ mutex_init(&is->mutex); ++ ++ is->mclk = clk_get(NULL, mclk_name); ++ if (IS_ERR(is->mclk)) { ++ ret = PTR_ERR(is->mclk); ++ goto err_clk; ++ } ++ clk_enable(is->mclk); ++ ++ ret = i2c_attach_client(client); ++ if (ret) ++ goto err_attach; ++ ++ i2c_set_clientdata(client, is); ++ ++ ret = tm13m3_init_hardware(is); ++ if (ret) ++ goto err_init_hw; ++ ++ /* We're up and running. Notify the ISI driver */ ++ ret = atmel_isi_register_camera(&is->cam); ++ if (ret) ++ goto err_register; ++ ++ printk(KERN_INFO "TM13M3 Image Sensor at %s:0x%02x\n", ++ adapter->name, address); ++ ++ tm13m3_init_debugfs(is); ++ ++ return 0; ++ ++err_register: ++err_init_hw: ++// at76_reset_hardware(is); ++ i2c_detach_client(client); ++err_attach: ++ clk_disable(is->mclk); ++ clk_put(is->mclk); ++err_clk: ++ kfree(is); ++ return ret; ++} ++ ++static int tm13m3_attach_adapter(struct i2c_adapter *adapter) ++{ ++ pr_debug("tm13m3: starting probe for adapter %s (%u)\n", ++ adapter->name, adapter->id); ++ return i2c_probe(adapter, &addr_data, &tm13m3_detect_client); ++} ++ ++static int tm13m3_detach_client(struct i2c_client *client) ++{ ++ struct tm13m3 *is = i2c_get_clientdata(client); ++ int ret; ++ ++ tm13m3_cleanup_debugfs(is); ++ atmel_isi_unregister_camera(&is->cam); ++ ++ tm13m3_reset_hardware(is); ++ ++ ret = i2c_detach_client(client); ++ if (ret) ++ return ret; ++ ++ clk_disable(is->mclk); ++ clk_put(is->mclk); ++ kfree(is); ++ ++ return 0; ++} ++ ++static struct i2c_driver tm13m3_driver = { ++ .driver = { ++ .name = "tm13m3", ++ }, ++ .id = I2C_DRIVERID_TM13M3, ++ .attach_adapter = &tm13m3_attach_adapter, ++ .detach_client = &tm13m3_detach_client, ++}; ++ ++static int __init tm13m3_init(void) ++{ ++ /* ++ * Set up the master clock, if available. If clk_get() fails, ++ * this hopefully means that the board generates a suitable ++ * master clock some other way, which is fine by us. ++ * ++ * We need to do this before probing the i2c bus, as the ++ * camera won't ack any messages when it doesn't have a clock. ++ */ ++ mclk_parent = clk_get(NULL, mclk_parent_name); ++ if (!IS_ERR(mclk_parent)) ++ clk_enable(mclk_parent); ++ else { ++ mclk_parent = NULL; ++ pr_debug("tm13m3: No parent clock available\n"); ++ } ++ ++ mclk = clk_get(NULL, mclk_name); ++ if (!IS_ERR(mclk)) { ++ if (mclk_parent) ++ clk_set_parent(mclk, mclk_parent); ++ ++ clk_set_rate(mclk, 27000000); ++ clk_enable(mclk); ++ } else { ++ mclk = NULL; ++ pr_debug("tm13m3: No clock set\n"); ++ } ++ ++ gpio_direction_output(CAM_STANDBY, 0); ++ /* Reset sequence */ ++ gpio_direction_output(CAM_RESET, 0); ++ udelay(4); ++ gpio_set_value(CAM_RESET, 1); ++ ++ return i2c_add_driver(&tm13m3_driver); ++ ++} ++module_init(tm13m3_init); ++ ++static void __exit tm13m3_exit(void) ++{ ++ if (mclk) { ++ clk_disable(mclk); ++ clk_put(mclk); ++ } ++ if (mclk_parent) { ++ clk_disable(mclk_parent); ++ clk_put(mclk_parent); ++ } ++ i2c_del_driver(&tm13m3_driver); ++} ++module_exit(tm13m3_exit); ++ ++MODULE_DESCRIPTION("Atmel Image Sensor Interface Driver"); ++MODULE_AUTHOR("Lars Häring <lharing@atmel.com>"); ++MODULE_LICENSE("GPL"); +>From dc4286f6020df0bf791228cdfe7d4ea58e2f46ef Mon Sep 17 00:00:00 2001 +From: Haavard Skinnemoen <hskinnemoen@atmel.com> +Date: Wed, 17 Jan 2007 13:47:40 +0100 +Subject: [PATCH] AP7000: Add platform_device for ISI + +Signed-off-by: Haavard Skinnemoen <hskinnemoen@atmel.com> +--- + arch/avr32/mach-at32ap/at32ap700x.c | 47 +++++++++++++++++++++++++++++++++ + include/asm-avr32/arch-at32ap/board.h | 1 + + 2 files changed, 48 insertions(+), 0 deletions(-) + +diff --git a/arch/avr32/mach-at32ap/at32ap700x.c b/arch/avr32/mach-at32ap/at32ap700x.c +index 1130c8a..4184296 100644 +--- a/arch/avr32/mach-at32ap/at32ap700x.c ++++ b/arch/avr32/mach-at32ap/at32ap700x.c +@@ -1396,6 +1396,51 @@ at32_add_device_abdac(unsigned int id) + } + + /* -------------------------------------------------------------------- ++ * ISI ++ * -------------------------------------------------------------------- */ ++static struct resource atmel_isi0_resource[] = { ++ PBMEM(0xfff02c00), ++ IRQ(30), ++}; ++DEFINE_DEV(atmel_isi, 0); ++DEV_CLK(hclk, atmel_isi0, hsb, 5); ++DEV_CLK(pclk, atmel_isi0, pbb, 11); ++ ++struct platform_device *__init ++at32_add_device_isi(unsigned int id) ++{ ++ struct platform_device *pdev; ++ ++ switch (id) { ++ case 0: ++ pdev = &atmel_isi0_device; ++ select_peripheral(PB(0), PERIPH_A, 0); /* DATA0 */ ++ select_peripheral(PB(1), PERIPH_A, 0); /* DATA1 */ ++ select_peripheral(PB(2), PERIPH_A, 0); /* DATA2 */ ++ select_peripheral(PB(3), PERIPH_A, 0); /* DATA3 */ ++ select_peripheral(PB(4), PERIPH_A, 0); /* DATA4 */ ++ select_peripheral(PB(5), PERIPH_A, 0); /* DATA5 */ ++ select_peripheral(PB(6), PERIPH_A, 0); /* DATA6 */ ++ select_peripheral(PB(7), PERIPH_A, 0); /* DATA7 */ ++ select_peripheral(PB(11), PERIPH_B, 0); /* DATA8 */ ++ select_peripheral(PB(12), PERIPH_B, 0); /* DATA9 */ ++ select_peripheral(PB(13), PERIPH_B, 0); /* DATA10 */ ++ select_peripheral(PB(14), PERIPH_B, 0); /* DATA11 */ ++ select_peripheral(PB(8), PERIPH_A, 0); /* HSYNC */ ++ select_peripheral(PB(9), PERIPH_A, 0); /* VSYNC */ ++ select_peripheral(PB(10), PERIPH_A, 0); /* PCLK */ ++ break; ++ ++ default: ++ return NULL; ++ } ++ ++ platform_device_register(pdev); ++ ++ return pdev; ++} ++ ++/* -------------------------------------------------------------------- + * GCLK + * -------------------------------------------------------------------- */ + static struct clk gclk0 = { +@@ -1493,6 +1538,8 @@ struct clk *at32_clock_list[] = { + &gclk2, + &gclk3, + &gclk4, ++ &atmel_isi0_hclk, ++ &atmel_isi0_pclk, + }; + unsigned int at32_nr_clocks = ARRAY_SIZE(at32_clock_list); + +diff --git a/include/asm-avr32/arch-at32ap/board.h b/include/asm-avr32/arch-at32ap/board.h +index 9b36eb8..931f5af 100644 +--- a/include/asm-avr32/arch-at32ap/board.h ++++ b/include/asm-avr32/arch-at32ap/board.h +@@ -55,6 +55,7 @@ at32_add_device_lcdc(unsigned int id, struct atmel_lcdfb_info *data, + + struct platform_device *at32_add_device_ac97c(unsigned int id); + struct platform_device *at32_add_device_abdac(unsigned int id); ++struct platform_device *at32_add_device_isi(unsigned int id); + + /* depending on what's hooked up, not all SSC pins will be used */ + #define ATMEL_SSC_TK 0x01 +-- +1.5.2.3 + +>From 6bac229e6999ce8e761baf97975fc5db774721fa Mon Sep 17 00:00:00 2001 +From: Haavard Skinnemoen <hskinnemoen@atmel.com> +Date: Wed, 21 Feb 2007 15:35:44 +0100 +Subject: [PATCH] NGW100: Wire up the ISI + +Since the NGW100 doesn't actually have a camera on board, this patch +merely serves as an example on how you might wire up the ISI on a +board that does have a camera. +--- + arch/avr32/boards/atngw100/setup.c | 5 +++++ + 1 files changed, 5 insertions(+), 0 deletions(-) + +diff --git a/arch/avr32/boards/atngw100/setup.c b/arch/avr32/boards/atngw100/setup.c +index d649974..6ca98bb 100644 +--- a/arch/avr32/boards/atngw100/setup.c ++++ b/arch/avr32/boards/atngw100/setup.c +@@ -178,6 +178,11 @@ static int __init atngw100_init(void) + at32_add_device_twi(0); + #endif + ++ at32_add_device_isi(0); ++ ++ /* Master clock for the camera (GCLK0) */ ++ at32_select_periph(GPIO_PIN_PA(30), GPIO_PERIPH_A, 0); ++ + return 0; + } + postcore_initcall(atngw100_init); +-- +1.5.2.3 |