1 /****************************************************************************
5 * Copyright 2001, STMicrolectronics, Inc.
7 * Contact: steve.miller@st.com
10 * This is a USB driver for CPiA2 based video cameras.
12 * This driver is modelled on the cpia usb driver by
13 * Jochen Scharrlach and Johannes Erdfeldt.
15 * This program is free software; you can redistribute it and/or modify
16 * it under the terms of the GNU General Public License as published by
17 * the Free Software Foundation; either version 2 of the License, or
18 * (at your option) any later version.
20 * This program is distributed in the hope that it will be useful,
21 * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * GNU General Public License for more details.
25 * You should have received a copy of the GNU General Public License
26 * along with this program; if not, write to the Free Software
27 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
29 ****************************************************************************/
34 #include <linux/videodev2.h>
35 #include <linux/usb.h>
36 #include <linux/poll.h>
37 #include <media/v4l2-common.h>
38 #include <media/v4l2-device.h>
39 #include <media/v4l2-ctrls.h>
41 #include "cpia2_registers.h"
43 /* define for verbose debug output */
44 //#define _CPIA2_DEBUG_
51 #define ALLOW_CORRUPT 0 /* Causes collater to discard checksum */
53 /* USB Transfer mode */
58 #define USBIF_CMDONLY 0
60 #define USBIF_ISO_1 2 /* 128 bytes/ms */
61 #define USBIF_ISO_2 3 /* 384 bytes/ms */
62 #define USBIF_ISO_3 4 /* 640 bytes/ms */
63 #define USBIF_ISO_4 5 /* 768 bytes/ms */
64 #define USBIF_ISO_5 6 /* 896 bytes/ms */
65 #define USBIF_ISO_6 7 /* 1023 bytes/ms */
68 #define NEVER_FLICKER 0
74 #define DEBUG_REG 0x00000001
75 #define DEBUG_DUMP_PATCH 0x00000002
76 #define DEBUG_DUMP_REGS 0x00000004
82 VIDEOSIZE_VGA
= 0, /* 640x480 */
83 VIDEOSIZE_CIF
, /* 352x288 */
84 VIDEOSIZE_QVGA
, /* 320x240 */
85 VIDEOSIZE_QCIF
, /* 176x144 */
92 #define STV_IMAGE_CIF_ROWS 288
93 #define STV_IMAGE_CIF_COLS 352
95 #define STV_IMAGE_QCIF_ROWS 144
96 #define STV_IMAGE_QCIF_COLS 176
98 #define STV_IMAGE_VGA_ROWS 480
99 #define STV_IMAGE_VGA_COLS 640
101 #define STV_IMAGE_QVGA_ROWS 240
102 #define STV_IMAGE_QVGA_COLS 320
104 #define JPEG_MARKER_COM (1<<6) /* Comment segment */
109 /* Sensor types available with cpia2 asics */
115 /* Asic types available in the CPiA2 architecture */
116 #define CPIA2_ASIC_672 0x67
118 /* Device types (stv672, stv676, etc) */
119 #define DEVICE_STV_672 0x0001
120 #define DEVICE_STV_676 0x0002
124 FRAME_READING
, /* In the process of being grabbed into */
125 FRAME_READY
, /* Ready to be read */
130 * Register access (for USB request byte)
133 CAMERAACCESS_SYSTEM
= 0,
139 #define CAMERAACCESS_TYPE_BLOCK 0x00
140 #define CAMERAACCESS_TYPE_RANDOM 0x04
141 #define CAMERAACCESS_TYPE_MASK 0x08
142 #define CAMERAACCESS_TYPE_REPEAT 0x0C
144 #define TRANSFER_READ 0
145 #define TRANSFER_WRITE 1
147 #define DEFAULT_ALT USBIF_ISO_6
148 #define DEFAULT_BRIGHTNESS 0x46
149 #define DEFAULT_CONTRAST 0x93
150 #define DEFAULT_SATURATION 0x7f
153 #define HI_POWER_MODE CPIA2_SYSTEM_CONTROL_HIGH_POWER
154 #define LO_POWER_MODE CPIA2_SYSTEM_CONTROL_LOW_POWER
162 CPIA2_CMD_GET_VERSION
,
163 CPIA2_CMD_GET_PNP_ID
,
164 CPIA2_CMD_GET_ASIC_TYPE
,
165 CPIA2_CMD_GET_SENSOR
,
166 CPIA2_CMD_GET_VP_DEVICE
,
167 CPIA2_CMD_GET_VP_BRIGHTNESS
,
168 CPIA2_CMD_SET_VP_BRIGHTNESS
,
169 CPIA2_CMD_GET_CONTRAST
,
170 CPIA2_CMD_SET_CONTRAST
,
171 CPIA2_CMD_GET_VP_SATURATION
,
172 CPIA2_CMD_SET_VP_SATURATION
,
173 CPIA2_CMD_GET_VP_GPIO_DIRECTION
,
174 CPIA2_CMD_SET_VP_GPIO_DIRECTION
,
175 CPIA2_CMD_GET_VP_GPIO_DATA
,
176 CPIA2_CMD_SET_VP_GPIO_DATA
,
177 CPIA2_CMD_GET_VC_MP_GPIO_DIRECTION
,
178 CPIA2_CMD_SET_VC_MP_GPIO_DIRECTION
,
179 CPIA2_CMD_GET_VC_MP_GPIO_DATA
,
180 CPIA2_CMD_SET_VC_MP_GPIO_DATA
,
181 CPIA2_CMD_ENABLE_PACKET_CTRL
,
182 CPIA2_CMD_GET_FLICKER_MODES
,
183 CPIA2_CMD_SET_FLICKER_MODES
,
184 CPIA2_CMD_RESET_FIFO
, /* clear fifo and enable stream block */
185 CPIA2_CMD_SET_HI_POWER
,
186 CPIA2_CMD_SET_LOW_POWER
,
187 CPIA2_CMD_CLEAR_V2W_ERR
,
188 CPIA2_CMD_SET_USER_MODE
,
189 CPIA2_CMD_GET_USER_MODE
,
190 CPIA2_CMD_FRAMERATE_REQ
,
191 CPIA2_CMD_SET_COMPRESSION_STATE
,
192 CPIA2_CMD_GET_WAKEUP
,
193 CPIA2_CMD_SET_WAKEUP
,
194 CPIA2_CMD_GET_PW_CONTROL
,
195 CPIA2_CMD_SET_PW_CONTROL
,
196 CPIA2_CMD_GET_SYSTEM_CTRL
,
197 CPIA2_CMD_SET_SYSTEM_CTRL
,
198 CPIA2_CMD_GET_VP_SYSTEM_STATE
,
199 CPIA2_CMD_GET_VP_SYSTEM_CTRL
,
200 CPIA2_CMD_SET_VP_SYSTEM_CTRL
,
201 CPIA2_CMD_GET_VP_EXP_MODES
,
202 CPIA2_CMD_SET_VP_EXP_MODES
,
203 CPIA2_CMD_GET_DEVICE_CONFIG
,
204 CPIA2_CMD_SET_DEVICE_CONFIG
,
205 CPIA2_CMD_SET_SERIAL_ADDR
,
206 CPIA2_CMD_SET_SENSOR_CR1
,
207 CPIA2_CMD_GET_VC_CONTROL
,
208 CPIA2_CMD_SET_VC_CONTROL
,
209 CPIA2_CMD_SET_TARGET_KB
,
210 CPIA2_CMD_SET_DEF_JPEG_OPT
,
211 CPIA2_CMD_REHASH_VP4
,
212 CPIA2_CMD_GET_USER_EFFECTS
,
213 CPIA2_CMD_SET_USER_EFFECTS
217 COMMAND_NONE
= 0x00000001,
218 COMMAND_SET_FPS
= 0x00000002,
219 COMMAND_SET_COLOR_PARAMS
= 0x00000004,
220 COMMAND_GET_COLOR_PARAMS
= 0x00000008,
221 COMMAND_SET_FORMAT
= 0x00000010, /* size, etc */
222 COMMAND_SET_FLICKER
= 0x00000020
226 * Some defines specific to the 676 chip
228 #define CAMACC_CIF 0x01
229 #define CAMACC_VGA 0x02
230 #define CAMACC_QCIF 0x04
231 #define CAMACC_QVGA 0x08
234 struct cpia2_register
{
239 struct cpia2_reg_mask
{
246 struct cpia2_command
{
248 u8 req_mode
; /* (Block or random) | registerBank */
253 struct cpia2_register registers
[32];
254 struct cpia2_reg_mask masks
[16];
256 u8
*patch_data
; /* points to function defined block */
260 struct camera_params
{
262 u8 firmware_revision_hi
; /* For system register set (bank 0) */
263 u8 firmware_revision_lo
;
264 u8 asic_id
; /* Video Compressor set (bank 1) */
266 u8 vp_device_hi
; /* Video Processor set (bank 2) */
273 u32 device_type
; /* enumerated from vendor/product ids.
274 * Currently, either STV_672 or STV_676 */
281 u8 brightness
; /* CPIA2_VP_EXPOSURE_TARGET */
282 u8 contrast
; /* Note: this is CPIA2_VP_YRANGE */
283 u8 saturation
; /* CPIA2_VP_SATURATION */
288 u8 flicker_mode_req
; /* 1 if flicker on, else never flicker */
299 u8 ohsize
; /* output image size */
301 u8 hcrop
; /* cropping start_pos/4 */
303 u8 hphase
; /* scaling registers */
314 int width
; /* actual window width */
315 int height
; /* actual window height */
321 u8 video_size
; /* Not a register, just a convenience for cropped sizes */
326 u8 lowlight_boost
; /* Bool: 0 = off, 1 = on */
344 u8 stream_mode
; /* This is the current alternate for usb drivers */
357 struct timeval timestamp
;
362 volatile enum frame_status status
;
364 struct framebuf
*next
;
369 struct v4l2_device v4l2_dev
;
370 struct mutex v4l2_lock
; /* serialize file operations */
371 struct v4l2_ctrl_handler hdl
;
373 /* Lights control cluster */
374 struct v4l2_ctrl
*top_light
;
375 struct v4l2_ctrl
*bottom_light
;
377 struct v4l2_ctrl
*usb_alt
;
380 int first_image_seen
;
381 enum sensors sensor_type
;
383 struct v4l2_fh
*stream_fh
;
385 int streaming
; /* 0 = no, 1 = yes */
386 int xfer_mode
; /* XFER_BULK or XFER_ISOC */
387 struct camera_params params
; /* camera settings */
390 int video_size
; /* VIDEO_SIZE_ */
391 struct video_device vdev
; /* v4l videodev */
393 u32 height
; /* Its size */
394 __u32 pixelformat
; /* Format fourcc */
397 struct usb_device
*dev
;
399 unsigned int cur_alt
;
400 unsigned int old_alt
;
401 struct cpia2_sbuf sbuf
[NUM_SBUF
]; /* Double buffering */
403 wait_queue_head_t wq_stream
;
408 unsigned long frame_count
;
409 u8
*frame_buffer
; /* frame buffer data */
410 struct framebuf
*buffers
;
411 struct framebuf
* volatile curbuff
;
412 struct framebuf
*workbuff
;
414 /* MJPEG Extension */
415 int APPn
; /* Number of APP segment to be written, must be 0..15 */
416 int APP_len
; /* Length of data in JPEG APPn segment */
417 char APP_data
[60]; /* Data in the JPEG APPn segment. */
419 int COM_len
; /* Length of data in JPEG COM segment */
420 char COM_data
[60]; /* Data in JPEG COM segment */
424 int cpia2_register_camera(struct camera_data
*cam
);
425 void cpia2_unregister_camera(struct camera_data
*cam
);
426 void cpia2_camera_release(struct v4l2_device
*v4l2_dev
);
429 int cpia2_reset_camera(struct camera_data
*cam
);
430 int cpia2_set_low_power(struct camera_data
*cam
);
431 void cpia2_dbg_dump_registers(struct camera_data
*cam
);
432 int cpia2_match_video_size(int width
, int height
);
433 void cpia2_set_camera_state(struct camera_data
*cam
);
434 void cpia2_save_camera_state(struct camera_data
*cam
);
435 void cpia2_set_color_params(struct camera_data
*cam
);
436 void cpia2_set_brightness(struct camera_data
*cam
, unsigned char value
);
437 void cpia2_set_contrast(struct camera_data
*cam
, unsigned char value
);
438 void cpia2_set_saturation(struct camera_data
*cam
, unsigned char value
);
439 int cpia2_set_flicker_mode(struct camera_data
*cam
, int mode
);
440 void cpia2_set_format(struct camera_data
*cam
);
441 int cpia2_send_command(struct camera_data
*cam
, struct cpia2_command
*cmd
);
442 int cpia2_do_command(struct camera_data
*cam
,
443 unsigned int command
,
444 unsigned char direction
, unsigned char param
);
445 struct camera_data
*cpia2_init_camera_struct(struct usb_interface
*intf
);
446 int cpia2_init_camera(struct camera_data
*cam
);
447 int cpia2_allocate_buffers(struct camera_data
*cam
);
448 void cpia2_free_buffers(struct camera_data
*cam
);
449 long cpia2_read(struct camera_data
*cam
,
450 char __user
*buf
, unsigned long count
, int noblock
);
451 unsigned int cpia2_poll(struct camera_data
*cam
,
452 struct file
*filp
, poll_table
*wait
);
453 int cpia2_remap_buffer(struct camera_data
*cam
, struct vm_area_struct
*vma
);
454 void cpia2_set_property_flip(struct camera_data
*cam
, int prop_val
);
455 void cpia2_set_property_mirror(struct camera_data
*cam
, int prop_val
);
456 int cpia2_set_gpio(struct camera_data
*cam
, unsigned char setting
);
457 int cpia2_set_fps(struct camera_data
*cam
, int framerate
);
460 int cpia2_usb_init(void);
461 void cpia2_usb_cleanup(void);
462 int cpia2_usb_transfer_cmd(struct camera_data
*cam
, void *registers
,
463 u8 request
, u8 start
, u8 count
, u8 direction
);
464 int cpia2_usb_stream_start(struct camera_data
*cam
, unsigned int alternate
);
465 int cpia2_usb_stream_stop(struct camera_data
*cam
);
466 int cpia2_usb_stream_pause(struct camera_data
*cam
);
467 int cpia2_usb_stream_resume(struct camera_data
*cam
);
468 int cpia2_usb_change_streaming_alternate(struct camera_data
*cam
,
472 /* ----------------------- debug functions ---------------------- */
474 #define ALOG(lev, fmt, args...) printk(lev "%s:%d %s(): " fmt, __FILE__, __LINE__, __func__, ## args)
475 #define LOG(fmt, args...) ALOG(KERN_INFO, fmt, ## args)
476 #define ERR(fmt, args...) ALOG(KERN_ERR, fmt, ## args)
477 #define DBG(fmt, args...) ALOG(KERN_DEBUG, fmt, ## args)
479 #define ALOG(fmt,args...) printk(fmt,##args)
480 #define LOG(fmt,args...) ALOG(KERN_INFO "cpia2: "fmt,##args)
481 #define ERR(fmt,args...) ALOG(KERN_ERR "cpia2: "fmt,##args)
482 #define DBG(fmn,args...) do {} while(0)
484 /* No function or lineno, for shorter lines */
485 #define KINFO(fmt, args...) printk(KERN_INFO fmt,##args)