fimc-core.h 23.2 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
#include <media/v4l2-ctrls.h>
24 25
#include <media/v4l2-device.h>
#include <media/v4l2-mem2mem.h>
26
#include <media/v4l2-mediabus.h>
27
#include <media/s5p_fimc.h>
28

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

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

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

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

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

54
enum fimc_dev_flags {
55 56 57
	ST_LPM,
	/* m2m node */
	ST_M2M_RUN,
58
	ST_M2M_PEND,
59 60 61
	ST_M2M_SUSPENDING,
	ST_M2M_SUSPENDED,
	/* capture node */
62 63 64
	ST_CAPT_PEND,
	ST_CAPT_RUN,
	ST_CAPT_STREAM,
65
	ST_CAPT_ISP_STREAM,
66
	ST_CAPT_SHUT,
67
	ST_CAPT_BUSY,
68
	ST_CAPT_APPLY_CFG,
69
	ST_CAPT_JPEG,
70 71
};

72
#define fimc_m2m_active(dev) test_bit(ST_M2M_RUN, &(dev)->state)
73 74
#define fimc_m2m_pending(dev) test_bit(ST_M2M_PEND, &(dev)->state)

75 76
#define fimc_capture_running(dev) test_bit(ST_CAPT_RUN, &(dev)->state)
#define fimc_capture_pending(dev) test_bit(ST_CAPT_PEND, &(dev)->state)
77
#define fimc_capture_busy(dev) test_bit(ST_CAPT_BUSY, &(dev)->state)
78

79
enum fimc_datapath {
80
	FIMC_CAMERA,
81 82 83 84 85 86
	FIMC_DMA,
	FIMC_LCDFIFO,
	FIMC_WRITEBACK
};

enum fimc_color_fmt {
87
	S5P_FIMC_RGB565 = 0x10,
88 89
	S5P_FIMC_RGB666,
	S5P_FIMC_RGB888,
90 91
	S5P_FIMC_RGB30_LOCAL,
	S5P_FIMC_YCBCR420 = 0x20,
92 93 94 95 96
	S5P_FIMC_YCBYCR422,
	S5P_FIMC_YCRYCB422,
	S5P_FIMC_CBYCRY422,
	S5P_FIMC_CRYCBY422,
	S5P_FIMC_YCBCR444_LOCAL,
97
	S5P_FIMC_JPEG = 0x40,
98 99
};

100 101
#define fimc_fmt_is_rgb(x) (!!((x) & 0x10))
#define fimc_fmt_is_jpeg(x) (!!((x) & 0x40))
102

103 104 105
#define IS_M2M(__strt) ((__strt) == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE || \
			__strt == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)

106 107 108 109 110 111 112 113 114 115 116 117
/* 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. */
118 119 120 121 122
#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)
123 124 125 126
#define	FIMC_DST_CROP		(1 << 5)
#define	FIMC_CTX_M2M		(1 << 16)
#define	FIMC_CTX_CAP		(1 << 17)
#define	FIMC_CTX_SHUT		(1 << 18)
127 128 129 130 131 132 133 134

/* 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)
135 136 137
/*
 * YCbCr data dynamic range for RGB-YUV color conversion.
 * Y/Cb/Cr: (0 ~ 255) */
138 139 140 141 142 143
#define	FIMC_COLOR_RANGE_WIDE		(0 << 3)
/* Y (16 ~ 235), Cb/Cr (16 ~ 240) */
#define	FIMC_COLOR_RANGE_NARROW		(1 << 3)

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

/**
 * 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;
};

/**
185
 * struct fimc_effect - color effect information
186 187 188 189 190 191 192 193 194 195 196 197
 * @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
198 199 200 201 202
 * @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
203 204 205 206 207 208 209 210
 * @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
211 212
 * @real_width:		source pixel (width - offset)
 * @real_height:	source pixel (height - offset)
213 214
 */
