fimc-core.h 21.0 KB
Newer Older
1
/*
2
 * Copyright (C) 2010 - 2011 Samsung Electronics Co., Ltd.
3 4 5 6 7 8 9 10 11
 *
 * 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 FIMC_CORE_H_
#define FIMC_CORE_H_

12 13
/*#define DEBUG*/

14
#include <linux/platform_device.h>
15
#include <linux/sched.h>
16
#include <linux/spinlock.h>
17
#include <linux/types.h>
18
#include <linux/videodev2.h>
19
#include <linux/io.h>
20 21

#include <media/media-entity.h>
22
#include <media/videobuf2-core.h>
23 24
#include <media/v4l2-device.h>
#include <media/v4l2-mem2mem.h>
25
#include <media/v4l2-mediabus.h>
26
#include <media/s5p_fimc.h>
27

28 29 30 31 32 33
#include "regs-fimc.h"

#define err(fmt, args...) \
	printk(KERN_ERR "%s:%d: " fmt "\n", __func__, __LINE__, ##args)

#define dbg(fmt, args...) \
34
	pr_debug("%s:%d: " fmt "\n", __func__, __LINE__, ##args)
35

36 37
/* Time to wait for next frame VSYNC interrupt while stopping operation. */
#define FIMC_SHUTDOWN_TIMEOUT	((100*HZ)/1000)
38
#define MAX_FIMC_CLOCKS		2
39
#define MODULE_NAME		"s5p-fimc"
40
#define FIMC_MAX_DEVS		4
41 42 43
#define FIMC_MAX_OUT_BUFS	4
#define SCALER_MAX_HRATIO	64
#define SCALER_MAX_VRATIO	64
44
#define DMA_MIN_SIZE		8
45

46 47 48 49 50 51
/* indices to the clocks array */
enum {
	CLK_BUS,
	CLK_GATE,
};

52
enum fimc_dev_flags {
53 54 55
	ST_LPM,
	/* m2m node */
	ST_M2M_RUN,
56
	ST_M2M_PEND,
57 58 59
	ST_M2M_SUSPENDING,
	ST_M2M_SUSPENDED,
	/* capture node */
60 61 62 63
	ST_CAPT_PEND,
	ST_CAPT_RUN,
	ST_CAPT_STREAM,
	ST_CAPT_SHUT,
64
	ST_CAPT_BUSY,
65 66
};

67
#define fimc_m2m_active(dev) test_bit(ST_M2M_RUN, &(dev)->state)
68 69
#define fimc_m2m_pending(dev) test_bit(ST_M2M_PEND, &(dev)->state)

70 71
#define fimc_capture_running(dev) test_bit(ST_CAPT_RUN, &(dev)->state)
#define fimc_capture_pending(dev) test_bit(ST_CAPT_PEND, &(dev)->state)
72
#define fimc_capture_busy(dev) test_bit(ST_CAPT_BUSY, &(dev)->state)
73

74
enum fimc_datapath {
75
	FIMC_CAMERA,
76 77 78 79 80 81
	FIMC_DMA,
	FIMC_LCDFIFO,
	FIMC_WRITEBACK
};

enum fimc_color_fmt {
82
	S5P_FIMC_RGB565 = 0x10,
83 84
	S5P_FIMC_RGB666,
	S5P_FIMC_RGB888,
85 86
	S5P_FIMC_RGB30_LOCAL,
	S5P_FIMC_YCBCR420 = 0x20,
87 88 89 90 91 92 93
	S5P_FIMC_YCBYCR422,
	S5P_FIMC_YCRYCB422,
	S5P_FIMC_CBYCRY422,
	S5P_FIMC_CRYCBY422,
	S5P_FIMC_YCBCR444_LOCAL,
};

94 95
#define fimc_fmt_is_rgb(x) ((x) & 0x10)

96 97 98 99 100 101 102 103 104 105 106 107
/* Cb/Cr chrominance components order for 2 plane Y/CbCr 4:2:2 formats. */
#define	S5P_FIMC_LSB_CRCB	S5P_CIOCTRL_ORDER422_2P_LSB_CRCB

/* The embedded image effect selection */
#define	S5P_FIMC_EFFECT_ORIGINAL	S5P_CIIMGEFF_FIN_BYPASS
#define	S5P_FIMC_EFFECT_ARBITRARY	S5P_CIIMGEFF_FIN_ARBITRARY
#define	S5P_FIMC_EFFECT_NEGATIVE	S5P_CIIMGEFF_FIN_NEGATIVE
#define	S5P_FIMC_EFFECT_ARTFREEZE	S5P_CIIMGEFF_FIN_ARTFREEZE
#define	S5P_FIMC_EFFECT_EMBOSSING	S5P_CIIMGEFF_FIN_EMBOSSING
#define	S5P_FIMC_EFFECT_SIKHOUETTE	S5P_CIIMGEFF_FIN_SILHOUETTE

/* The hardware context state. */
108 109 110 111 112 113 114
#define	FIMC_PARAMS		(1 << 0)
#define	FIMC_SRC_ADDR		(1 << 1)
#define	FIMC_DST_ADDR		(1 << 2)
#define	FIMC_SRC_FMT		(1 << 3)
#define	FIMC_DST_FMT		(1 << 4)
#define	FIMC_CTX_M2M		(1 << 5)
#define	FIMC_CTX_CAP		(1 << 6)
115
#define	FIMC_CTX_SHUT		(1 << 7)
116 117 118 119 120 121 122 123

/* Image conversion flags */
#define	FIMC_IN_DMA_ACCESS_TILED	(1 << 0)
#define	FIMC_IN_DMA_ACCESS_LINEAR	(0 << 0)
#define	FIMC_OUT_DMA_ACCESS_TILED	(1 << 1)
#define	FIMC_OUT_DMA_ACCESS_LINEAR	(0 << 1)
#define	FIMC_SCAN_MODE_PROGRESSIVE	(0 << 2)
#define	FIMC_SCAN_MODE_INTERLACED	(1 << 2)
124 125 126
/*
 * YCbCr data dynamic range for RGB-YUV color conversion.
 * Y/Cb/Cr: (0 ~ 255) */
127 128 129 130 131 132 133 134 135 136 137
#define	FIMC_COLOR_RANGE_WIDE		(0 << 3)
/* Y (16 ~ 235), Cb/Cr (16 ~ 240) */
#define	FIMC_COLOR_RANGE_NARROW		(1 << 3)

#define	FLIP_NONE			0
#define	FLIP_X_AXIS			1
#define	FLIP_Y_AXIS			2
#define	FLIP_XY_AXIS			(FLIP_X_AXIS | FLIP_Y_AXIS)

/**
 * struct fimc_fmt - the driver's internal color format data
138
 * @mbus_code: Media Bus pixel code, -1 if not applicable
139
 * @name: format description
140
 * @fourcc: the fourcc code for this format, 0 if not applicable
141
 * @color: the corresponding fimc_color_fmt
142 143
 * @memplanes: number of physically non-contiguous data planes
 * @colplanes: number of physically contiguous data planes
144 145
 * @depth: per plane driver's private 'number of bits per pixel'
 * @flags: flags indicating which operation mode format applies to
146 147
 */
struct fimc_fmt {
148
	enum v4l2_mbus_pixelcode mbus_code;
149 150 151
	char	*name;
	u32	fourcc;
	u32	color;
152 153 154
	u16	memplanes;
	u16	colplanes;
	u8	depth[VIDEO_MAX_PLANES];
155 156 157
	u16	flags;
#define FMT_FLAGS_CAM	(1 << 0)
#define FMT_FLAGS_M2M	(1 << 1)
158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
};

/**
 * struct fimc_dma_offset - pixel offset information for DMA
 * @y_h:	y value horizontal offset
 * @y_v:	y value vertical offset
 * @cb_h:	cb value horizontal offset
 * @cb_v:	cb value vertical offset
 * @cr_h:	cr value horizontal offset
 * @cr_v:	cr value vertical offset
 */
struct fimc_dma_offset {
	int	y_h;
	int	y_v;
	int	cb_h;
	int	cb_v;
	int	cr_h;
	int	cr_v;
};

/**
179
 * struct fimc_effect - color effect information
180 181 182 183 184 185 186 187 188 189 190 191
 * @type:	effect type
 * @pat_cb:	cr value when type is "arbitrary"
 * @pat_cr:	cr value when type is "arbitrary"
 */
struct fimc_effect {
	u32	type;
	u8	pat_cb;
	u8	pat_cr;
};

/**
 * struct fimc_scaler - the configuration data for FIMC inetrnal scaler
192 193 194 195 196
 * @scaleup_h:		flag indicating scaling up horizontally
 * @scaleup_v:		flag indicating scaling up vertically
 * @copy_mode:		flag indicating transparent DMA transfer (no scaling
 *			and color format conversion)
 * @enabled:		flag indicating if the scaler is used
197 198 199 200 201 202 203 204
 * @hfactor:		horizontal shift factor
 * @vfactor:		vertical shift factor
 * @pre_hratio:		horizontal ratio of the prescaler
 * @pre_vratio:		vertical ratio of the prescaler
 * @pre_dst_width:	the prescaler's destination width
 * @pre_dst_height:	the prescaler's destination height
 * @main_hratio:	the main scaler's horizontal ratio
 * @main_vratio:	the main scaler's vertical ratio
205 206
 * @real_width:		source pixel (width - offset)
 * @real_height:	source pixel (height - offset)
207 208
 */
struct fimc_scaler {
209 210 211 212
	unsigned int scaleup_h:1;
	unsigned int scaleup_v:1;
	unsigned int copy_mode:1;
	unsigned int enabled:1;
213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
	u32	hfactor;
	u32	vfactor;
	u32	pre_hratio;
	u32	pre_vratio;
	u32	pre_dst_width;
	u32	pre_dst_height;
	u32	main_hratio;
	u32	main_vratio;
	u32	real_width;
	u32	real_height;
};

/**
 * struct fimc_addr - the FIMC physical address set for DMA
 * @y:	 luminance plane physical address
 * @cb:	 Cb plane physical address
 * @cr:	 Cr plane physical address
 */
struct fimc_addr {
	u32	y;
	u32	cb;
	u32	cr;
};

/**
 * struct fimc_vid_buffer - the driver's video buffer
239
 * @vb:    v4l videobuf buffer
240
 * @list:  linked list structure for buffer queue
241 242
 * @paddr: precalculated physical address set
 * @index: buffer index for the output DMA engine
243 244
 */
struct fimc_vid_buffer {
245 246
	struct vb2_buffer	vb;
	struct list_head	list;
247 248
	struct fimc_addr	paddr;
	int			index;
249 250 251
};

/**
252
 * struct fimc_frame - source/target frame properties
253 254 255 256 257 258 259 260
 * @f_width:	image full width (virtual screen size)
 * @f_height:	image full height (virtual screen size)
 * @o_width:	original image width as set by S_FMT
 * @o_height:	original image height as set by S_FMT
 * @offs_h:	image horizontal pixel offset
 * @offs_v:	image vertical pixel offset
 * @width:	image pixel width
 * @height:	image pixel weight
261
 * @payload:	image size in bytes (w x h x bpp)
262
 * @paddr:	image frame buffer physical addresses
263
 * @dma_offset:	DMA offset in bytes
264
 * @fmt:	fimc color format pointer
265 266 267 268 269 270 271 272 273 274
 */
struct fimc_frame {
	u32	f_width;
	u32	f_height;
	u32	o_width;
	u32	o_height;
	u32	offs_h;
	u32	offs_v;
	u32	width;
	u32	height;
275
	unsigned long		payload[VIDEO_MAX_PLANES];
276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296
	struct fimc_addr	paddr;
	struct fimc_dma_offset	dma_offset;
	struct fimc_fmt		*fmt;
};

/**
 * struct fimc_m2m_device - v4l2 memory-to-memory device data
 * @vfd: the video device node for v4l2 m2m mode
 * @v4l2_dev: v4l2 device for m2m mode
 * @m2m_dev: v4l2 memory-to-memory device data
 * @ctx: hardware context data
 * @refcnt: the reference counter
 */
struct fimc_m2m_device {
	struct video_device	*vfd;
	struct v4l2_device	v4l2_dev;
	struct v4l2_m2m_dev	*m2m_dev;
	struct fimc_ctx		*ctx;
	int			refcnt;
};

297 298 299 300 301 302
/**
 * struct fimc_vid_cap - camera capture device information
 * @ctx: hardware context data
 * @vfd: video device node for camera capture mode
 * @v4l2_dev: v4l2_device struct to manage subdevs
 * @sd: pointer to camera sensor subdevice currently in use
303
 * @vd_pad: fimc video capture node pad
304 305 306 307 308 309 310 311 312 313 314 315 316
 * @fmt: Media Bus format configured at selected image sensor
 * @pending_buf_q: the pending buffer queue head
 * @active_buf_q: the queue head of buffers scheduled in hardware
 * @vbq: the capture am video buffer queue
 * @active_buf_cnt: number of video buffers scheduled in hardware
 * @buf_index: index for managing the output DMA buffers
 * @frame_count: the frame counter for statistics
 * @reqbufs_count: the number of buffers requested in REQBUFS ioctl
 * @input_index: input (camera sensor) index
 * @refcnt: driver's private reference counter
 */
struct fimc_vid_cap {
	struct fimc_ctx			*ctx;
317
	struct vb2_alloc_ctx		*alloc_ctx;
318 319
	struct video_device		*vfd;
	struct v4l2_device		v4l2_dev;
320
	struct v4l2_subdev		*sd;;
321
	struct media_pad		vd_pad;
322 323 324
	struct v4l2_mbus_framefmt	fmt;
	struct list_head		pending_buf_q;
	struct list_head		active_buf_q;
325
	struct vb2_queue		vbq;
326 327 328 329 330 331 332 333
	int				active_buf_cnt;
	int				buf_index;
	unsigned int			frame_count;
	unsigned int			reqbufs_count;
	int				input_index;
	int				refcnt;
};

334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352
/**
 *  struct fimc_pix_limit - image pixel size limits in various IP configurations
 *
 *  @scaler_en_w: max input pixel width when the scaler is enabled
 *  @scaler_dis_w: max input pixel width when the scaler is disabled
 *  @in_rot_en_h: max input width with the input rotator is on
 *  @in_rot_dis_w: max input width with the input rotator is off
 *  @out_rot_en_w: max output width with the output rotator on
 *  @out_rot_dis_w: max output width with the output rotator off
 */
struct fimc_pix_limit {
	u16 scaler_en_w;
	u16 scaler_dis_w;
	u16 in_rot_en_h;
	u16 in_rot_dis_w;
	u16 out_rot_en_w;
	u16 out_rot_dis_w;
};

353 354 355 356 357 358
/**
 * struct samsung_fimc_variant - camera interface variant information
 *
 * @pix_hoff: indicate whether horizontal offset is in pixels or in bytes
 * @has_inp_rot: set if has input rotator
 * @has_out_rot: set if has output rotator
359
 * @has_cistatus2: 1 if CISTATUS2 register is present in this IP revision
360 361
 * @has_mainscaler_ext: 1 if extended mainscaler ratios in CIEXTEN register
 *			 are present in this IP revision
362
 * @pix_limit: pixel size constraints for the scaler
363 364
 * @min_inp_pixsize: minimum input pixel size
 * @min_out_pixsize: minimum output pixel size
365 366
 * @hor_offs_align: horizontal pixel offset aligment
 * @out_buf_count: the number of buffers in output DMA sequence
367 368 369 370 371
 */
struct samsung_fimc_variant {
	unsigned int	pix_hoff:1;
	unsigned int	has_inp_rot:1;
	unsigned int	has_out_rot:1;
372
	unsigned int	has_cistatus2:1;
373
	unsigned int	has_mainscaler_ext:1;
374
	struct fimc_pix_limit *pix_limit;
375 376
	u16		min_inp_pixsize;
	u16		min_out_pixsize;
377 378
	u16		hor_offs_align;
	u16		out_buf_count;
379 380 381
};

/**
382
 * struct samsung_fimc_driverdata - per device type driver data for init time.
383 384 385
 *
 * @variant: the variant information for this driver.
 * @dev_cnt: number of fimc sub-devices available in SoC
386
 * @lclk_frequency: fimc bus clock frequency
387 388 389
 */
struct samsung_fimc_driverdata {
	struct samsung_fimc_variant *variant[FIMC_MAX_DEVS];
390
	unsigned long	lclk_frequency;
391
	int		num_entities;
392 393 394 395 396
};

struct fimc_ctx;

/**
397
 * struct fimc_dev - abstraction for FIMC entity
398 399 400
 * @slock:	the spinlock protecting this data structure
 * @lock:	the mutex protecting this data structure
 * @pdev:	pointer to the FIMC platform device
401
 * @pdata:	pointer to the device platform data
402
 * @variant:	the IP variant information
403 404
 * @id:		FIMC device index (0..FIMC_MAX_DEVS)
 * @num_clocks: the number of clocks managed by this device instance
405
 * @clock:	clocks required for FIMC operation
406 407
 * @regs:	the mapped hardware registers
 * @regs_res:	the resource claimed for IO registers
408 409
 * @irq:	FIMC interrupt number
 * @irq_queue:	interrupt handler waitqueue
410
 * @m2m:	memory-to-memory V4L2 device information
411 412
 * @vid_cap:	camera capture device information
 * @state:	flags used to synchronize m2m and capture mode operation
413
 * @alloc_ctx:	videobuf2 memory allocator context
414 415 416 417 418
 */
struct fimc_dev {
	spinlock_t			slock;
	struct mutex			lock;
	struct platform_device		*pdev;
419
	struct s5p_platform_fimc	*pdata;
420
	struct samsung_fimc_variant	*variant;
421 422 423
	u16				id;
	u16				num_clocks;
	struct clk			*clock[MAX_FIMC_CLOCKS];
424 425 426
	void __iomem			*regs;
	struct resource			*regs_res;
	int				irq;
427
	wait_queue_head_t		irq_queue;
428
	struct fimc_m2m_device		m2m;
429
	struct fimc_vid_cap		vid_cap;
430
	unsigned long			state;
431
	struct vb2_alloc_ctx		*alloc_ctx;
432 433 434 435
};

/**
 * fimc_ctx - the device context data
436
 * @slock:		spinlock protecting this data structure
437 438 439 440 441 442 443 444 445 446 447 448
 * @s_frame:		source frame properties
 * @d_frame:		destination frame properties
 * @out_order_1p:	output 1-plane YCBCR order
 * @out_order_2p:	output 2-plane YCBCR order
 * @in_order_1p		input 1-plane YCBCR order
 * @in_order_2p:	input 2-plane YCBCR order
 * @in_path:		input mode (DMA or camera)
 * @out_path:		output mode (DMA or FIFO)
 * @scaler:		image scaler properties
 * @effect:		image effect
 * @rotation:		image clockwise rotation in degrees
 * @flip:		image flip mode
449
 * @flags:		additional flags for image conversion
450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473
 * @state:		flags to keep track of user configuration
 * @fimc_dev:		the FIMC device this context applies to
 * @m2m_ctx:		memory-to-memory device context
 */
struct fimc_ctx {
	spinlock_t		slock;
	struct fimc_frame	s_frame;
	struct fimc_frame	d_frame;
	u32			out_order_1p;
	u32			out_order_2p;
	u32			in_order_1p;
	u32			in_order_2p;
	enum fimc_datapath	in_path;
	enum fimc_datapath	out_path;
	struct fimc_scaler	scaler;
	struct fimc_effect	effect;
	int			rotation;
	u32			flip;
	u32			flags;
	u32			state;
	struct fimc_dev		*fimc_dev;
	struct v4l2_m2m_ctx	*m2m_ctx;
};

474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505
static inline bool fimc_capture_active(struct fimc_dev *fimc)
{
	unsigned long flags;
	bool ret;

	spin_lock_irqsave(&fimc->slock, flags);
	ret = !!(fimc->state & (1 << ST_CAPT_RUN) ||
		 fimc->state & (1 << ST_CAPT_PEND));
	spin_unlock_irqrestore(&fimc->slock, flags);
	return ret;
}

static inline void fimc_ctx_state_lock_set(u32 state, struct fimc_ctx *ctx)
{
	unsigned long flags;

	spin_lock_irqsave(&ctx->slock, flags);
	ctx->state |= state;
	spin_unlock_irqrestore(&ctx->slock, flags);
}

static inline bool fimc_ctx_state_is_set(u32 mask, struct fimc_ctx *ctx)
{
	unsigned long flags;
	bool ret;

	spin_lock_irqsave(&ctx->slock, flags);
	ret = (ctx->state & mask) == mask;
	spin_unlock_irqrestore(&ctx->slock, flags);
	return ret;
}

506 507
static inline int tiled_fmt(struct fimc_fmt *fmt)
{
508
	return fmt->fourcc == V4L2_PIX_FMT_NV12MT;
509 510 511 512 513 514 515 516 517
}

static inline void fimc_hw_clear_irq(struct fimc_dev *dev)
{
	u32 cfg = readl(dev->regs + S5P_CIGCTRL);
	cfg |= S5P_CIGCTRL_IRQ_CLR;
	writel(cfg, dev->regs + S5P_CIGCTRL);
}

518
static inline void fimc_hw_enable_scaler(struct fimc_dev *dev, bool on)
519 520
{
	u32 cfg = readl(dev->regs + S5P_CISCCTRL);
521 522 523 524
	if (on)
		cfg |= S5P_CISCCTRL_SCALERSTART;
	else
		cfg &= ~S5P_CISCCTRL_SCALERSTART;
525 526 527
	writel(cfg, dev->regs + S5P_CISCCTRL);
}

528
static inline void fimc_hw_activate_input_dma(struct fimc_dev *dev, bool on)
529
{
530 531 532 533 534 535
	u32 cfg = readl(dev->regs + S5P_MSCTRL);
	if (on)
		cfg |= S5P_MSCTRL_ENVID;
	else
		cfg &= ~S5P_MSCTRL_ENVID;
	writel(cfg, dev->regs + S5P_MSCTRL);
536 537 538 539 540 541 542 543 544
}

static inline void fimc_hw_dis_capture(struct fimc_dev *dev)
{
	u32 cfg = readl(dev->regs + S5P_CIIMGCPT);
	cfg &= ~(S5P_CIIMGCPT_IMGCPTEN | S5P_CIIMGCPT_IMGCPTEN_SC);
	writel(cfg, dev->regs + S5P_CIIMGCPT);
}

545 546 547 548 549 550 551 552 553 554 555 556 557 558
/**
 * fimc_hw_set_dma_seq - configure output DMA buffer sequence
 * @mask: each bit corresponds to one of 32 output buffer registers set
 *	  1 to include buffer in the sequence, 0 to disable
 *
 * This function mask output DMA ring buffers, i.e. it allows to configure
 * which of the output buffer address registers will be used by the DMA
 * engine.
 */
static inline void fimc_hw_set_dma_seq(struct fimc_dev *dev, u32 mask)
{
	writel(mask, dev->regs + S5P_CIFCNTSEQ);
}

559 560
static inline struct fimc_frame *ctx_get_frame(struct fimc_ctx *ctx,
					       enum v4l2_buf_type type)
561 562 563
{
	struct fimc_frame *frame;

564
	if (V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE == type) {
565
		if (fimc_ctx_state_is_set(FIMC_CTX_M2M, ctx))
566 567 568
			frame = &ctx->s_frame;
		else
			return ERR_PTR(-EINVAL);
569
	} else if (V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE == type) {
570 571 572 573 574 575 576 577 578 579
		frame = &ctx->d_frame;
	} else {
		v4l2_err(&ctx->fimc_dev->m2m.v4l2_dev,
			"Wrong buffer/video queue type (%d)\n", type);
		return ERR_PTR(-EINVAL);
	}

	return frame;
}

580
/* Return an index to the buffer actually being written. */
581 582
static inline u32 fimc_hw_get_frame_index(struct fimc_dev *dev)
{
583 584 585 586 587 588 589 590 591 592
	u32 reg;

	if (dev->variant->has_cistatus2) {
		reg = readl(dev->regs + S5P_CISTATUS2) & 0x3F;
		return reg > 0 ? --reg : reg;
	} else {
		reg = readl(dev->regs + S5P_CISTATUS);
		return (reg & S5P_CISTATUS_FRAMECNT_MASK) >>
			S5P_CISTATUS_FRAMECNT_SHIFT;
	}
593 594
}

595 596
/* -----------------------------------------------------*/
/* fimc-reg.c						*/
597
void fimc_hw_reset(struct fimc_dev *fimc);
598 599 600
void fimc_hw_set_rotation(struct fimc_ctx *ctx);
void fimc_hw_set_target_format(struct fimc_ctx *ctx);
void fimc_hw_set_out_dma(struct fimc_ctx *ctx);
601 602
void fimc_hw_en_lastirq(struct fimc_dev *fimc, int enable);
void fimc_hw_en_irq(struct fimc_dev *fimc, int enable);
603 604
void fimc_hw_set_prescaler(struct fimc_ctx *ctx);
void fimc_hw_set_mainscaler(struct fimc_ctx *ctx);
605 606 607 608 609
void fimc_hw_en_capture(struct fimc_ctx *ctx);
void fimc_hw_set_effect(struct fimc_ctx *ctx);
void fimc_hw_set_in_dma(struct fimc_ctx *ctx);
void fimc_hw_set_input_path(struct fimc_ctx *ctx);
void fimc_hw_set_output_path(struct fimc_ctx *ctx);
610 611
void fimc_hw_set_input_addr(struct fimc_dev *fimc, struct fimc_addr *paddr);
void fimc_hw_set_output_addr(struct fimc_dev *fimc, struct fimc_addr *paddr,
612
			     int index);
613
int fimc_hw_set_camera_source(struct fimc_dev *fimc,
614
			      struct s5p_fimc_isp_info *cam);
615 616
int fimc_hw_set_camera_offset(struct fimc_dev *fimc, struct fimc_frame *f);
int fimc_hw_set_camera_polarity(struct fimc_dev *fimc,
617
				struct s5p_fimc_isp_info *cam);
618
int fimc_hw_set_camera_type(struct fimc_dev *fimc,
619
			    struct s5p_fimc_isp_info *cam);
620 621 622

/* -----------------------------------------------------*/
/* fimc-core.c */
623 624 625 626 627 628
int fimc_vidioc_enum_fmt_mplane(struct file *file, void *priv,
				struct v4l2_fmtdesc *f);
int fimc_vidioc_g_fmt_mplane(struct file *file, void *priv,
			     struct v4l2_format *f);
int fimc_vidioc_try_fmt_mplane(struct file *file, void *priv,
			       struct v4l2_format *f);
629 630 631 632 633 634 635 636 637 638 639 640 641
int fimc_vidioc_queryctrl(struct file *file, void *priv,
			  struct v4l2_queryctrl *qc);
int fimc_vidioc_g_ctrl(struct file *file, void *priv,
		       struct v4l2_control *ctrl);

int fimc_try_crop(struct fimc_ctx *ctx, struct v4l2_crop *cr);
int check_ctrl_val(struct fimc_ctx *ctx,  struct v4l2_control *ctrl);
int fimc_s_ctrl(struct fimc_ctx *ctx, struct v4l2_control *ctrl);

struct fimc_fmt *find_format(struct v4l2_format *f, unsigned int mask);
struct fimc_fmt *find_mbus_format(struct v4l2_mbus_framefmt *f,
				  unsigned int mask);

642
int fimc_check_scaler_ratio(int sw, int sh, int dw, int dh, int rot);
643 644
int fimc_set_scaler_info(struct fimc_ctx *ctx);
int fimc_prepare_config(struct fimc_ctx *ctx, u32 flags);
645
int fimc_prepare_addr(struct fimc_ctx *ctx, struct vb2_buffer *vb,
646
		      struct fimc_frame *frame, struct fimc_addr *paddr);
647
int fimc_register_m2m_device(struct fimc_dev *fimc);
648 649 650 651 652 653 654

/* -----------------------------------------------------*/
/* fimc-capture.c					*/
int fimc_register_capture_device(struct fimc_dev *fimc);
void fimc_unregister_capture_device(struct fimc_dev *fimc);
int fimc_vid_cap_buf_queue(struct fimc_dev *fimc,
			     struct fimc_vid_buffer *fimc_vb);
655 656
int fimc_capture_suspend(struct fimc_dev *fimc);
int fimc_capture_resume(struct fimc_dev *fimc);
657 658 659 660 661 662 663 664 665 666 667 668 669 670 671

/* Locking: the caller holds fimc->slock */
static inline void fimc_activate_capture(struct fimc_ctx *ctx)
{
	fimc_hw_enable_scaler(ctx->fimc_dev, ctx->scaler.enabled);
	fimc_hw_en_capture(ctx);
}

static inline void fimc_deactivate_capture(struct fimc_dev *fimc)
{
	fimc_hw_en_lastirq(fimc, true);
	fimc_hw_dis_capture(fimc);
	fimc_hw_enable_scaler(fimc, false);
	fimc_hw_en_lastirq(fimc, false);
}
672

673
/*
674 675
 * Add buf to the capture active buffers queue.
 * Locking: Need to be called with fimc_dev::slock held.
676 677
 */
static inline void active_queue_add(struct fimc_vid_cap *vid_cap,
678
				    struct fimc_vid_buffer *buf)
679
{
680
	list_add_tail(&buf->list, &vid_cap->active_buf_q);
681 682 683 684 685
	vid_cap->active_buf_cnt++;
}

/*
 * Pop a video buffer from the capture active buffers queue
686
 * Locking: Need to be called with fimc_dev::slock held.
687 688 689 690 691 692
 */
static inline struct fimc_vid_buffer *
active_queue_pop(struct fimc_vid_cap *vid_cap)
{
	struct fimc_vid_buffer *buf;
	buf = list_entry(vid_cap->active_buf_q.next,
693 694
			 struct fimc_vid_buffer, list);
	list_del(&buf->list);
695 696 697 698 699 700 701 702
	vid_cap->active_buf_cnt--;
	return buf;
}

/* Add video buffer to the capture pending buffers queue */
static inline void fimc_pending_queue_add(struct fimc_vid_cap *vid_cap,
					  struct fimc_vid_buffer *buf)
{
703
	list_add_tail(&buf->list, &vid_cap->pending_buf_q);
704 705 706 707 708 709 710 711
}

/* Add video buffer to the capture pending buffers queue */
static inline struct fimc_vid_buffer *
pending_queue_pop(struct fimc_vid_cap *vid_cap)
{
	struct fimc_vid_buffer *buf;
	buf = list_entry(vid_cap->pending_buf_q.next,
712 713
			struct fimc_vid_buffer, list);
	list_del(&buf->list);
714 715 716
	return buf;
}

717
#endif /* FIMC_CORE_H_ */