Commit | Line | Data |
---|---|---|
bdc621fc JK |
1 | /* |
2 | * V4L2 SoC Camera driver for OMAP1 Camera Interface | |
3 | * | |
4 | * Copyright (C) 2010, Janusz Krzysztofik <jkrzyszt@tis.icnet.pl> | |
5 | * | |
6 | * Based on V4L2 Driver for i.MXL/i.MXL camera (CSI) host | |
7 | * Copyright (C) 2008, Paulius Zaleckas <paulius.zaleckas@teltonika.lt> | |
8 | * Copyright (C) 2009, Darius Augulis <augulis.darius@gmail.com> | |
9 | * | |
10 | * Based on PXA SoC camera driver | |
11 | * Copyright (C) 2006, Sascha Hauer, Pengutronix | |
12 | * Copyright (C) 2008, Guennadi Liakhovetski <kernel@pengutronix.de> | |
13 | * | |
14 | * Hardware specific bits initialy based on former work by Matt Callow | |
2c3fb08b | 15 | * drivers/media/platform/omap/omap1510cam.c |
bdc621fc JK |
16 | * Copyright (C) 2006 Matt Callow |
17 | * | |
18 | * This program is free software; you can redistribute it and/or modify | |
19 | * it under the terms of the GNU General Public License version 2 as | |
20 | * published by the Free Software Foundation. | |
21 | */ | |
22 | ||
23 | ||
24 | #include <linux/clk.h> | |
25 | #include <linux/dma-mapping.h> | |
26 | #include <linux/interrupt.h> | |
d95d7b91 | 27 | #include <linux/module.h> |
bdc621fc JK |
28 | #include <linux/platform_device.h> |
29 | #include <linux/slab.h> | |
bdc621fc | 30 | |
eb4b0ec7 | 31 | #include <linux/platform_data/media/omap1_camera.h> |
bdc621fc | 32 | #include <media/soc_camera.h> |
d647f0b7 | 33 | #include <media/drv-intf/soc_mediabus.h> |
bdc621fc JK |
34 | #include <media/videobuf-dma-contig.h> |
35 | #include <media/videobuf-dma-sg.h> | |
36 | ||
45c3eb7d | 37 | #include <linux/omap-dma.h> |
bdc621fc JK |
38 | |
39 | ||
40 | #define DRIVER_NAME "omap1-camera" | |
64dc3c1a | 41 | #define DRIVER_VERSION "0.0.2" |
bdc621fc | 42 | |
8c4cc005 | 43 | #define OMAP_DMA_CAMERA_IF_RX 20 |
bdc621fc JK |
44 | |
45 | /* | |
46 | * --------------------------------------------------------------------------- | |
47 | * OMAP1 Camera Interface registers | |
48 | * --------------------------------------------------------------------------- | |
49 | */ | |
50 | ||
51 | #define REG_CTRLCLOCK 0x00 | |
52 | #define REG_IT_STATUS 0x04 | |
53 | #define REG_MODE 0x08 | |
54 | #define REG_STATUS 0x0C | |
55 | #define REG_CAMDATA 0x10 | |
56 | #define REG_GPIO 0x14 | |
57 | #define REG_PEAK_COUNTER 0x18 | |
58 | ||
59 | /* CTRLCLOCK bit shifts */ | |
60 | #define LCLK_EN BIT(7) | |
61 | #define DPLL_EN BIT(6) | |
62 | #define MCLK_EN BIT(5) | |
63 | #define CAMEXCLK_EN BIT(4) | |
64 | #define POLCLK BIT(3) | |
65 | #define FOSCMOD_SHIFT 0 | |
66 | #define FOSCMOD_MASK (0x7 << FOSCMOD_SHIFT) | |
67 | #define FOSCMOD_12MHz 0x0 | |
68 | #define FOSCMOD_6MHz 0x2 | |
69 | #define FOSCMOD_9_6MHz 0x4 | |
70 | #define FOSCMOD_24MHz 0x5 | |
71 | #define FOSCMOD_8MHz 0x6 | |
72 | ||
73 | /* IT_STATUS bit shifts */ | |
74 | #define DATA_TRANSFER BIT(5) | |
75 | #define FIFO_FULL BIT(4) | |
76 | #define H_DOWN BIT(3) | |
77 | #define H_UP BIT(2) | |
78 | #define V_DOWN BIT(1) | |
79 | #define V_UP BIT(0) | |
80 | ||
81 | /* MODE bit shifts */ | |
82 | #define RAZ_FIFO BIT(18) | |
83 | #define EN_FIFO_FULL BIT(17) | |
84 | #define EN_NIRQ BIT(16) | |
85 | #define THRESHOLD_SHIFT 9 | |
86 | #define THRESHOLD_MASK (0x7f << THRESHOLD_SHIFT) | |
87 | #define DMA BIT(8) | |
88 | #define EN_H_DOWN BIT(7) | |
89 | #define EN_H_UP BIT(6) | |
90 | #define EN_V_DOWN BIT(5) | |
91 | #define EN_V_UP BIT(4) | |
92 | #define ORDERCAMD BIT(3) | |
93 | ||
94 | #define IRQ_MASK (EN_V_UP | EN_V_DOWN | EN_H_UP | EN_H_DOWN | \ | |
95 | EN_NIRQ | EN_FIFO_FULL) | |
96 | ||
97 | /* STATUS bit shifts */ | |
98 | #define HSTATUS BIT(1) | |
99 | #define VSTATUS BIT(0) | |
100 | ||
101 | /* GPIO bit shifts */ | |
102 | #define CAM_RST BIT(0) | |
103 | ||
104 | /* end of OMAP1 Camera Interface registers */ | |
105 | ||
106 | ||
92d2c339 GL |
107 | #define SOCAM_BUS_FLAGS (V4L2_MBUS_MASTER | \ |
108 | V4L2_MBUS_HSYNC_ACTIVE_HIGH | V4L2_MBUS_VSYNC_ACTIVE_HIGH | \ | |
109 | V4L2_MBUS_PCLK_SAMPLE_RISING | V4L2_MBUS_PCLK_SAMPLE_FALLING | \ | |
110 | V4L2_MBUS_DATA_ACTIVE_HIGH) | |
bdc621fc JK |
111 | |
112 | ||
113 | #define FIFO_SIZE ((THRESHOLD_MASK >> THRESHOLD_SHIFT) + 1) | |
114 | #define FIFO_SHIFT __fls(FIFO_SIZE) | |
115 | ||
116 | #define DMA_BURST_SHIFT (1 + OMAP_DMA_DATA_BURST_4) | |
117 | #define DMA_BURST_SIZE (1 << DMA_BURST_SHIFT) | |
118 | ||
119 | #define DMA_ELEMENT_SHIFT OMAP_DMA_DATA_TYPE_S32 | |
120 | #define DMA_ELEMENT_SIZE (1 << DMA_ELEMENT_SHIFT) | |
121 | ||
122 | #define DMA_FRAME_SHIFT_CONTIG (FIFO_SHIFT - 1) | |
123 | #define DMA_FRAME_SHIFT_SG DMA_BURST_SHIFT | |
124 | ||
125 | #define DMA_FRAME_SHIFT(x) ((x) == OMAP1_CAM_DMA_CONTIG ? \ | |
126 | DMA_FRAME_SHIFT_CONTIG : \ | |
127 | DMA_FRAME_SHIFT_SG) | |
128 | #define DMA_FRAME_SIZE(x) (1 << DMA_FRAME_SHIFT(x)) | |
129 | #define DMA_SYNC OMAP_DMA_SYNC_FRAME | |
130 | #define THRESHOLD_LEVEL DMA_FRAME_SIZE | |
131 | ||
132 | ||
133 | #define MAX_VIDEO_MEM 4 /* arbitrary video memory limit in MB */ | |
134 | ||
135 | ||
136 | /* | |
137 | * Structures | |
138 | */ | |
139 | ||
140 | /* buffer for one video frame */ | |
141 | struct omap1_cam_buf { | |
142 | struct videobuf_buffer vb; | |
27ffaeb0 | 143 | u32 code; |
bdc621fc JK |
144 | int inwork; |
145 | struct scatterlist *sgbuf; | |
146 | int sgcount; | |
147 | int bytes_left; | |
148 | enum videobuf_state result; | |
149 | }; | |
150 | ||
151 | struct omap1_cam_dev { | |
152 | struct soc_camera_host soc_host; | |
bdc621fc JK |
153 | struct clk *clk; |
154 | ||
155 | unsigned int irq; | |
156 | void __iomem *base; | |
157 | ||
158 | int dma_ch; | |
159 | ||
160 | struct omap1_cam_platform_data *pdata; | |
161 | struct resource *res; | |
162 | unsigned long pflags; | |
163 | unsigned long camexclk; | |
164 | ||
165 | struct list_head capture; | |
166 | ||
167 | /* lock used to protect videobuf */ | |
168 | spinlock_t lock; | |
169 | ||
170 | /* Pointers to DMA buffers */ | |
171 | struct omap1_cam_buf *active; | |
172 | struct omap1_cam_buf *ready; | |
173 | ||
174 | enum omap1_cam_vb_mode vb_mode; | |
175 | int (*mmap_mapper)(struct videobuf_queue *q, | |
176 | struct videobuf_buffer *buf, | |
177 | struct vm_area_struct *vma); | |
178 | ||
179 | u32 reg_cache[0]; | |
180 | }; | |
181 | ||
182 | ||
183 | static void cam_write(struct omap1_cam_dev *pcdev, u16 reg, u32 val) | |
184 | { | |
185 | pcdev->reg_cache[reg / sizeof(u32)] = val; | |
186 | __raw_writel(val, pcdev->base + reg); | |
187 | } | |
188 | ||
189 | static u32 cam_read(struct omap1_cam_dev *pcdev, u16 reg, bool from_cache) | |
190 | { | |
191 | return !from_cache ? __raw_readl(pcdev->base + reg) : | |
192 | pcdev->reg_cache[reg / sizeof(u32)]; | |
193 | } | |
194 | ||
195 | #define CAM_READ(pcdev, reg) \ | |
196 | cam_read(pcdev, REG_##reg, false) | |
197 | #define CAM_WRITE(pcdev, reg, val) \ | |
198 | cam_write(pcdev, REG_##reg, val) | |
199 | #define CAM_READ_CACHE(pcdev, reg) \ | |
200 | cam_read(pcdev, REG_##reg, true) | |
201 | ||
202 | /* | |
203 | * Videobuf operations | |
204 | */ | |
205 | static int omap1_videobuf_setup(struct videobuf_queue *vq, unsigned int *count, | |
206 | unsigned int *size) | |
207 | { | |
208 | struct soc_camera_device *icd = vq->priv_data; | |
7dfff953 | 209 | struct soc_camera_host *ici = to_soc_camera_host(icd->parent); |
bdc621fc JK |
210 | struct omap1_cam_dev *pcdev = ici->priv; |
211 | ||
2b61d46e | 212 | *size = icd->sizeimage; |
bdc621fc JK |
213 | |
214 | if (!*count || *count < OMAP1_CAMERA_MIN_BUF_COUNT(pcdev->vb_mode)) | |
215 | *count = OMAP1_CAMERA_MIN_BUF_COUNT(pcdev->vb_mode); | |
216 | ||
217 | if (*size * *count > MAX_VIDEO_MEM * 1024 * 1024) | |
218 | *count = (MAX_VIDEO_MEM * 1024 * 1024) / *size; | |
219 | ||
7dfff953 | 220 | dev_dbg(icd->parent, |
bdc621fc JK |
221 | "%s: count=%d, size=%d\n", __func__, *count, *size); |
222 | ||
223 | return 0; | |
224 | } | |
225 | ||
226 | static void free_buffer(struct videobuf_queue *vq, struct omap1_cam_buf *buf, | |
227 | enum omap1_cam_vb_mode vb_mode) | |
228 | { | |
229 | struct videobuf_buffer *vb = &buf->vb; | |
230 | ||
231 | BUG_ON(in_interrupt()); | |
232 | ||
8c66caeb | 233 | videobuf_waiton(vq, vb, 0, 0); |
bdc621fc JK |
234 | |
235 | if (vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
236 | videobuf_dma_contig_free(vq, vb); | |
237 | } else { | |
238 | struct soc_camera_device *icd = vq->priv_data; | |
7dfff953 | 239 | struct device *dev = icd->parent; |
bdc621fc JK |
240 | struct videobuf_dmabuf *dma = videobuf_to_dma(vb); |
241 | ||
242 | videobuf_dma_unmap(dev, dma); | |
243 | videobuf_dma_free(dma); | |
244 | } | |
245 | ||
246 | vb->state = VIDEOBUF_NEEDS_INIT; | |
247 | } | |
248 | ||
249 | static int omap1_videobuf_prepare(struct videobuf_queue *vq, | |
250 | struct videobuf_buffer *vb, enum v4l2_field field) | |
251 | { | |
252 | struct soc_camera_device *icd = vq->priv_data; | |
253 | struct omap1_cam_buf *buf = container_of(vb, struct omap1_cam_buf, vb); | |
7dfff953 | 254 | struct soc_camera_host *ici = to_soc_camera_host(icd->parent); |
bdc621fc JK |
255 | struct omap1_cam_dev *pcdev = ici->priv; |
256 | int ret; | |
257 | ||
bdc621fc JK |
258 | WARN_ON(!list_empty(&vb->queue)); |
259 | ||
260 | BUG_ON(NULL == icd->current_fmt); | |
261 | ||
262 | buf->inwork = 1; | |
263 | ||
264 | if (buf->code != icd->current_fmt->code || vb->field != field || | |
265 | vb->width != icd->user_width || | |
266 | vb->height != icd->user_height) { | |
267 | buf->code = icd->current_fmt->code; | |
268 | vb->width = icd->user_width; | |
269 | vb->height = icd->user_height; | |
270 | vb->field = field; | |
271 | vb->state = VIDEOBUF_NEEDS_INIT; | |
272 | } | |
273 | ||
2b61d46e | 274 | vb->size = icd->sizeimage; |
bdc621fc JK |
275 | |
276 | if (vb->baddr && vb->bsize < vb->size) { | |
277 | ret = -EINVAL; | |
278 | goto out; | |
279 | } | |
280 | ||
281 | if (vb->state == VIDEOBUF_NEEDS_INIT) { | |
282 | ret = videobuf_iolock(vq, vb, NULL); | |
283 | if (ret) | |
284 | goto fail; | |
285 | ||
286 | vb->state = VIDEOBUF_PREPARED; | |
287 | } | |
288 | buf->inwork = 0; | |
289 | ||
290 | return 0; | |
291 | fail: | |
292 | free_buffer(vq, buf, pcdev->vb_mode); | |
293 | out: | |
294 | buf->inwork = 0; | |
295 | return ret; | |
296 | } | |
297 | ||
298 | static void set_dma_dest_params(int dma_ch, struct omap1_cam_buf *buf, | |
299 | enum omap1_cam_vb_mode vb_mode) | |
300 | { | |
301 | dma_addr_t dma_addr; | |
302 | unsigned int block_size; | |
303 | ||
304 | if (vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
305 | dma_addr = videobuf_to_dma_contig(&buf->vb); | |
306 | block_size = buf->vb.size; | |
307 | } else { | |
308 | if (WARN_ON(!buf->sgbuf)) { | |
309 | buf->result = VIDEOBUF_ERROR; | |
310 | return; | |
311 | } | |
312 | dma_addr = sg_dma_address(buf->sgbuf); | |
313 | if (WARN_ON(!dma_addr)) { | |
314 | buf->sgbuf = NULL; | |
315 | buf->result = VIDEOBUF_ERROR; | |
316 | return; | |
317 | } | |
318 | block_size = sg_dma_len(buf->sgbuf); | |
319 | if (WARN_ON(!block_size)) { | |
320 | buf->sgbuf = NULL; | |
321 | buf->result = VIDEOBUF_ERROR; | |
322 | return; | |
323 | } | |
324 | if (unlikely(buf->bytes_left < block_size)) | |
325 | block_size = buf->bytes_left; | |
326 | if (WARN_ON(dma_addr & (DMA_FRAME_SIZE(vb_mode) * | |
327 | DMA_ELEMENT_SIZE - 1))) { | |
328 | dma_addr = ALIGN(dma_addr, DMA_FRAME_SIZE(vb_mode) * | |
329 | DMA_ELEMENT_SIZE); | |
330 | block_size &= ~(DMA_FRAME_SIZE(vb_mode) * | |
331 | DMA_ELEMENT_SIZE - 1); | |
332 | } | |
333 | buf->bytes_left -= block_size; | |
334 | buf->sgcount++; | |
335 | } | |
336 | ||
337 | omap_set_dma_dest_params(dma_ch, | |
338 | OMAP_DMA_PORT_EMIFF, OMAP_DMA_AMODE_POST_INC, dma_addr, 0, 0); | |
339 | omap_set_dma_transfer_params(dma_ch, | |
340 | OMAP_DMA_DATA_TYPE_S32, DMA_FRAME_SIZE(vb_mode), | |
341 | block_size >> (DMA_FRAME_SHIFT(vb_mode) + DMA_ELEMENT_SHIFT), | |
342 | DMA_SYNC, 0, 0); | |
343 | } | |
344 | ||
345 | static struct omap1_cam_buf *prepare_next_vb(struct omap1_cam_dev *pcdev) | |
346 | { | |
347 | struct omap1_cam_buf *buf; | |
348 | ||
349 | /* | |
350 | * If there is already a buffer pointed out by the pcdev->ready, | |
351 | * (re)use it, otherwise try to fetch and configure a new one. | |
352 | */ | |
353 | buf = pcdev->ready; | |
354 | if (!buf) { | |
355 | if (list_empty(&pcdev->capture)) | |
356 | return buf; | |
357 | buf = list_entry(pcdev->capture.next, | |
358 | struct omap1_cam_buf, vb.queue); | |
359 | buf->vb.state = VIDEOBUF_ACTIVE; | |
360 | pcdev->ready = buf; | |
361 | list_del_init(&buf->vb.queue); | |
362 | } | |
363 | ||
364 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
365 | /* | |
366 | * In CONTIG mode, we can safely enter next buffer parameters | |
367 | * into the DMA programming register set after the DMA | |
368 | * has already been activated on the previous buffer | |
369 | */ | |
370 | set_dma_dest_params(pcdev->dma_ch, buf, pcdev->vb_mode); | |
371 | } else { | |
372 | /* | |
373 | * In SG mode, the above is not safe since there are probably | |
374 | * a bunch of sgbufs from previous sglist still pending. | |
375 | * Instead, mark the sglist fresh for the upcoming | |
376 | * try_next_sgbuf(). | |
377 | */ | |
378 | buf->sgbuf = NULL; | |
379 | } | |
380 | ||
381 | return buf; | |
382 | } | |
383 | ||
384 | static struct scatterlist *try_next_sgbuf(int dma_ch, struct omap1_cam_buf *buf) | |
385 | { | |
386 | struct scatterlist *sgbuf; | |
387 | ||
388 | if (likely(buf->sgbuf)) { | |
389 | /* current sglist is active */ | |
390 | if (unlikely(!buf->bytes_left)) { | |
391 | /* indicate sglist complete */ | |
392 | sgbuf = NULL; | |
393 | } else { | |
394 | /* process next sgbuf */ | |
395 | sgbuf = sg_next(buf->sgbuf); | |
396 | if (WARN_ON(!sgbuf)) { | |
397 | buf->result = VIDEOBUF_ERROR; | |
398 | } else if (WARN_ON(!sg_dma_len(sgbuf))) { | |
399 | sgbuf = NULL; | |
400 | buf->result = VIDEOBUF_ERROR; | |
401 | } | |
402 | } | |
403 | buf->sgbuf = sgbuf; | |
404 | } else { | |
405 | /* sglist is fresh, initialize it before using */ | |
406 | struct videobuf_dmabuf *dma = videobuf_to_dma(&buf->vb); | |
407 | ||
408 | sgbuf = dma->sglist; | |
409 | if (!(WARN_ON(!sgbuf))) { | |
410 | buf->sgbuf = sgbuf; | |
411 | buf->sgcount = 0; | |
412 | buf->bytes_left = buf->vb.size; | |
413 | buf->result = VIDEOBUF_DONE; | |
414 | } | |
415 | } | |
416 | if (sgbuf) | |
417 | /* | |
418 | * Put our next sgbuf parameters (address, size) | |
419 | * into the DMA programming register set. | |
420 | */ | |
421 | set_dma_dest_params(dma_ch, buf, OMAP1_CAM_DMA_SG); | |
422 | ||
423 | return sgbuf; | |
424 | } | |
425 | ||
426 | static void start_capture(struct omap1_cam_dev *pcdev) | |
427 | { | |
428 | struct omap1_cam_buf *buf = pcdev->active; | |
429 | u32 ctrlclock = CAM_READ_CACHE(pcdev, CTRLCLOCK); | |
430 | u32 mode = CAM_READ_CACHE(pcdev, MODE) & ~EN_V_DOWN; | |
431 | ||
432 | if (WARN_ON(!buf)) | |
433 | return; | |
434 | ||
435 | /* | |
436 | * Enable start of frame interrupt, which we will use for activating | |
437 | * our end of frame watchdog when capture actually starts. | |
438 | */ | |
439 | mode |= EN_V_UP; | |
440 | ||
441 | if (unlikely(ctrlclock & LCLK_EN)) | |
442 | /* stop pixel clock before FIFO reset */ | |
443 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~LCLK_EN); | |
444 | /* reset FIFO */ | |
445 | CAM_WRITE(pcdev, MODE, mode | RAZ_FIFO); | |
446 | ||
447 | omap_start_dma(pcdev->dma_ch); | |
448 | ||
449 | if (pcdev->vb_mode == OMAP1_CAM_DMA_SG) { | |
450 | /* | |
451 | * In SG mode, it's a good moment for fetching next sgbuf | |
452 | * from the current sglist and, if available, already putting | |
453 | * its parameters into the DMA programming register set. | |
454 | */ | |
455 | try_next_sgbuf(pcdev->dma_ch, buf); | |
456 | } | |
457 | ||
458 | /* (re)enable pixel clock */ | |
459 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock | LCLK_EN); | |
460 | /* release FIFO reset */ | |
461 | CAM_WRITE(pcdev, MODE, mode); | |
462 | } | |
463 | ||
464 | static void suspend_capture(struct omap1_cam_dev *pcdev) | |
465 | { | |
466 | u32 ctrlclock = CAM_READ_CACHE(pcdev, CTRLCLOCK); | |
467 | ||
468 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~LCLK_EN); | |
469 | omap_stop_dma(pcdev->dma_ch); | |
470 | } | |
471 | ||
472 | static void disable_capture(struct omap1_cam_dev *pcdev) | |
473 | { | |
474 | u32 mode = CAM_READ_CACHE(pcdev, MODE); | |
475 | ||
476 | CAM_WRITE(pcdev, MODE, mode & ~(IRQ_MASK | DMA)); | |
477 | } | |
478 | ||
479 | static void omap1_videobuf_queue(struct videobuf_queue *vq, | |
480 | struct videobuf_buffer *vb) | |
481 | { | |
482 | struct soc_camera_device *icd = vq->priv_data; | |
7dfff953 | 483 | struct soc_camera_host *ici = to_soc_camera_host(icd->parent); |
bdc621fc JK |
484 | struct omap1_cam_dev *pcdev = ici->priv; |
485 | struct omap1_cam_buf *buf; | |
486 | u32 mode; | |
487 | ||
488 | list_add_tail(&vb->queue, &pcdev->capture); | |
489 | vb->state = VIDEOBUF_QUEUED; | |
490 | ||
491 | if (pcdev->active) { | |
492 | /* | |
493 | * Capture in progress, so don't touch pcdev->ready even if | |
494 | * empty. Since the transfer of the DMA programming register set | |
495 | * content to the DMA working register set is done automatically | |
496 | * by the DMA hardware, this can pretty well happen while we | |
4b35e625 | 497 | * are keeping the lock here. Leave fetching it from the queue |
bdc621fc JK |
498 | * to be done when a next DMA interrupt occures instead. |
499 | */ | |
500 | return; | |
501 | } | |
502 | ||
503 | WARN_ON(pcdev->ready); | |
504 | ||
505 | buf = prepare_next_vb(pcdev); | |
506 | if (WARN_ON(!buf)) | |
507 | return; | |
508 | ||
509 | pcdev->active = buf; | |
510 | pcdev->ready = NULL; | |
511 | ||
7dfff953 | 512 | dev_dbg(icd->parent, |
bdc621fc JK |
513 | "%s: capture not active, setup FIFO, start DMA\n", __func__); |
514 | mode = CAM_READ_CACHE(pcdev, MODE) & ~THRESHOLD_MASK; | |
515 | mode |= THRESHOLD_LEVEL(pcdev->vb_mode) << THRESHOLD_SHIFT; | |
516 | CAM_WRITE(pcdev, MODE, mode | EN_FIFO_FULL | DMA); | |
517 | ||
518 | if (pcdev->vb_mode == OMAP1_CAM_DMA_SG) { | |
519 | /* | |
520 | * In SG mode, the above prepare_next_vb() didn't actually | |
521 | * put anything into the DMA programming register set, | |
522 | * so we have to do it now, before activating DMA. | |
523 | */ | |
524 | try_next_sgbuf(pcdev->dma_ch, buf); | |
525 | } | |
526 | ||
527 | start_capture(pcdev); | |
528 | } | |
529 | ||
530 | static void omap1_videobuf_release(struct videobuf_queue *vq, | |
531 | struct videobuf_buffer *vb) | |
532 | { | |
533 | struct omap1_cam_buf *buf = | |
534 | container_of(vb, struct omap1_cam_buf, vb); | |
535 | struct soc_camera_device *icd = vq->priv_data; | |
7dfff953 GL |
536 | struct device *dev = icd->parent; |
537 | struct soc_camera_host *ici = to_soc_camera_host(dev); | |
bdc621fc JK |
538 | struct omap1_cam_dev *pcdev = ici->priv; |
539 | ||
540 | switch (vb->state) { | |
541 | case VIDEOBUF_DONE: | |
542 | dev_dbg(dev, "%s (done)\n", __func__); | |
543 | break; | |
544 | case VIDEOBUF_ACTIVE: | |
545 | dev_dbg(dev, "%s (active)\n", __func__); | |
546 | break; | |
547 | case VIDEOBUF_QUEUED: | |
548 | dev_dbg(dev, "%s (queued)\n", __func__); | |
549 | break; | |
550 | case VIDEOBUF_PREPARED: | |
551 | dev_dbg(dev, "%s (prepared)\n", __func__); | |
552 | break; | |
553 | default: | |
554 | dev_dbg(dev, "%s (unknown %d)\n", __func__, vb->state); | |
555 | break; | |
556 | } | |
557 | ||
558 | free_buffer(vq, buf, pcdev->vb_mode); | |
559 | } | |
560 | ||
561 | static void videobuf_done(struct omap1_cam_dev *pcdev, | |
562 | enum videobuf_state result) | |
563 | { | |
564 | struct omap1_cam_buf *buf = pcdev->active; | |
565 | struct videobuf_buffer *vb; | |
f7f6ce2d | 566 | struct device *dev = pcdev->soc_host.icd->parent; |
bdc621fc JK |
567 | |
568 | if (WARN_ON(!buf)) { | |
569 | suspend_capture(pcdev); | |
570 | disable_capture(pcdev); | |
571 | return; | |
572 | } | |
573 | ||
574 | if (result == VIDEOBUF_ERROR) | |
575 | suspend_capture(pcdev); | |
576 | ||
577 | vb = &buf->vb; | |
578 | if (waitqueue_active(&vb->done)) { | |
579 | if (!pcdev->ready && result != VIDEOBUF_ERROR) { | |
580 | /* | |
581 | * No next buffer has been entered into the DMA | |
582 | * programming register set on time (could be done only | |
583 | * while the previous DMA interurpt was processed, not | |
584 | * later), so the last DMA block, be it a whole buffer | |
585 | * if in CONTIG or its last sgbuf if in SG mode, is | |
586 | * about to be reused by the just autoreinitialized DMA | |
587 | * engine, and overwritten with next frame data. Best we | |
588 | * can do is stopping the capture as soon as possible, | |
589 | * hopefully before the next frame start. | |
590 | */ | |
591 | suspend_capture(pcdev); | |
592 | } | |
593 | vb->state = result; | |
8e6057b5 | 594 | v4l2_get_timestamp(&vb->ts); |
bdc621fc JK |
595 | if (result != VIDEOBUF_ERROR) |
596 | vb->field_count++; | |
597 | wake_up(&vb->done); | |
598 | ||
599 | /* shift in next buffer */ | |
600 | buf = pcdev->ready; | |
601 | pcdev->active = buf; | |
602 | pcdev->ready = NULL; | |
603 | ||
604 | if (!buf) { | |
605 | /* | |
606 | * No next buffer was ready on time (see above), so | |
607 | * indicate error condition to force capture restart or | |
608 | * stop, depending on next buffer already queued or not. | |
609 | */ | |
610 | result = VIDEOBUF_ERROR; | |
611 | prepare_next_vb(pcdev); | |
612 | ||
613 | buf = pcdev->ready; | |
614 | pcdev->active = buf; | |
615 | pcdev->ready = NULL; | |
616 | } | |
617 | } else if (pcdev->ready) { | |
618 | /* | |
619 | * In both CONTIG and SG mode, the DMA engine has possibly | |
620 | * been already autoreinitialized with the preprogrammed | |
621 | * pcdev->ready buffer. We can either accept this fact | |
622 | * and just swap the buffers, or provoke an error condition | |
623 | * and restart capture. The former seems less intrusive. | |
624 | */ | |
625 | dev_dbg(dev, "%s: nobody waiting on videobuf, swap with next\n", | |
626 | __func__); | |
627 | pcdev->active = pcdev->ready; | |
628 | ||
629 | if (pcdev->vb_mode == OMAP1_CAM_DMA_SG) { | |
630 | /* | |
631 | * In SG mode, we have to make sure that the buffer we | |
632 | * are putting back into the pcdev->ready is marked | |
633 | * fresh. | |
634 | */ | |
635 | buf->sgbuf = NULL; | |
636 | } | |
637 | pcdev->ready = buf; | |
638 | ||
639 | buf = pcdev->active; | |
640 | } else { | |
641 | /* | |
642 | * No next buffer has been entered into | |
643 | * the DMA programming register set on time. | |
644 | */ | |
645 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
646 | /* | |
647 | * In CONTIG mode, the DMA engine has already been | |
648 | * reinitialized with the current buffer. Best we can do | |
649 | * is not touching it. | |
650 | */ | |
651 | dev_dbg(dev, | |
652 | "%s: nobody waiting on videobuf, reuse it\n", | |
653 | __func__); | |
654 | } else { | |
655 | /* | |
656 | * In SG mode, the DMA engine has just been | |
657 | * autoreinitialized with the last sgbuf from the | |
658 | * current list. Restart capture in order to transfer | |
659 | * next frame start into the first sgbuf, not the last | |
660 | * one. | |
661 | */ | |
662 | if (result != VIDEOBUF_ERROR) { | |
663 | suspend_capture(pcdev); | |
664 | result = VIDEOBUF_ERROR; | |
665 | } | |
666 | } | |
667 | } | |
668 | ||
669 | if (!buf) { | |
670 | dev_dbg(dev, "%s: no more videobufs, stop capture\n", __func__); | |
671 | disable_capture(pcdev); | |
672 | return; | |
673 | } | |
674 | ||
675 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
676 | /* | |
677 | * In CONTIG mode, the current buffer parameters had already | |
678 | * been entered into the DMA programming register set while the | |
679 | * buffer was fetched with prepare_next_vb(), they may have also | |
25985edc | 680 | * been transferred into the runtime set and already active if |
bdc621fc JK |
681 | * the DMA still running. |
682 | */ | |
683 | } else { | |
684 | /* In SG mode, extra steps are required */ | |
685 | if (result == VIDEOBUF_ERROR) | |
686 | /* make sure we (re)use sglist from start on error */ | |
687 | buf->sgbuf = NULL; | |
688 | ||
689 | /* | |
690 | * In any case, enter the next sgbuf parameters into the DMA | |
691 | * programming register set. They will be used either during | |
692 | * nearest DMA autoreinitialization or, in case of an error, | |
693 | * on DMA startup below. | |
694 | */ | |
695 | try_next_sgbuf(pcdev->dma_ch, buf); | |
696 | } | |
697 | ||
698 | if (result == VIDEOBUF_ERROR) { | |
699 | dev_dbg(dev, "%s: videobuf error; reset FIFO, restart DMA\n", | |
700 | __func__); | |
701 | start_capture(pcdev); | |
702 | /* | |
703 | * In SG mode, the above also resulted in the next sgbuf | |
704 | * parameters being entered into the DMA programming register | |
705 | * set, making them ready for next DMA autoreinitialization. | |
706 | */ | |
707 | } | |
708 | ||
709 | /* | |
710 | * Finally, try fetching next buffer. | |
711 | * In CONTIG mode, it will also enter it into the DMA programming | |
712 | * register set, making it ready for next DMA autoreinitialization. | |
713 | */ | |
714 | prepare_next_vb(pcdev); | |
715 | } | |
716 | ||
717 | static void dma_isr(int channel, unsigned short status, void *data) | |
718 | { | |
719 | struct omap1_cam_dev *pcdev = data; | |
720 | struct omap1_cam_buf *buf = pcdev->active; | |
721 | unsigned long flags; | |
722 | ||
723 | spin_lock_irqsave(&pcdev->lock, flags); | |
724 | ||
725 | if (WARN_ON(!buf)) { | |
726 | suspend_capture(pcdev); | |
727 | disable_capture(pcdev); | |
728 | goto out; | |
729 | } | |
730 | ||
731 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
732 | /* | |
733 | * In CONTIG mode, assume we have just managed to collect the | |
734 | * whole frame, hopefully before our end of frame watchdog is | |
735 | * triggered. Then, all we have to do is disabling the watchdog | |
736 | * for this frame, and calling videobuf_done() with success | |
737 | * indicated. | |
738 | */ | |
739 | CAM_WRITE(pcdev, MODE, | |
740 | CAM_READ_CACHE(pcdev, MODE) & ~EN_V_DOWN); | |
741 | videobuf_done(pcdev, VIDEOBUF_DONE); | |
742 | } else { | |
743 | /* | |
744 | * In SG mode, we have to process every sgbuf from the current | |
745 | * sglist, one after another. | |
746 | */ | |
747 | if (buf->sgbuf) { | |
748 | /* | |
749 | * Current sglist not completed yet, try fetching next | |
750 | * sgbuf, hopefully putting it into the DMA programming | |
751 | * register set, making it ready for next DMA | |
752 | * autoreinitialization. | |
753 | */ | |
754 | try_next_sgbuf(pcdev->dma_ch, buf); | |
755 | if (buf->sgbuf) | |
756 | goto out; | |
757 | ||
758 | /* | |
759 | * No more sgbufs left in the current sglist. This | |
760 | * doesn't mean that the whole videobuffer is already | |
761 | * complete, but only that the last sgbuf from the | |
762 | * current sglist is about to be filled. It will be | |
763 | * ready on next DMA interrupt, signalled with the | |
764 | * buf->sgbuf set back to NULL. | |
765 | */ | |
766 | if (buf->result != VIDEOBUF_ERROR) { | |
767 | /* | |
768 | * Video frame collected without errors so far, | |
769 | * we can prepare for collecting a next one | |
770 | * as soon as DMA gets autoreinitialized | |
771 | * after the current (last) sgbuf is completed. | |
772 | */ | |
773 | buf = prepare_next_vb(pcdev); | |
774 | if (!buf) | |
775 | goto out; | |
776 | ||
777 | try_next_sgbuf(pcdev->dma_ch, buf); | |
778 | goto out; | |
779 | } | |
780 | } | |
781 | /* end of videobuf */ | |
782 | videobuf_done(pcdev, buf->result); | |
783 | } | |
784 | ||
785 | out: | |
786 | spin_unlock_irqrestore(&pcdev->lock, flags); | |
787 | } | |
788 | ||
789 | static irqreturn_t cam_isr(int irq, void *data) | |
790 | { | |
791 | struct omap1_cam_dev *pcdev = data; | |
f7f6ce2d | 792 | struct device *dev = pcdev->soc_host.icd->parent; |
bdc621fc JK |
793 | struct omap1_cam_buf *buf = pcdev->active; |
794 | u32 it_status; | |
795 | unsigned long flags; | |
796 | ||
797 | it_status = CAM_READ(pcdev, IT_STATUS); | |
798 | if (!it_status) | |
799 | return IRQ_NONE; | |
800 | ||
801 | spin_lock_irqsave(&pcdev->lock, flags); | |
802 | ||
803 | if (WARN_ON(!buf)) { | |
353c2129 GL |
804 | dev_warn(dev, "%s: unhandled camera interrupt, status == %#x\n", |
805 | __func__, it_status); | |
bdc621fc JK |
806 | suspend_capture(pcdev); |
807 | disable_capture(pcdev); | |
808 | goto out; | |
809 | } | |
810 | ||
811 | if (unlikely(it_status & FIFO_FULL)) { | |
812 | dev_warn(dev, "%s: FIFO overflow\n", __func__); | |
813 | ||
814 | } else if (it_status & V_DOWN) { | |
815 | /* end of video frame watchdog */ | |
816 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
817 | /* | |
818 | * In CONTIG mode, the watchdog is disabled with | |
819 | * successful DMA end of block interrupt, and reenabled | |
820 | * on next frame start. If we get here, there is nothing | |
821 | * to check, we must be out of sync. | |
822 | */ | |
823 | } else { | |
824 | if (buf->sgcount == 2) { | |
825 | /* | |
826 | * If exactly 2 sgbufs from the next sglist have | |
827 | * been programmed into the DMA engine (the | |
25985edc | 828 | * first one already transferred into the DMA |
bdc621fc JK |
829 | * runtime register set, the second one still |
830 | * in the programming set), then we are in sync. | |
831 | */ | |
832 | goto out; | |
833 | } | |
834 | } | |
835 | dev_notice(dev, "%s: unexpected end of video frame\n", | |
836 | __func__); | |
837 | ||
838 | } else if (it_status & V_UP) { | |
839 | u32 mode; | |
840 | ||
841 | if (pcdev->vb_mode == OMAP1_CAM_DMA_CONTIG) { | |
842 | /* | |
843 | * In CONTIG mode, we need this interrupt every frame | |
844 | * in oredr to reenable our end of frame watchdog. | |
845 | */ | |
846 | mode = CAM_READ_CACHE(pcdev, MODE); | |
847 | } else { | |
848 | /* | |
849 | * In SG mode, the below enabled end of frame watchdog | |
850 | * is kept on permanently, so we can turn this one shot | |
851 | * setup off. | |
852 | */ | |
853 | mode = CAM_READ_CACHE(pcdev, MODE) & ~EN_V_UP; | |
854 | } | |
855 | ||
856 | if (!(mode & EN_V_DOWN)) { | |
857 | /* (re)enable end of frame watchdog interrupt */ | |
858 | mode |= EN_V_DOWN; | |
859 | } | |
860 | CAM_WRITE(pcdev, MODE, mode); | |
861 | goto out; | |
862 | ||
863 | } else { | |
864 | dev_warn(dev, "%s: unhandled camera interrupt, status == %#x\n", | |
865 | __func__, it_status); | |
866 | goto out; | |
867 | } | |
868 | ||
869 | videobuf_done(pcdev, VIDEOBUF_ERROR); | |
870 | out: | |
871 | spin_unlock_irqrestore(&pcdev->lock, flags); | |
872 | return IRQ_HANDLED; | |
873 | } | |
874 | ||
875 | static struct videobuf_queue_ops omap1_videobuf_ops = { | |
876 | .buf_setup = omap1_videobuf_setup, | |
877 | .buf_prepare = omap1_videobuf_prepare, | |
878 | .buf_queue = omap1_videobuf_queue, | |
879 | .buf_release = omap1_videobuf_release, | |
880 | }; | |
881 | ||
882 | ||
883 | /* | |
884 | * SOC Camera host operations | |
885 | */ | |
886 | ||
887 | static void sensor_reset(struct omap1_cam_dev *pcdev, bool reset) | |
888 | { | |
889 | /* apply/release camera sensor reset if requested by platform data */ | |
890 | if (pcdev->pflags & OMAP1_CAMERA_RST_HIGH) | |
891 | CAM_WRITE(pcdev, GPIO, reset); | |
892 | else if (pcdev->pflags & OMAP1_CAMERA_RST_LOW) | |
893 | CAM_WRITE(pcdev, GPIO, !reset); | |
894 | } | |
895 | ||
b5dbfe46 GL |
896 | static int omap1_cam_add_device(struct soc_camera_device *icd) |
897 | { | |
898 | dev_dbg(icd->parent, "OMAP1 Camera driver attached to camera %d\n", | |
899 | icd->devnum); | |
900 | ||
901 | return 0; | |
902 | } | |
903 | ||
904 | static void omap1_cam_remove_device(struct soc_camera_device *icd) | |
905 | { | |
906 | dev_dbg(icd->parent, | |
907 | "OMAP1 Camera driver detached from camera %d\n", icd->devnum); | |
908 | } | |
909 | ||
bdc621fc JK |
910 | /* |
911 | * The following two functions absolutely depend on the fact, that | |
912 | * there can be only one camera on OMAP1 camera sensor interface | |
913 | */ | |
b5dbfe46 | 914 | static int omap1_cam_clock_start(struct soc_camera_host *ici) |
bdc621fc | 915 | { |
bdc621fc JK |
916 | struct omap1_cam_dev *pcdev = ici->priv; |
917 | u32 ctrlclock; | |
918 | ||
bdc621fc JK |
919 | clk_enable(pcdev->clk); |
920 | ||
921 | /* setup sensor clock */ | |
922 | ctrlclock = CAM_READ(pcdev, CTRLCLOCK); | |
923 | ctrlclock &= ~(CAMEXCLK_EN | MCLK_EN | DPLL_EN); | |
924 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | |
925 | ||
926 | ctrlclock &= ~FOSCMOD_MASK; | |
927 | switch (pcdev->camexclk) { | |
928 | case 6000000: | |
929 | ctrlclock |= CAMEXCLK_EN | FOSCMOD_6MHz; | |
930 | break; | |
931 | case 8000000: | |
932 | ctrlclock |= CAMEXCLK_EN | FOSCMOD_8MHz | DPLL_EN; | |
933 | break; | |
934 | case 9600000: | |
935 | ctrlclock |= CAMEXCLK_EN | FOSCMOD_9_6MHz | DPLL_EN; | |
936 | break; | |
937 | case 12000000: | |
938 | ctrlclock |= CAMEXCLK_EN | FOSCMOD_12MHz; | |
939 | break; | |
940 | case 24000000: | |
941 | ctrlclock |= CAMEXCLK_EN | FOSCMOD_24MHz | DPLL_EN; | |
942 | default: | |
943 | break; | |
944 | } | |
945 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~DPLL_EN); | |
946 | ||
947 | /* enable internal clock */ | |
948 | ctrlclock |= MCLK_EN; | |
949 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | |
950 | ||
951 | sensor_reset(pcdev, false); | |
952 | ||
bdc621fc JK |
953 | return 0; |
954 | } | |
955 | ||
b5dbfe46 | 956 | static void omap1_cam_clock_stop(struct soc_camera_host *ici) |
bdc621fc | 957 | { |
bdc621fc JK |
958 | struct omap1_cam_dev *pcdev = ici->priv; |
959 | u32 ctrlclock; | |
960 | ||
bdc621fc JK |
961 | suspend_capture(pcdev); |
962 | disable_capture(pcdev); | |
963 | ||
964 | sensor_reset(pcdev, true); | |
965 | ||
966 | /* disable and release system clocks */ | |
967 | ctrlclock = CAM_READ_CACHE(pcdev, CTRLCLOCK); | |
968 | ctrlclock &= ~(MCLK_EN | DPLL_EN | CAMEXCLK_EN); | |
969 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | |
970 | ||
971 | ctrlclock = (ctrlclock & ~FOSCMOD_MASK) | FOSCMOD_12MHz; | |
972 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | |
973 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock | MCLK_EN); | |
974 | ||
975 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~MCLK_EN); | |
976 | ||
977 | clk_disable(pcdev->clk); | |
bdc621fc JK |
978 | } |
979 | ||
980 | /* Duplicate standard formats based on host capability of byte swapping */ | |
e9ceeced GL |
981 | static const struct soc_mbus_lookup omap1_cam_formats[] = { |
982 | { | |
27ffaeb0 | 983 | .code = MEDIA_BUS_FMT_UYVY8_2X8, |
e9ceeced | 984 | .fmt = { |
bdc621fc JK |
985 | .fourcc = V4L2_PIX_FMT_YUYV, |
986 | .name = "YUYV", | |
987 | .bits_per_sample = 8, | |
988 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
989 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 990 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 991 | }, |
e9ceeced | 992 | }, { |
27ffaeb0 | 993 | .code = MEDIA_BUS_FMT_VYUY8_2X8, |
e9ceeced | 994 | .fmt = { |
bdc621fc JK |
995 | .fourcc = V4L2_PIX_FMT_YVYU, |
996 | .name = "YVYU", | |
997 | .bits_per_sample = 8, | |
998 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
999 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1000 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1001 | }, |
e9ceeced | 1002 | }, { |
27ffaeb0 | 1003 | .code = MEDIA_BUS_FMT_YUYV8_2X8, |
e9ceeced | 1004 | .fmt = { |
bdc621fc JK |
1005 | .fourcc = V4L2_PIX_FMT_UYVY, |
1006 | .name = "UYVY", | |
1007 | .bits_per_sample = 8, | |
1008 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1009 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1010 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1011 | }, |
e9ceeced | 1012 | }, { |
27ffaeb0 | 1013 | .code = MEDIA_BUS_FMT_YVYU8_2X8, |
e9ceeced | 1014 | .fmt = { |
bdc621fc JK |
1015 | .fourcc = V4L2_PIX_FMT_VYUY, |
1016 | .name = "VYUY", | |
1017 | .bits_per_sample = 8, | |
1018 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1019 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1020 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1021 | }, |
e9ceeced | 1022 | }, { |
27ffaeb0 | 1023 | .code = MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE, |
e9ceeced | 1024 | .fmt = { |
bdc621fc JK |
1025 | .fourcc = V4L2_PIX_FMT_RGB555, |
1026 | .name = "RGB555", | |
1027 | .bits_per_sample = 8, | |
1028 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1029 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1030 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1031 | }, |
e9ceeced | 1032 | }, { |
27ffaeb0 | 1033 | .code = MEDIA_BUS_FMT_RGB555_2X8_PADHI_LE, |
e9ceeced | 1034 | .fmt = { |
bdc621fc JK |
1035 | .fourcc = V4L2_PIX_FMT_RGB555X, |
1036 | .name = "RGB555X", | |
1037 | .bits_per_sample = 8, | |
1038 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1039 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1040 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1041 | }, |
e9ceeced | 1042 | }, { |
27ffaeb0 | 1043 | .code = MEDIA_BUS_FMT_RGB565_2X8_BE, |
e9ceeced | 1044 | .fmt = { |
bdc621fc JK |
1045 | .fourcc = V4L2_PIX_FMT_RGB565, |
1046 | .name = "RGB565", | |
1047 | .bits_per_sample = 8, | |
1048 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1049 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1050 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1051 | }, |
e9ceeced | 1052 | }, { |
27ffaeb0 | 1053 | .code = MEDIA_BUS_FMT_RGB565_2X8_LE, |
e9ceeced | 1054 | .fmt = { |
bdc621fc JK |
1055 | .fourcc = V4L2_PIX_FMT_RGB565X, |
1056 | .name = "RGB565X", | |
1057 | .bits_per_sample = 8, | |
1058 | .packing = SOC_MBUS_PACKING_2X8_PADHI, | |
1059 | .order = SOC_MBUS_ORDER_BE, | |
ad3b81fa | 1060 | .layout = SOC_MBUS_LAYOUT_PACKED, |
bdc621fc | 1061 | }, |
e9ceeced | 1062 | }, |
bdc621fc JK |
1063 | }; |
1064 | ||
1065 | static int omap1_cam_get_formats(struct soc_camera_device *icd, | |
1066 | unsigned int idx, struct soc_camera_format_xlate *xlate) | |
1067 | { | |
1068 | struct v4l2_subdev *sd = soc_camera_to_subdev(icd); | |
7dfff953 | 1069 | struct device *dev = icd->parent; |
bdc621fc | 1070 | int formats = 0, ret; |
ebcff5fc HV |
1071 | struct v4l2_subdev_mbus_code_enum code = { |
1072 | .which = V4L2_SUBDEV_FORMAT_ACTIVE, | |
1073 | .index = idx, | |
1074 | }; | |
bdc621fc JK |
1075 | const struct soc_mbus_pixelfmt *fmt; |
1076 | ||
ebcff5fc | 1077 | ret = v4l2_subdev_call(sd, pad, enum_mbus_code, NULL, &code); |
bdc621fc JK |
1078 | if (ret < 0) |
1079 | /* No more formats */ | |
1080 | return 0; | |
1081 | ||
ebcff5fc | 1082 | fmt = soc_mbus_get_fmtdesc(code.code); |
bdc621fc | 1083 | if (!fmt) { |
d2dcad49 | 1084 | dev_warn(dev, "%s: unsupported format code #%d: %d\n", __func__, |
ebcff5fc | 1085 | idx, code.code); |
bdc621fc JK |
1086 | return 0; |
1087 | } | |
1088 | ||
1089 | /* Check support for the requested bits-per-sample */ | |
1090 | if (fmt->bits_per_sample != 8) | |
1091 | return 0; | |
1092 | ||
ebcff5fc | 1093 | switch (code.code) { |
27ffaeb0 BB |
1094 | case MEDIA_BUS_FMT_YUYV8_2X8: |
1095 | case MEDIA_BUS_FMT_YVYU8_2X8: | |
1096 | case MEDIA_BUS_FMT_UYVY8_2X8: | |
1097 | case MEDIA_BUS_FMT_VYUY8_2X8: | |
1098 | case MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE: | |
1099 | case MEDIA_BUS_FMT_RGB555_2X8_PADHI_LE: | |
1100 | case MEDIA_BUS_FMT_RGB565_2X8_BE: | |
1101 | case MEDIA_BUS_FMT_RGB565_2X8_LE: | |
bdc621fc JK |
1102 | formats++; |
1103 | if (xlate) { | |
ebcff5fc | 1104 | xlate->host_fmt = soc_mbus_find_fmtdesc(code.code, |
e9ceeced GL |
1105 | omap1_cam_formats, |
1106 | ARRAY_SIZE(omap1_cam_formats)); | |
ebcff5fc | 1107 | xlate->code = code.code; |
bdc621fc | 1108 | xlate++; |
353c2129 GL |
1109 | dev_dbg(dev, |
1110 | "%s: providing format %s as byte swapped code #%d\n", | |
ebcff5fc | 1111 | __func__, xlate->host_fmt->name, code.code); |
bdc621fc JK |
1112 | } |
1113 | default: | |
1114 | if (xlate) | |
353c2129 GL |
1115 | dev_dbg(dev, |
1116 | "%s: providing format %s in pass-through mode\n", | |
1117 | __func__, fmt->name); | |
bdc621fc JK |
1118 | } |
1119 | formats++; | |
1120 | if (xlate) { | |
1121 | xlate->host_fmt = fmt; | |
ebcff5fc | 1122 | xlate->code = code.code; |
bdc621fc JK |
1123 | xlate++; |
1124 | } | |
1125 | ||
1126 | return formats; | |
1127 | } | |
1128 | ||
1129 | static bool is_dma_aligned(s32 bytes_per_line, unsigned int height, | |
1130 | enum omap1_cam_vb_mode vb_mode) | |
1131 | { | |
1132 | int size = bytes_per_line * height; | |
1133 | ||
1134 | return IS_ALIGNED(bytes_per_line, DMA_ELEMENT_SIZE) && | |
1135 | IS_ALIGNED(size, DMA_FRAME_SIZE(vb_mode) * DMA_ELEMENT_SIZE); | |
1136 | } | |
1137 | ||
1138 | static int dma_align(int *width, int *height, | |
1139 | const struct soc_mbus_pixelfmt *fmt, | |
1140 | enum omap1_cam_vb_mode vb_mode, bool enlarge) | |
1141 | { | |
1142 | s32 bytes_per_line = soc_mbus_bytes_per_line(*width, fmt); | |
1143 | ||
1144 | if (bytes_per_line < 0) | |
1145 | return bytes_per_line; | |
1146 | ||
1147 | if (!is_dma_aligned(bytes_per_line, *height, vb_mode)) { | |
1148 | unsigned int pxalign = __fls(bytes_per_line / *width); | |
1149 | unsigned int salign = DMA_FRAME_SHIFT(vb_mode) + | |
1150 | DMA_ELEMENT_SHIFT - pxalign; | |
1151 | unsigned int incr = enlarge << salign; | |
1152 | ||
1153 | v4l_bound_align_image(width, 1, *width + incr, 0, | |
1154 | height, 1, *height + incr, 0, salign); | |
1155 | return 0; | |
1156 | } | |
1157 | return 1; | |
1158 | } | |
1159 | ||
ebf984bb | 1160 | #define subdev_call_with_sense(pcdev, dev, icd, sd, op, function, args...) \ |
353c2129 GL |
1161 | ({ \ |
1162 | struct soc_camera_sense sense = { \ | |
1163 | .master_clock = pcdev->camexclk, \ | |
1164 | .pixel_clock_max = 0, \ | |
1165 | }; \ | |
1166 | int __ret; \ | |
1167 | \ | |
1168 | if (pcdev->pdata) \ | |
1169 | sense.pixel_clock_max = pcdev->pdata->lclk_khz_max * 1000; \ | |
1170 | icd->sense = &sense; \ | |
ebf984bb | 1171 | __ret = v4l2_subdev_call(sd, op, function, ##args); \ |
353c2129 GL |
1172 | icd->sense = NULL; \ |
1173 | \ | |
1174 | if (sense.flags & SOCAM_SENSE_PCLK_CHANGED) { \ | |
1175 | if (sense.pixel_clock > sense.pixel_clock_max) { \ | |
1176 | dev_err(dev, \ | |
1177 | "%s: pixel clock %lu set by the camera too high!\n", \ | |
1178 | __func__, sense.pixel_clock); \ | |
1179 | __ret = -EINVAL; \ | |
1180 | } \ | |
1181 | } \ | |
1182 | __ret; \ | |
bdc621fc JK |
1183 | }) |
1184 | ||
ebf984bb | 1185 | static int set_format(struct omap1_cam_dev *pcdev, struct device *dev, |
bdc621fc | 1186 | struct soc_camera_device *icd, struct v4l2_subdev *sd, |
ebf984bb | 1187 | struct v4l2_subdev_format *format, |
bdc621fc JK |
1188 | const struct soc_camera_format_xlate *xlate) |
1189 | { | |
1190 | s32 bytes_per_line; | |
ebf984bb HV |
1191 | struct v4l2_mbus_framefmt *mf = &format->format; |
1192 | int ret = subdev_call_with_sense(pcdev, dev, icd, sd, pad, set_fmt, NULL, format); | |
bdc621fc JK |
1193 | |
1194 | if (ret < 0) { | |
ebf984bb | 1195 | dev_err(dev, "%s: set_fmt failed\n", __func__); |
bdc621fc JK |
1196 | return ret; |
1197 | } | |
1198 | ||
1199 | if (mf->code != xlate->code) { | |
1200 | dev_err(dev, "%s: unexpected pixel code change\n", __func__); | |
1201 | return -EINVAL; | |
1202 | } | |
1203 | ||
1204 | bytes_per_line = soc_mbus_bytes_per_line(mf->width, xlate->host_fmt); | |
1205 | if (bytes_per_line < 0) { | |
1206 | dev_err(dev, "%s: soc_mbus_bytes_per_line() failed\n", | |
1207 | __func__); | |
1208 | return bytes_per_line; | |
1209 | } | |
1210 | ||
1211 | if (!is_dma_aligned(bytes_per_line, mf->height, pcdev->vb_mode)) { | |
1212 | dev_err(dev, "%s: resulting geometry %ux%u not DMA aligned\n", | |
1213 | __func__, mf->width, mf->height); | |
1214 | return -EINVAL; | |
1215 | } | |
1216 | return 0; | |
1217 | } | |
1218 | ||
1219 | static int omap1_cam_set_crop(struct soc_camera_device *icd, | |
6a3082ad | 1220 | const struct v4l2_crop *crop) |
bdc621fc | 1221 | { |
6a3082ad | 1222 | const struct v4l2_rect *rect = &crop->c; |
bdc621fc JK |
1223 | const struct soc_camera_format_xlate *xlate = icd->current_fmt; |
1224 | struct v4l2_subdev *sd = soc_camera_to_subdev(icd); | |
7dfff953 GL |
1225 | struct device *dev = icd->parent; |
1226 | struct soc_camera_host *ici = to_soc_camera_host(dev); | |
bdc621fc | 1227 | struct omap1_cam_dev *pcdev = ici->priv; |
da298c6d HV |
1228 | struct v4l2_subdev_format fmt = { |
1229 | .which = V4L2_SUBDEV_FORMAT_ACTIVE, | |
1230 | }; | |
1231 | struct v4l2_mbus_framefmt *mf = &fmt.format; | |
bdc621fc JK |
1232 | int ret; |
1233 | ||
ebf984bb | 1234 | ret = subdev_call_with_sense(pcdev, dev, icd, sd, video, s_crop, crop); |
bdc621fc JK |
1235 | if (ret < 0) { |
1236 | dev_warn(dev, "%s: failed to crop to %ux%u@%u:%u\n", __func__, | |
1237 | rect->width, rect->height, rect->left, rect->top); | |
1238 | return ret; | |
1239 | } | |
1240 | ||
da298c6d | 1241 | ret = v4l2_subdev_call(sd, pad, get_fmt, NULL, &fmt); |
bdc621fc JK |
1242 | if (ret < 0) { |
1243 | dev_warn(dev, "%s: failed to fetch current format\n", __func__); | |
1244 | return ret; | |
1245 | } | |
1246 | ||
da298c6d | 1247 | ret = dma_align(&mf->width, &mf->height, xlate->host_fmt, pcdev->vb_mode, |
bdc621fc JK |
1248 | false); |
1249 | if (ret < 0) { | |
1250 | dev_err(dev, "%s: failed to align %ux%u %s with DMA\n", | |
da298c6d | 1251 | __func__, mf->width, mf->height, |
bdc621fc JK |
1252 | xlate->host_fmt->name); |
1253 | return ret; | |
1254 | } | |
1255 | ||
1256 | if (!ret) { | |
1257 | /* sensor returned geometry not DMA aligned, trying to fix */ | |
ebf984bb | 1258 | ret = set_format(pcdev, dev, icd, sd, &fmt, xlate); |
bdc621fc JK |
1259 | if (ret < 0) { |
1260 | dev_err(dev, "%s: failed to set format\n", __func__); | |
1261 | return ret; | |
1262 | } | |
1263 | } | |
1264 | ||
da298c6d HV |
1265 | icd->user_width = mf->width; |
1266 | icd->user_height = mf->height; | |
bdc621fc JK |
1267 | |
1268 | return 0; | |
1269 | } | |
1270 | ||
1271 | static int omap1_cam_set_fmt(struct soc_camera_device *icd, | |
1272 | struct v4l2_format *f) | |
1273 | { | |
1274 | struct v4l2_subdev *sd = soc_camera_to_subdev(icd); | |
1275 | const struct soc_camera_format_xlate *xlate; | |
7dfff953 GL |
1276 | struct device *dev = icd->parent; |
1277 | struct soc_camera_host *ici = to_soc_camera_host(dev); | |
bdc621fc JK |
1278 | struct omap1_cam_dev *pcdev = ici->priv; |
1279 | struct v4l2_pix_format *pix = &f->fmt.pix; | |
ebf984bb HV |
1280 | struct v4l2_subdev_format format = { |
1281 | .which = V4L2_SUBDEV_FORMAT_ACTIVE, | |
1282 | }; | |
1283 | struct v4l2_mbus_framefmt *mf = &format.format; | |
bdc621fc JK |
1284 | int ret; |
1285 | ||
1286 | xlate = soc_camera_xlate_by_fourcc(icd, pix->pixelformat); | |
1287 | if (!xlate) { | |
1288 | dev_warn(dev, "%s: format %#x not found\n", __func__, | |
1289 | pix->pixelformat); | |
1290 | return -EINVAL; | |
1291 | } | |
1292 | ||
ebf984bb HV |
1293 | mf->width = pix->width; |
1294 | mf->height = pix->height; | |
1295 | mf->field = pix->field; | |
1296 | mf->colorspace = pix->colorspace; | |
1297 | mf->code = xlate->code; | |
bdc621fc | 1298 | |
ebf984bb | 1299 | ret = dma_align(&mf->width, &mf->height, xlate->host_fmt, pcdev->vb_mode, |
bdc621fc JK |
1300 | true); |
1301 | if (ret < 0) { | |
1302 | dev_err(dev, "%s: failed to align %ux%u %s with DMA\n", | |
1303 | __func__, pix->width, pix->height, | |
1304 | xlate->host_fmt->name); | |
1305 | return ret; | |
1306 | } | |
1307 | ||
ebf984bb | 1308 | ret = set_format(pcdev, dev, icd, sd, &format, xlate); |
bdc621fc JK |
1309 | if (ret < 0) { |
1310 | dev_err(dev, "%s: failed to set format\n", __func__); | |
1311 | return ret; | |
1312 | } | |
1313 | ||
ebf984bb HV |
1314 | pix->width = mf->width; |
1315 | pix->height = mf->height; | |
1316 | pix->field = mf->field; | |
1317 | pix->colorspace = mf->colorspace; | |
bdc621fc JK |
1318 | icd->current_fmt = xlate; |
1319 | ||
1320 | return 0; | |
1321 | } | |
1322 | ||
1323 | static int omap1_cam_try_fmt(struct soc_camera_device *icd, | |
1324 | struct v4l2_format *f) | |
1325 | { | |
1326 | struct v4l2_subdev *sd = soc_camera_to_subdev(icd); | |
1327 | const struct soc_camera_format_xlate *xlate; | |
1328 | struct v4l2_pix_format *pix = &f->fmt.pix; | |
5eab4983 HV |
1329 | struct v4l2_subdev_pad_config pad_cfg; |
1330 | struct v4l2_subdev_format format = { | |
1331 | .which = V4L2_SUBDEV_FORMAT_TRY, | |
1332 | }; | |
1333 | struct v4l2_mbus_framefmt *mf = &format.format; | |
bdc621fc JK |
1334 | int ret; |
1335 | /* TODO: limit to mx1 hardware capabilities */ | |
1336 | ||
1337 | xlate = soc_camera_xlate_by_fourcc(icd, pix->pixelformat); | |
1338 | if (!xlate) { | |
7dfff953 | 1339 | dev_warn(icd->parent, "Format %#x not found\n", |
bdc621fc JK |
1340 | pix->pixelformat); |
1341 | return -EINVAL; | |
1342 | } | |
1343 | ||
5eab4983 HV |
1344 | mf->width = pix->width; |
1345 | mf->height = pix->height; | |
1346 | mf->field = pix->field; | |
1347 | mf->colorspace = pix->colorspace; | |
1348 | mf->code = xlate->code; | |
bdc621fc JK |
1349 | |
1350 | /* limit to sensor capabilities */ | |
5eab4983 | 1351 | ret = v4l2_subdev_call(sd, pad, set_fmt, &pad_cfg, &format); |
bdc621fc JK |
1352 | if (ret < 0) |
1353 | return ret; | |
1354 | ||
5eab4983 HV |
1355 | pix->width = mf->width; |
1356 | pix->height = mf->height; | |
1357 | pix->field = mf->field; | |
1358 | pix->colorspace = mf->colorspace; | |
bdc621fc JK |
1359 | |
1360 | return 0; | |
1361 | } | |
1362 | ||
1363 | static bool sg_mode; | |
1364 | ||
1365 | /* | |
1366 | * Local mmap_mapper wrapper, | |
1367 | * used for detecting videobuf-dma-contig buffer allocation failures | |
1368 | * and switching to videobuf-dma-sg automatically for future attempts. | |
1369 | */ | |
1370 | static int omap1_cam_mmap_mapper(struct videobuf_queue *q, | |
1371 | struct videobuf_buffer *buf, | |
1372 | struct vm_area_struct *vma) | |
1373 | { | |
1374 | struct soc_camera_device *icd = q->priv_data; | |
7dfff953 | 1375 | struct soc_camera_host *ici = to_soc_camera_host(icd->parent); |
bdc621fc JK |
1376 | struct omap1_cam_dev *pcdev = ici->priv; |
1377 | int ret; | |
1378 | ||
1379 | ret = pcdev->mmap_mapper(q, buf, vma); | |
1380 | ||
1381 | if (ret == -ENOMEM) | |
1382 | sg_mode = true; | |
1383 | ||
1384 | return ret; | |
1385 | } | |
1386 | ||
1387 | static void omap1_cam_init_videobuf(struct videobuf_queue *q, | |
1388 | struct soc_camera_device *icd) | |
1389 | { | |
7dfff953 | 1390 | struct soc_camera_host *ici = to_soc_camera_host(icd->parent); |
bdc621fc JK |
1391 | struct omap1_cam_dev *pcdev = ici->priv; |
1392 | ||
1393 | if (!sg_mode) | |
1394 | videobuf_queue_dma_contig_init(q, &omap1_videobuf_ops, | |
7dfff953 | 1395 | icd->parent, &pcdev->lock, |
bdc621fc | 1396 | V4L2_BUF_TYPE_VIDEO_CAPTURE, V4L2_FIELD_NONE, |
47ebe3f9 | 1397 | sizeof(struct omap1_cam_buf), icd, &ici->host_lock); |
bdc621fc JK |
1398 | else |
1399 | videobuf_queue_sg_init(q, &omap1_videobuf_ops, | |
7dfff953 | 1400 | icd->parent, &pcdev->lock, |
bdc621fc | 1401 | V4L2_BUF_TYPE_VIDEO_CAPTURE, V4L2_FIELD_NONE, |
47ebe3f9 | 1402 | sizeof(struct omap1_cam_buf), icd, &ici->host_lock); |
bdc621fc JK |
1403 | |
1404 | /* use videobuf mode (auto)selected with the module parameter */ | |
1405 | pcdev->vb_mode = sg_mode ? OMAP1_CAM_DMA_SG : OMAP1_CAM_DMA_CONTIG; | |
1406 | ||
1407 | /* | |
1408 | * Ensure we substitute the videobuf-dma-contig version of the | |
1409 | * mmap_mapper() callback with our own wrapper, used for switching | |
1410 | * automatically to videobuf-dma-sg on buffer allocation failure. | |
1411 | */ | |
1412 | if (!sg_mode && q->int_ops->mmap_mapper != omap1_cam_mmap_mapper) { | |
1413 | pcdev->mmap_mapper = q->int_ops->mmap_mapper; | |
1414 | q->int_ops->mmap_mapper = omap1_cam_mmap_mapper; | |
1415 | } | |
1416 | } | |
1417 | ||
352f5d25 | 1418 | static int omap1_cam_reqbufs(struct soc_camera_device *icd, |
bdc621fc JK |
1419 | struct v4l2_requestbuffers *p) |
1420 | { | |
1421 | int i; | |
1422 | ||
1423 | /* | |
1424 | * This is for locking debugging only. I removed spinlocks and now I | |
1425 | * check whether .prepare is ever called on a linked buffer, or whether | |
1426 | * a dma IRQ can occur for an in-work or unlinked buffer. Until now | |
1427 | * it hadn't triggered | |
1428 | */ | |
1429 | for (i = 0; i < p->count; i++) { | |
352f5d25 | 1430 | struct omap1_cam_buf *buf = container_of(icd->vb_vidq.bufs[i], |
bdc621fc JK |
1431 | struct omap1_cam_buf, vb); |
1432 | buf->inwork = 0; | |
1433 | INIT_LIST_HEAD(&buf->vb.queue); | |
1434 | } | |
1435 | ||
1436 | return 0; | |
1437 | } | |
1438 | ||
1439 | static int omap1_cam_querycap(struct soc_camera_host *ici, | |
1440 | struct v4l2_capability *cap) | |
1441 | { | |
1442 | /* cap->name is set by the friendly caller:-> */ | |
1443 | strlcpy(cap->card, "OMAP1 Camera", sizeof(cap->card)); | |
7d96c3e4 GL |
1444 | cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; |
1445 | cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS; | |
bdc621fc JK |
1446 | |
1447 | return 0; | |
1448 | } | |
1449 | ||
8843d119 | 1450 | static int omap1_cam_set_bus_param(struct soc_camera_device *icd) |
bdc621fc | 1451 | { |
92d2c339 | 1452 | struct v4l2_subdev *sd = soc_camera_to_subdev(icd); |
7dfff953 GL |
1453 | struct device *dev = icd->parent; |
1454 | struct soc_camera_host *ici = to_soc_camera_host(dev); | |
bdc621fc | 1455 | struct omap1_cam_dev *pcdev = ici->priv; |
8843d119 | 1456 | u32 pixfmt = icd->current_fmt->host_fmt->fourcc; |
bdc621fc JK |
1457 | const struct soc_camera_format_xlate *xlate; |
1458 | const struct soc_mbus_pixelfmt *fmt; | |
92d2c339 GL |
1459 | struct v4l2_mbus_config cfg = {.type = V4L2_MBUS_PARALLEL,}; |
1460 | unsigned long common_flags; | |
bdc621fc JK |
1461 | u32 ctrlclock, mode; |
1462 | int ret; | |
1463 | ||
92d2c339 GL |
1464 | ret = v4l2_subdev_call(sd, video, g_mbus_config, &cfg); |
1465 | if (!ret) { | |
1466 | common_flags = soc_mbus_config_compatible(&cfg, SOCAM_BUS_FLAGS); | |
1467 | if (!common_flags) { | |
1468 | dev_warn(dev, | |
1469 | "Flags incompatible: camera 0x%x, host 0x%x\n", | |
1470 | cfg.flags, SOCAM_BUS_FLAGS); | |
1471 | return -EINVAL; | |
1472 | } | |
1473 | } else if (ret != -ENOIOCTLCMD) { | |
1474 | return ret; | |
1475 | } else { | |
1476 | common_flags = SOCAM_BUS_FLAGS; | |
1477 | } | |
bdc621fc JK |
1478 | |
1479 | /* Make choices, possibly based on platform configuration */ | |
92d2c339 GL |
1480 | if ((common_flags & V4L2_MBUS_PCLK_SAMPLE_RISING) && |
1481 | (common_flags & V4L2_MBUS_PCLK_SAMPLE_FALLING)) { | |
bdc621fc JK |
1482 | if (!pcdev->pdata || |
1483 | pcdev->pdata->flags & OMAP1_CAMERA_LCLK_RISING) | |
92d2c339 | 1484 | common_flags &= ~V4L2_MBUS_PCLK_SAMPLE_FALLING; |
bdc621fc | 1485 | else |
92d2c339 | 1486 | common_flags &= ~V4L2_MBUS_PCLK_SAMPLE_RISING; |
bdc621fc JK |
1487 | } |
1488 | ||
92d2c339 GL |
1489 | cfg.flags = common_flags; |
1490 | ret = v4l2_subdev_call(sd, video, s_mbus_config, &cfg); | |
1491 | if (ret < 0 && ret != -ENOIOCTLCMD) { | |
1492 | dev_dbg(dev, "camera s_mbus_config(0x%lx) returned %d\n", | |
1493 | common_flags, ret); | |
bdc621fc | 1494 | return ret; |
92d2c339 | 1495 | } |
bdc621fc JK |
1496 | |
1497 | ctrlclock = CAM_READ_CACHE(pcdev, CTRLCLOCK); | |
1498 | if (ctrlclock & LCLK_EN) | |
1499 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~LCLK_EN); | |
1500 | ||
92d2c339 | 1501 | if (common_flags & V4L2_MBUS_PCLK_SAMPLE_RISING) { |
bdc621fc JK |
1502 | dev_dbg(dev, "CTRLCLOCK_REG |= POLCLK\n"); |
1503 | ctrlclock |= POLCLK; | |
1504 | } else { | |
1505 | dev_dbg(dev, "CTRLCLOCK_REG &= ~POLCLK\n"); | |
1506 | ctrlclock &= ~POLCLK; | |
1507 | } | |
1508 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock & ~LCLK_EN); | |
1509 | ||
1510 | if (ctrlclock & LCLK_EN) | |
1511 | CAM_WRITE(pcdev, CTRLCLOCK, ctrlclock); | |
1512 | ||
39c1cb2b | 1513 | /* select bus endianness */ |
bdc621fc JK |
1514 | xlate = soc_camera_xlate_by_fourcc(icd, pixfmt); |
1515 | fmt = xlate->host_fmt; | |
1516 | ||
1517 | mode = CAM_READ(pcdev, MODE) & ~(RAZ_FIFO | IRQ_MASK | DMA); | |
1518 | if (fmt->order == SOC_MBUS_ORDER_LE) { | |
1519 | dev_dbg(dev, "MODE_REG &= ~ORDERCAMD\n"); | |
1520 | CAM_WRITE(pcdev, MODE, mode & ~ORDERCAMD); | |
1521 | } else { | |
1522 | dev_dbg(dev, "MODE_REG |= ORDERCAMD\n"); | |
1523 | CAM_WRITE(pcdev, MODE, mode | ORDERCAMD); | |
1524 | } | |
1525 | ||
1526 | return 0; | |
1527 | } | |
1528 | ||
1529 | static unsigned int omap1_cam_poll(struct file *file, poll_table *pt) | |
1530 | { | |
352f5d25 | 1531 | struct soc_camera_device *icd = file->private_data; |
bdc621fc JK |
1532 | struct omap1_cam_buf *buf; |
1533 | ||
352f5d25 | 1534 | buf = list_entry(icd->vb_vidq.stream.next, struct omap1_cam_buf, |
bdc621fc JK |
1535 | vb.stream); |
1536 | ||
1537 | poll_wait(file, &buf->vb.done, pt); | |
1538 | ||
1539 | if (buf->vb.state == VIDEOBUF_DONE || | |
1540 | buf->vb.state == VIDEOBUF_ERROR) | |
1541 | return POLLIN | POLLRDNORM; | |
1542 | ||
1543 | return 0; | |
1544 | } | |
1545 | ||
1546 | static struct soc_camera_host_ops omap1_host_ops = { | |
1547 | .owner = THIS_MODULE, | |
1548 | .add = omap1_cam_add_device, | |
1549 | .remove = omap1_cam_remove_device, | |
b5dbfe46 GL |
1550 | .clock_start = omap1_cam_clock_start, |
1551 | .clock_stop = omap1_cam_clock_stop, | |
bdc621fc JK |
1552 | .get_formats = omap1_cam_get_formats, |
1553 | .set_crop = omap1_cam_set_crop, | |
1554 | .set_fmt = omap1_cam_set_fmt, | |
1555 | .try_fmt = omap1_cam_try_fmt, | |
1556 | .init_videobuf = omap1_cam_init_videobuf, | |
1557 | .reqbufs = omap1_cam_reqbufs, | |
1558 | .querycap = omap1_cam_querycap, | |
1559 | .set_bus_param = omap1_cam_set_bus_param, | |
1560 | .poll = omap1_cam_poll, | |
1561 | }; | |
1562 | ||
bf306900 | 1563 | static int omap1_cam_probe(struct platform_device *pdev) |
bdc621fc JK |
1564 | { |
1565 | struct omap1_cam_dev *pcdev; | |
1566 | struct resource *res; | |
1567 | struct clk *clk; | |
1568 | void __iomem *base; | |
1569 | unsigned int irq; | |
1570 | int err = 0; | |
1571 | ||
1572 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
1573 | irq = platform_get_irq(pdev, 0); | |
1574 | if (!res || (int)irq <= 0) { | |
1575 | err = -ENODEV; | |
1576 | goto exit; | |
1577 | } | |
1578 | ||
1579 | clk = clk_get(&pdev->dev, "armper_ck"); | |
1580 | if (IS_ERR(clk)) { | |
1581 | err = PTR_ERR(clk); | |
1582 | goto exit; | |
1583 | } | |
1584 | ||
1585 | pcdev = kzalloc(sizeof(*pcdev) + resource_size(res), GFP_KERNEL); | |
1586 | if (!pcdev) { | |
1587 | dev_err(&pdev->dev, "Could not allocate pcdev\n"); | |
1588 | err = -ENOMEM; | |
1589 | goto exit_put_clk; | |
1590 | } | |
1591 | ||
1592 | pcdev->res = res; | |
1593 | pcdev->clk = clk; | |
1594 | ||
1595 | pcdev->pdata = pdev->dev.platform_data; | |
2b3d0457 GL |
1596 | if (pcdev->pdata) { |
1597 | pcdev->pflags = pcdev->pdata->flags; | |
bdc621fc | 1598 | pcdev->camexclk = pcdev->pdata->camexclk_khz * 1000; |
2b3d0457 | 1599 | } |
bdc621fc JK |
1600 | |
1601 | switch (pcdev->camexclk) { | |
1602 | case 6000000: | |
1603 | case 8000000: | |
1604 | case 9600000: | |
1605 | case 12000000: | |
1606 | case 24000000: | |
1607 | break; | |
1608 | default: | |
2b3d0457 | 1609 | /* pcdev->camexclk != 0 => pcdev->pdata != NULL */ |
bdc621fc JK |
1610 | dev_warn(&pdev->dev, |
1611 | "Incorrect sensor clock frequency %ld kHz, " | |
1612 | "should be one of 0, 6, 8, 9.6, 12 or 24 MHz, " | |
1613 | "please correct your platform data\n", | |
1614 | pcdev->pdata->camexclk_khz); | |
1615 | pcdev->camexclk = 0; | |
1616 | case 0: | |
2b3d0457 | 1617 | dev_info(&pdev->dev, "Not providing sensor clock\n"); |
bdc621fc JK |
1618 | } |
1619 | ||
1620 | INIT_LIST_HEAD(&pcdev->capture); | |
1621 | spin_lock_init(&pcdev->lock); | |
1622 | ||
1623 | /* | |
1624 | * Request the region. | |
1625 | */ | |
1626 | if (!request_mem_region(res->start, resource_size(res), DRIVER_NAME)) { | |
1627 | err = -EBUSY; | |
1628 | goto exit_kfree; | |
1629 | } | |
1630 | ||
1631 | base = ioremap(res->start, resource_size(res)); | |
1632 | if (!base) { | |
1633 | err = -ENOMEM; | |
1634 | goto exit_release; | |
1635 | } | |
1636 | pcdev->irq = irq; | |
1637 | pcdev->base = base; | |
1638 | ||
1639 | sensor_reset(pcdev, true); | |
1640 | ||
1641 | err = omap_request_dma(OMAP_DMA_CAMERA_IF_RX, DRIVER_NAME, | |
1642 | dma_isr, (void *)pcdev, &pcdev->dma_ch); | |
1643 | if (err < 0) { | |
1644 | dev_err(&pdev->dev, "Can't request DMA for OMAP1 Camera\n"); | |
1645 | err = -EBUSY; | |
1646 | goto exit_iounmap; | |
1647 | } | |
1648 | dev_dbg(&pdev->dev, "got DMA channel %d\n", pcdev->dma_ch); | |
1649 | ||
1650 | /* preconfigure DMA */ | |
1651 | omap_set_dma_src_params(pcdev->dma_ch, OMAP_DMA_PORT_TIPB, | |
1652 | OMAP_DMA_AMODE_CONSTANT, res->start + REG_CAMDATA, | |
1653 | 0, 0); | |
1654 | omap_set_dma_dest_burst_mode(pcdev->dma_ch, OMAP_DMA_DATA_BURST_4); | |
1655 | /* setup DMA autoinitialization */ | |
1656 | omap_dma_link_lch(pcdev->dma_ch, pcdev->dma_ch); | |
1657 | ||
1658 | err = request_irq(pcdev->irq, cam_isr, 0, DRIVER_NAME, pcdev); | |
1659 | if (err) { | |
1660 | dev_err(&pdev->dev, "Camera interrupt register failed\n"); | |
1661 | goto exit_free_dma; | |
1662 | } | |
1663 | ||
1664 | pcdev->soc_host.drv_name = DRIVER_NAME; | |
1665 | pcdev->soc_host.ops = &omap1_host_ops; | |
1666 | pcdev->soc_host.priv = pcdev; | |
1667 | pcdev->soc_host.v4l2_dev.dev = &pdev->dev; | |
1668 | pcdev->soc_host.nr = pdev->id; | |
1669 | ||
1670 | err = soc_camera_host_register(&pcdev->soc_host); | |
1671 | if (err) | |
1672 | goto exit_free_irq; | |
1673 | ||
1674 | dev_info(&pdev->dev, "OMAP1 Camera Interface driver loaded\n"); | |
1675 | ||
1676 | return 0; | |
1677 | ||
1678 | exit_free_irq: | |
1679 | free_irq(pcdev->irq, pcdev); | |
1680 | exit_free_dma: | |
1681 | omap_free_dma(pcdev->dma_ch); | |
1682 | exit_iounmap: | |
1683 | iounmap(base); | |
1684 | exit_release: | |
1685 | release_mem_region(res->start, resource_size(res)); | |
1686 | exit_kfree: | |
1687 | kfree(pcdev); | |
1688 | exit_put_clk: | |
1689 | clk_put(clk); | |
1690 | exit: | |
1691 | return err; | |
1692 | } | |
1693 | ||
bf306900 | 1694 | static int omap1_cam_remove(struct platform_device *pdev) |
bdc621fc JK |
1695 | { |
1696 | struct soc_camera_host *soc_host = to_soc_camera_host(&pdev->dev); | |
1697 | struct omap1_cam_dev *pcdev = container_of(soc_host, | |
1698 | struct omap1_cam_dev, soc_host); | |
1699 | struct resource *res; | |
1700 | ||
1701 | free_irq(pcdev->irq, pcdev); | |
1702 | ||
1703 | omap_free_dma(pcdev->dma_ch); | |
1704 | ||
1705 | soc_camera_host_unregister(soc_host); | |
1706 | ||
1707 | iounmap(pcdev->base); | |
1708 | ||
1709 | res = pcdev->res; | |
1710 | release_mem_region(res->start, resource_size(res)); | |
1711 | ||
bdc621fc JK |
1712 | clk_put(pcdev->clk); |
1713 | ||
5bccd608 MK |
1714 | kfree(pcdev); |
1715 | ||
bdc621fc JK |
1716 | dev_info(&pdev->dev, "OMAP1 Camera Interface driver unloaded\n"); |
1717 | ||
1718 | return 0; | |
1719 | } | |
1720 | ||
1721 | static struct platform_driver omap1_cam_driver = { | |
1722 | .driver = { | |
1723 | .name = DRIVER_NAME, | |
1724 | }, | |
1725 | .probe = omap1_cam_probe, | |
bf306900 | 1726 | .remove = omap1_cam_remove, |
bdc621fc JK |
1727 | }; |
1728 | ||
1d6629b1 | 1729 | module_platform_driver(omap1_cam_driver); |
bdc621fc JK |
1730 | |
1731 | module_param(sg_mode, bool, 0644); | |
1732 | MODULE_PARM_DESC(sg_mode, "videobuf mode, 0: dma-contig (default), 1: dma-sg"); | |
1733 | ||
1734 | MODULE_DESCRIPTION("OMAP1 Camera Interface driver"); | |
1735 | MODULE_AUTHOR("Janusz Krzysztofik <jkrzyszt@tis.icnet.pl>"); | |
1736 | MODULE_LICENSE("GPL v2"); | |
92d2c339 | 1737 | MODULE_VERSION(DRIVER_VERSION); |
bdc621fc | 1738 | MODULE_ALIAS("platform:" DRIVER_NAME); |