struct fimc_scaler {
215 216 217 218
	unsigned int scaleup_h:1;
	unsigned int scaleup_v:1;
	unsigned int copy_mode:1;
	unsigned int enabled:1;
219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
	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
245
 * @vb:    v4l videobuf buffer
246
 * @list:  linked list structure for buffer queue
247 248
 * @paddr: precalculated physical address set
 * @index: buffer index for the output DMA engine
249 250
 */
struct fimc_vid_buffer {
251 252
	struct vb2_buffer	vb;
	struct list_head	list;
253 254
	struct fimc_addr	paddr;
	int			index;
255 256 257
};

/**
258
 * struct fimc_frame - source/target frame properties
259 260 261 262 263 264 265 266
 * @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
267
 * @payload:	image size in bytes (w x h x bpp)
268
 * @paddr:	image frame buffer physical addresses
269
 * @dma_offset:	DMA offset in bytes
270
 * @fmt:	fimc color format pointer
271 272 273 274 275 276 277 278 279 280
 */
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;
281
	unsigned long		payload[VIDEO_MAX_PLANES];
282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
	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
 * @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_m2m_dev	*m2m_dev;
	struct fimc_ctx		*ctx;
	int			refcnt;
};

301 302 303 304
#define FIMC_SD_PAD_SINK	0
#define FIMC_SD_PAD_SOURCE	1
#define FIMC_SD_PADS_NUM	2

305 306 307 308
/**
 * struct fimc_vid_cap - camera capture device information
 * @ctx: hardware context data
 * @vfd: video device node for camera capture mode
309
 * @subdev: subdev exposing the FIMC processing block
310
 * @vd_pad: fimc video capture node pad
311 312
 * @sd_pads: fimc video processing block pads
 * @mf: media bus format at the FIMC camera input (and the scaler output) pad
313 314 315 316 317 318 319 320 321
 * @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
322
 * @input: capture input type, grp_id of the attached subdev
323
 * @user_subdev_api: true if subdevs are not configured by the host driver
324 325 326
 */
struct fimc_vid_cap {
	struct fimc_ctx			*ctx;
327
	struct vb2_alloc_ctx		*alloc_ctx;
328
	struct video_device		*vfd;
329
	struct v4l2_subdev		*subdev;
330
	struct media_pad		vd_pad;
331 332
	struct v4l2_mbus_framefmt	mf;
	struct media_pad		sd_pads[FIMC_SD_PADS_NUM];
333 334
	struct list_head		pending_buf_q;
	struct list_head		active_buf_q;
335
	struct vb2_queue		vbq;
336 337 338 339 340 341
	int				active_buf_cnt;
	int				buf_index;
	unsigned int			frame_count;
	unsigned int			reqbufs_count;
	int				input_index;
	int				refcnt;
342
	u32				input;
343
	bool				user_subdev_api;
344 345
};

346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364
/**
 *  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;
};

365 366 367 368 369 370
/**
 * 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
371
 * @has_cistatus2: 1 if CISTATUS2 register is present in this IP revision
372 373
 * @has_mainscaler_ext: 1 if extended mainscaler ratios in CIEXTEN register
 *			 are present in this IP revision
374
 * @has_cam_if: set if this instance has a camera input interface
375
 * @pix_limit: pixel size constraints for the scaler
376 377
 * @min_inp_pixsize: minimum input pixel size
 * @min_out_pixsize: minimum output pixel size
378 379
 * @hor_offs_align: horizontal pixel offset aligment
 * @out_buf_count: the number of buffers in output DMA sequence
380 381 382 383 384
 */
struct samsung_fimc_variant {
	unsigned int	pix_hoff:1;
	unsigned int	has_inp_rot:1;
	unsigned int	has_out_rot:1;
385
	unsigned int	has_cistatus2:1;
386
	unsigned int	has_mainscaler_ext:1;
387
	unsigned int	has_cam_if:1;
388
	struct fimc_pix_limit *pix_limit;
389 390
	u16		min_inp_pixsize;
	u16		min_out_pixsize;
391 392
	u16		hor_offs_align;
	u16		out_buf_count;
393 394 395
};

/**
396
 * struct samsung_fimc_driverdata - per device type driver data for init time.
397 398 399
 *
 * @variant: the variant information for this driver.
 * @dev_cnt: number of fimc sub-devices available in SoC
400
 * @lclk_frequency: fimc bus clock frequency
401 402 403
 */
struct samsung_fimc_driverdata {
	struct samsung_fimc_variant *variant[FIMC_MAX_DEVS];
404
	unsigned long	lclk_frequency;
405
	int		num_entities;
406 407
};

408 409 410 411 412 413
struct fimc_pipeline {
	struct media_pipeline *pipe;
	struct v4l2_subdev *sensor;
	struct v4l2_subdev *csis;
};

414 415 416
struct fimc_ctx;

/**
417
 * struct fimc_dev - abstraction for FIMC entity
418 419 420
 * @slock:	the spinlock protecting this data structure
 * @lock:	the mutex protecting this data structure
 * @pdev:	pointer to the FIMC platform device
421
 * @pdata:	pointer to the device platform data
422
 * @variant:	the IP variant information
423 424
 * @id:		FIMC device index (0..FIMC_MAX_DEVS)
 * @num_clocks: the number of clocks managed by this device instance
425
 * @clock:	clocks required for FIMC operation
426 427
 * @regs:	the mapped hardware registers
 * @regs_res:	the resource claimed for IO registers
428 429
 * @irq:	FIMC interrupt number
 * @irq_queue:	interrupt handler waitqueue
430
 * @v4l2_dev:	root v4l2_device
431
 * @m2m:	memory-to-memory V4L2 device information
432 433
 * @vid_cap:	camera capture device information
 * @state:	flags used to synchronize m2m and capture mode operation
434
 * @alloc_ctx:	videobuf2 memory allocator context
435
 * @pipeline:	fimc video capture pipeline data structure
436 437 438 439 440
 */
struct fimc_dev {
	spinlock_t			slock;
	struct mutex			lock;
	struct platform_device		*pdev;
441
	struct s5p_platform_fimc	*pdata;
442
	struct samsung_fimc_variant	*variant;
443 444 445
	u16				id;
	u16				num_clocks;
	struct clk			*clock[MAX_FIMC_CLOCKS];
446 447 448
	void __iomem			*regs;
	struct resource			*regs_res;
	int				irq;
449
	wait_queue_head_t		irq_queue;
450
	struct v4l2_device		*v4l2_dev;
451
	struct fimc_m2m_device		m2m;
452
	struct fimc_vid_cap		vid_cap;
453
	unsigned long			state;
454
	struct vb2_alloc_ctx		*alloc_ctx;
455
	struct fimc_pipeline		pipeline;
456 457 458 459
};

/**
 * fimc_ctx - the device context data
460
 * @slock:		spinlock protecting this data structure
461 462 463 464 465 466 467 468 469 470 471
 * @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
472 473
 * @hflip:		indicates image horizontal flip if set
 * @vflip:		indicates image vertical flip if set
474
 * @flags:		additional flags for image conversion
475 476 477
 * @state:		flags to keep track of user configuration
 * @fimc_dev:		the FIMC device this context applies to
 * @m2m_ctx:		memory-to-memory device context
478
 * @fh:			v4l2 file handle
479 480 481 482 483
 * @ctrl_handler:	v4l2 controls handler
 * @ctrl_rotate		image rotation control
 * @ctrl_hflip		horizontal flip control
 * @ctrl_vflip		vartical flip control
 * @ctrls_rdy:		true if the control handler is initialized
484 485 486 487 488 489 490 491 492 493 494 495 496 497
 */
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;
498 499
	unsigned int		hflip:1;
	unsigned int		vflip:1;
500 501 502 503
	u32			flags;
	u32			state;
	struct fimc_dev		*fimc_dev;
	struct v4l2_m2m_ctx	*m2m_ctx;
504
	struct v4l2_fh		fh;
505 506 507 508 509
	struct v4l2_ctrl_handler ctrl_handler;
	struct v4l2_ctrl	*ctrl_rotate;
	struct v4l2_ctrl	*ctrl_hflip;
	struct v4l2_ctrl	*ctrl_vflip;
	bool			ctrls_rdy;
510 511
};

512 513
#define fh_to_ctx(__fh) container_of(__fh, struct fimc_ctx, fh)

514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540
static inline void set_frame_bounds(struct fimc_frame *f, u32 width, u32 height)
{
	f->o_width  = width;
	f->o_height = height;
	f->f_width  = width;
	f->f_height = height;
}

static inline void set_frame_crop(struct fimc_frame *f,
				  u32 left, u32 top, u32 width, u32 height)
{
	f->offs_h = left;
	f->offs_v = top;
	f->width  = width;
	f->height = height;
}

static inline u32 fimc_get_format_depth(struct fimc_fmt *ff)
{
	u32 i, depth = 0;

	if (ff != NULL)
		for (i = 0; i < ff->colplanes; i++)
			depth += ff->depth[i];
	return depth;
}

541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
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;
}

573 574
static inline int tiled_fmt(struct fimc_fmt *fmt)
{
575
	return fmt->fourcc == V4L2_PIX_FMT_NV12MT;
576 577 578 579 580 581 582 583 584
}

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);
}

585
static inline void fimc_hw_enable_scaler(struct fimc_dev *dev, bool on)
586 587
{
	u32 cfg = readl(dev->regs + S5P_CISCCTRL);
588 589 590 591
	if (on)
		cfg |= S5P_CISCCTRL_SCALERSTART;
	else
		cfg &= ~S5P_CISCCTRL_SCALERSTART;
592 593 594
	writel(cfg, dev->regs + S5P_CISCCTRL);
}

595
static inline void fimc_hw_activate_input_dma(struct fimc_dev *dev, bool on)
596
{
597 598 599 600 601 602
	u32 cfg = readl(dev->regs + S5P_MSCTRL);
	if (on)
		cfg |= S5P_MSCTRL_ENVID;
	else
		cfg &= ~S5P_MSCTRL_ENVID;
	writel(cfg, dev->regs + S5P_MSCTRL);
603 604 605 606 607 608 609 610 611
}

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);
}

612 613 614 615 616 617 618 619 620 621 622 623 624 625
/**
 * 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);
}

626 627
static inline struct fimc_frame *ctx_get_frame(struct fimc_ctx *ctx,
					       enum v4l2_buf_type type)
628 629 630
{
	struct fimc_frame *frame;

631
	if (V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE == type) {
632
		if (fimc_ctx_state_is_set(FIMC_CTX_M2M, ctx))
633 634 635
			frame = &ctx->s_frame;
		else
			return ERR_PTR(-EINVAL);
636
	} else if (V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE == type) {
637 638
		frame = &ctx->d_frame;
	} else {
639
		v4l2_err(ctx->fimc_dev->v4l2_dev,
640 641 642 643 644 645 646
			"Wrong buffer/video queue type (%d)\n", type);
		return ERR_PTR(-EINVAL);
	}

	return frame;
}

647
/* Return an index to the buffer actually being written. */
648 649
static inline u32 fimc_hw_get_frame_index(struct fimc_dev *dev)
{
650 651 652 653 654 655 656 657 658 659
	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;
	}
660 661
}

662 663
/* -----------------------------------------------------*/
/* fimc-reg.c						*/
664
void fimc_hw_reset(struct fimc_dev *fimc);
665 666 667
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);
668 669
void fimc_hw_en_lastirq(struct fimc_dev *fimc, int enable);
void fimc_hw_en_irq(struct fimc_dev *fimc, int enable);
670 671
void fimc_hw_set_prescaler(struct fimc_ctx *ctx);
void fimc_hw_set_mainscaler(struct fimc_ctx *ctx);
672
void fimc_hw_en_capture(struct fimc_ctx *ctx);
673
void fimc_hw_set_effect(struct fimc_ctx *ctx, bool active);
674 675 676
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);
677 678
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,
679
			     int index);
680
int fimc_hw_set_camera_source(struct fimc_dev *fimc,
681
			      struct s5p_fimc_isp_info *cam);
682 683
int fimc_hw_set_camera_offset(struct fimc_dev *fimc, struct fimc_frame *f);
int fimc_hw_set_camera_polarity(struct fimc_dev *fimc,
684
				struct s5p_fimc_isp_info *cam);
685
int fimc_hw_set_camera_type(struct fimc_dev *fimc,
686
			    struct s5p_fimc_isp_info *cam);
687 688 689

/* -----------------------------------------------------*/
/* fimc-core.c */
690 691
int fimc_vidioc_enum_fmt_mplane(struct file *file, void *priv,
				struct v4l2_fmtdesc *f);
692 693 694
int fimc_ctrls_create(struct fimc_ctx *ctx);
void fimc_ctrls_delete(struct fimc_ctx *ctx);
void fimc_ctrls_activate(struct fimc_ctx *ctx, bool active);
695
int fimc_fill_format(struct fimc_frame *frame, struct v4l2_format *f);
696 697
void fimc_adjust_mplane_format(struct fimc_fmt *fmt, u32 width, u32 height,
			       struct v4l2_pix_format_mplane *pix);
698 699
struct fimc_fmt *fimc_find_format(u32 *pixelformat, u32 *mbus_code,
				  unsigned int mask, int index);
700

701 702
int fimc_check_scaler_ratio(struct fimc_ctx *ctx, int sw, int sh,
			    int dw, int dh, int rotation);
703 704
int fimc_set_scaler_info(struct fimc_ctx *ctx);
int fimc_prepare_config(struct fimc_ctx *ctx, u32 flags);
705
int fimc_prepare_addr(struct fimc_ctx *ctx, struct vb2_buffer *vb,
706
		      struct fimc_frame *frame, struct fimc_addr *paddr);
707 708
void fimc_prepare_dma_offset(struct fimc_ctx *ctx, struct fimc_frame *f);
void fimc_set_yuv_order(struct fimc_ctx *ctx);
709
void fimc_fill_frame(struct fimc_frame *frame, struct v4l2_format *f);
710
void fimc_capture_irq_handler(struct fimc_dev *fimc, bool done);
711

712 713 714
int fimc_register_m2m_device(struct fimc_dev *fimc,
			     struct v4l2_device *v4l2_dev);
void fimc_unregister_m2m_device(struct fimc_dev *fimc);
715 716
int fimc_register_driver(void);
void fimc_unregister_driver(void);
717 718 719

/* -----------------------------------------------------*/
/* fimc-capture.c					*/
720 721
int fimc_register_capture_device(struct fimc_dev *fimc,
				 struct v4l2_device *v4l2_dev);
722
void fimc_unregister_capture_device(struct fimc_dev *fimc);
723
int fimc_capture_ctrls_create(struct fimc_dev *fimc);
724 725
int fimc_vid_cap_buf_queue(struct fimc_dev *fimc,
			     struct fimc_vid_buffer *fimc_vb);
726 727
int fimc_capture_suspend(struct fimc_dev *fimc);
int fimc_capture_resume(struct fimc_dev *fimc);
728
int fimc_capture_config_update(struct fimc_ctx *ctx);
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743

/* 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);
}
744

745
/*
746 747
 * Add buf to the capture active buffers queue.
 * Locking: Need to be called with fimc_dev::slock held.
748 749
 */
static inline void active_queue_add(struct fimc_vid_cap *vid_cap,
750
				    struct fimc_vid_buffer *buf)
751
{
752
	list_add_tail(&buf->list, &vid_cap->active_buf_q);
753 754 755 756 757
	vid_cap->active_buf_cnt++;
}

/*
 * Pop a video buffer from the capture active buffers queue
758
 * Locking: Need to be called with fimc_dev::slock held.
759 760 761 762 763 764
 */
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,
765 766
			 struct fimc_vid_buffer, list);
	list_del(&buf->list);
767 768 769 770 771 772 773 774
	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)
{
775
	list_add_tail(&buf->list, &vid_cap->pending_buf_q);
776 777 778 779 780 781 782 783
}

/* 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,
784 785
			struct fimc_vid_buffer, list);
	list_del(&buf->list);
786 787 788
	return buf;
}

789
#endif /* FIMC_CORE_H_ */