12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387 |
- /****************************************************************************
- *
- * The MIT License (MIT)
- *
- * Copyright (c) 2020 VeriSilicon Holdings Co., Ltd.
- *
- * Permission is hereby granted, free of charge, to any person obtaining a
- * copy of this software and associated documentation files (the "Software"),
- * to deal in the Software without restriction, including without limitation
- * the rights to use, copy, modify, merge, publish, distribute, sublicense,
- * and/or sell copies of the Software, and to permit persons to whom the
- * Software is furnished to do so, subject to the following conditions:
- *
- * The above copyright notice and this permission notice shall be included in
- * all copies or substantial portions of the Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
- * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
- * DEALINGS IN THE SOFTWARE.
- *
- *****************************************************************************
- *
- * The GPL License (GPL)
- *
- * Copyright (c) 2020 VeriSilicon Holdings Co., Ltd.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License
- * as published by the Free Software Foundation; either version 2
- * of the License, or (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program;
- *
- *****************************************************************************
- *
- * Note: This software is released under dual MIT and GPL licenses. A
- * recipient may use this file under the terms of either the MIT license or
- * GPL License. If you wish to use only one license not the other, you can
- * indicate your decision by deleting one of the above license notices in your
- * version of this file.
- *
- *****************************************************************************/
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- # include <linux/dma-direct.h>
- #endif
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/spinlock.h>
- #include <linux/version.h>
- #include <media/v4l2-device.h>
- #include <media/v4l2-event.h>
- #include <media/v4l2-fh.h>
- #include <media/v4l2-ioctl.h>
- #include <media/videobuf2-dma-contig.h>
- #include <linux/of_reserved_mem.h>
- #include "video.h"
- #include "vvctrl.h"
- #include "vvdefs.h"
- #include "vvsensor.h"
- #define DEF_PLANE_NO (0)
- #define RETRY_TIME_INTERVAL_MS (5)
- #define RETRY_TIMES_MAX (10)
- static struct viv_video_device *vvdev[VIDEO_NODE_NUM];
- static struct list_head file_list_head[VIDEO_NODE_NUM];
- static spinlock_t file_list_lock[VIDEO_NODE_NUM];
- #ifdef ENABLE_IRQ
- static struct media_device mdev;
- #endif
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- struct ext_dma_buf {
- dma_addr_t addr;
- void *vaddr;
- size_t size;
- struct list_head entry;
- };
- #endif
- static struct viv_video_fmt formats[] = {
- {
- .fourcc = V4L2_PIX_FMT_YUYV,
- .depth = 16,
- .bpp = 2,
- },
- {
- .fourcc = V4L2_PIX_FMT_NV12,
- .depth = 12,
- .bpp = 1,
- },
- {
- .fourcc = V4L2_PIX_FMT_NV16,
- .depth = 16,
- .bpp = 1,
- },
- };
- static int bayer_pattern_to_format(unsigned int bayer_pattern,
- unsigned int bit_width, struct viv_video_fmt *fmt)
- {
- int ret = 0;
- if (bayer_pattern == BAYER_BGGR)
- if (bit_width == 8) {
- fmt->fourcc = V4L2_PIX_FMT_SBGGR8;
- fmt->depth = 8;
- fmt->bpp = 1;
- } else if (bit_width == 10) {
- fmt->fourcc = V4L2_PIX_FMT_SBGGR10;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else if (bit_width == 12) {
- fmt->fourcc = V4L2_PIX_FMT_SBGGR12;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else
- ret = -EPERM;
- else if (bayer_pattern == BAYER_GBRG)
- if (bit_width == 8) {
- fmt->fourcc = V4L2_PIX_FMT_SGBRG8;
- fmt->depth = 8;
- fmt->bpp = 1;
- } else if (bit_width == 10) {
- fmt->fourcc = V4L2_PIX_FMT_SGBRG10;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else if (bit_width == 12) {
- fmt->fourcc = V4L2_PIX_FMT_SGBRG12;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else
- ret = -EPERM;
- else if (bayer_pattern == BAYER_GRBG)
- if (bit_width == 8) {
- fmt->fourcc = V4L2_PIX_FMT_SGRBG8;
- fmt->depth = 8;
- fmt->bpp = 1;
- } else if (bit_width == 10) {
- fmt->fourcc = V4L2_PIX_FMT_SGRBG10;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else if (bit_width == 12) {
- fmt->fourcc = V4L2_PIX_FMT_SGRBG12;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else
- ret = -EPERM;
- else if (bayer_pattern == BAYER_RGGB)
- if (bit_width == 8) {
- fmt->fourcc = V4L2_PIX_FMT_SRGGB8;
- fmt->depth = 8;
- fmt->bpp = 1;
- } else if (bit_width == 10) {
- fmt->fourcc = V4L2_PIX_FMT_SRGGB10;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else if (bit_width == 12) {
- fmt->fourcc = V4L2_PIX_FMT_SRGGB12;
- fmt->depth = 16;
- fmt->bpp = 2;
- } else
- ret = -EPERM;
- else
- ret = -EPERM;
- return ret;
- }
- /* Caller must hold fh->vdev->fh_lock! */
- static struct v4l2_subscribed_event *video_event_fh_subscribed(
- struct v4l2_fh *fh, u32 type, u32 id)
- {
- struct v4l2_subscribed_event *sev;
- assert_spin_locked(&fh->vdev->fh_lock);
- list_for_each_entry(sev, &fh->subscribed, list)
- if (sev->type == type && sev->id == id) {
- return sev;
- }
- return NULL;
- }
- /*0-unsubscribed 1-subscribed*/
- static int video_event_subscribed(struct video_device *vdev,
- const struct v4l2_event *ev, u16 retries)
- {
- struct v4l2_fh *fh;
- unsigned long flags;
- int retry;
- if (vdev == NULL || ev == NULL)
- return 0;
- /*retry for waitting the daemon to subscribe */
- for(retry = 0; retry < retries; retry++) {
- spin_lock_irqsave(&vdev->fh_lock, flags);
- /*search the fh_list and check the event subscribed or not*/
- list_for_each_entry(fh, &vdev->fh_list, list) {
- if(video_event_fh_subscribed(fh, ev->type, ev->id)) {
- spin_unlock_irqrestore(&vdev->fh_lock, flags);
- return 1;
- }
- }
- spin_unlock_irqrestore(&vdev->fh_lock, flags);
- msleep(RETRY_TIME_INTERVAL_MS);
- }
- return 0;
- }
- static int viv_post_event(struct v4l2_event *event, void *fh, bool sync)
- {
- struct viv_video_file *handle = priv_to_handle(fh);
- struct v4l2_fh *video_fh = (struct v4l2_fh *)fh;
- if(!video_fh || !event) {
- return -EINVAL;
- }
- if(!video_event_subscribed(video_fh->vdev, event, RETRY_TIMES_MAX)) {
- pr_err("%s: unsubscribed event id =%d type=0x%08x",
- __func__, event->id, event->type);
- return -EAGAIN;
- }
- if (sync)
- reinit_completion(&handle->wait);
- mutex_lock(&handle->event_mutex);
- v4l2_event_queue(handle->vdev->video, event);
- mutex_unlock(&handle->event_mutex);
- if (sync) {
- if (wait_for_completion_timeout(&handle->wait, msecs_to_jiffies(
- VIV_VIDEO_EVENT_TIMOUT_MS)) == 0)
- return -ETIMEDOUT;
- }
- return 0;
- }
- static int viv_post_simple_event(int id, int streamid, void *fh, bool sync)
- {
- struct v4l2_event event;
- struct viv_video_event *v_event;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = streamid;
- v_event->file = fh;
- v_event->sync = sync;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = id;
- return viv_post_event(&event, fh, sync);
- }
- static int viv_post_control_event(int streamid, void *fh,
- struct viv_control_event *control_event)
- {
- struct v4l2_event event;
- struct viv_video_event *v_event;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = streamid;
- v_event->file = fh;
- v_event->sync = true;
- v_event->addr = control_event->request;
- v_event->response = control_event->response;
- v_event->buf_index = control_event->id;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_PASS_JSON;
- return viv_post_event(&event, fh, true);
- }
- static int set_stream(struct viv_video_device *vdev, int enable)
- {
- struct v4l2_subdev *sd;
- struct media_pad *pad;
- if (!vdev)
- return -EINVAL;
- pad = &vdev->video->entity.pads[0];
- if (pad)
- pad = media_entity_remote_pad(pad);
- if (pad && is_media_entity_v4l2_subdev(pad->entity)) {
- sd = media_entity_to_v4l2_subdev(pad->entity);
- v4l2_subdev_call(sd, video, s_stream, enable);
- }
- return 0;
- }
- static int start_streaming(struct vb2_queue *vq, unsigned int count)
- {
- struct viv_video_file *handle = queue_to_handle(vq);
- struct v4l2_fh *fh = &handle->vfh;
- pr_debug("enter %s\n", __func__);
- if (handle->streamid >= 0 && handle->state != 2) {
- handle->state = 2;
- handle->vdev->active = 1;
- set_stream(handle->vdev, 1);
- viv_post_simple_event(VIV_VIDEO_EVENT_START_STREAM,
- handle->streamid, fh, true);
- } else {
- pr_err("can't start streaming, device busy!\n");
- return -EBUSY;
- }
- return 0;
- }
- static void stop_streaming(struct vb2_queue *vq)
- {
- struct viv_video_file *handle = queue_to_handle(vq);
- struct vb2_buffer *vb;
- pr_debug("enter %s\n", __func__);
- if (!handle || handle->streamid < 0 || handle->state != 2)
- return;
- handle->state = 1;
- set_stream(handle->vdev, 0);
- viv_post_simple_event(VIV_VIDEO_EVENT_STOP_STREAM, handle->streamid,
- &handle->vfh, true);
- handle->sequence = 0;
- list_for_each_entry(vb, &vq->queued_list, queued_entry) {
- if (vb->state == VB2_BUF_STATE_ACTIVE)
- vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
- }
- }
- #if LINUX_VERSION_CODE < KERNEL_VERSION(4, 8, 0)
- static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt,
- unsigned int *nbuffers, unsigned int *nplanes,
- unsigned int sizes[], void *alloc_ctxs[])
- {
- struct viv_video_file *handle = queue_to_handle(vq);
- unsigned long size = handle->vdev->fmt.fmt.pix.sizeimage;
- pr_debug("enter %s\n", __func__);
- if (*nbuffers == 0)
- *nbuffers = 1;
- while (size * *nbuffers > RESERVED_MEM_SIZE)
- (*nbuffers)--;
- sizes[0] = size;
- return 0;
- }
- #else
- static int queue_setup(struct vb2_queue *q,
- unsigned int *num_buffers, unsigned int *num_planes,
- unsigned int sizes[], struct device *alloc_devs[])
- {
- struct viv_video_file *handle = queue_to_handle(q);
- unsigned long size = handle->vdev->fmt.fmt.pix.sizeimage;
- pr_debug("enter %s\n", __func__);
- if (*num_buffers == 0)
- *num_buffers = 1;
- while (size * *num_buffers > RESERVED_MEM_SIZE)
- (*num_buffers)--;
- *num_planes = 1;
- sizes[0] = size;
- return 0;
- }
- #endif
- static int buffer_init(struct vb2_buffer *vb)
- {
- pr_debug("enter %s\n", __func__);
- return 0;
- }
- static void buffer_queue(struct vb2_buffer *vb)
- {
- struct viv_video_file *handle;
- struct vb2_v4l2_buffer *vbuf;
- struct vb2_dc_buf *buf;
- #ifdef ENABLE_IRQ
- struct viv_video_device *vdev;
- struct media_pad *pad;
- #else
- struct v4l2_event event;
- struct viv_video_event *v_event;
- #endif
- if (!vb)
- return;
- handle = queue_to_handle(vb->vb2_queue);
- vbuf = container_of(vb, struct vb2_v4l2_buffer, vb2_buf);
- buf = container_of(vbuf, struct vb2_dc_buf, vb);
- if (!buf)
- return;
- if (!handle)
- return;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- buf->dma = vb2_dma_contig_plane_dma_addr(vb, DEF_PLANE_NO);
- #endif
- #ifdef ENABLE_IRQ
- vdev = handle->vdev;
- if (!vdev)
- return;
- pad = &vdev->video->entity.pads[0];
- vvbuf_ready(&vdev->bctx, pad, buf);
- #endif
- #ifndef ENABLE_IRQ
- if (handle->streamid < 0)
- return;
- /* pr_debug("buffer_queue %d", vb->index); */
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = handle->streamid;
- v_event->file = &handle->vfh;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- v_event->addr = vb2_dma_contig_plane_dma_addr(vb, DEF_PLANE_NO);
- #endif
- v_event->buf_index = vb->index;
- v_event->sync = false;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_QBUF;
- viv_post_event(&event, &handle->vfh, false);
- #endif
- }
- static struct vb2_ops buffer_ops = {
- .queue_setup = queue_setup,
- .buf_init = buffer_init,
- .buf_queue = buffer_queue,
- .start_streaming = start_streaming,
- .stop_streaming = stop_streaming,
- };
- static int video_open(struct file *file)
- {
- struct viv_video_device *dev = video_drvdata(file);
- struct viv_video_file *handle;
- unsigned long flags;
- int rc;
- pr_debug("enter %s\n", __func__);
- handle = kzalloc(sizeof(*handle), GFP_KERNEL);
- v4l2_fh_init(&handle->vfh, dev->video);
- v4l2_fh_add(&handle->vfh);
- file->private_data = &handle->vfh;
- handle->vdev = dev;
- handle->queue.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
- handle->queue.drv_priv = handle;
- handle->queue.ops = &buffer_ops;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- handle->queue.io_modes = VB2_MMAP | VB2_DMABUF;
- handle->queue.mem_ops = &vb2_dma_contig_memops;
- #endif
- handle->queue.buf_struct_size = sizeof(struct vb2_dc_buf);
- handle->queue.timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 5, 0)
- handle->queue.dev = dev->v4l2_dev->dev;
- #endif
- rc = vb2_queue_init(&handle->queue);
- if (rc) {
- pr_err("can't init vb queue\n");
- v4l2_fh_del(&handle->vfh);
- v4l2_fh_exit(&handle->vfh);
- kfree(handle);
- return rc;
- }
- mutex_init(&handle->event_mutex);
- mutex_init(&handle->buffer_mutex);
- init_completion(&handle->wait);
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- INIT_LIST_HEAD(&handle->extdmaqueue);
- #endif
- handle->event_buf.va = kmalloc(VIV_EVENT_BUF_SIZE, GFP_KERNEL);
- handle->event_buf.pa = __pa(handle->event_buf.va);
- spin_lock_irqsave(&file_list_lock[handle->vdev->id], flags);
- list_add_tail(&handle->entry, &file_list_head[handle->vdev->id]);
- spin_unlock_irqrestore(&file_list_lock[handle->vdev->id], flags);
- return 0;
- }
- static int video_close(struct file *file)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct vb2_buffer *vb;
- spinlock_t *lock;
- unsigned long flags;
- pr_debug("enter %s\n", __func__);
- if (handle) {
- handle->req = false;
- if (handle->streamid >= 0 && handle->state == 2) {
- set_stream(handle->vdev, 0);
- viv_post_simple_event(VIV_VIDEO_EVENT_STOP_STREAM,
- handle->streamid, &handle->vfh,
- false);
- handle->state = 1;
- }
- if (handle->streamid >= 0 && handle->state == 1) {
- viv_post_simple_event(VIV_VIDEO_EVENT_DEL_STREAM,
- handle->streamid, &handle->vfh,
- true);
- handle->vdev->frame_flag = false;
- }
- if (handle->state > 0)
- handle->vdev->active = 0;
- handle->state = -1;
- handle->streamid = 0;
- lock = &file_list_lock[handle->vdev->id];
- spin_lock_irqsave(lock, flags);
- list_del(&handle->entry);
- spin_unlock_irqrestore(lock, flags);
- list_for_each_entry(vb, &handle->queue.queued_list,
- queued_entry) {
- if (vb->state == VB2_BUF_STATE_ACTIVE)
- vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
- }
- v4l2_fh_del(&handle->vfh);
- v4l2_fh_exit(&handle->vfh);
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- {
- struct ext_dma_buf *edb = NULL;
- while (!list_empty(&handle->extdmaqueue)) {
- edb = list_first_entry(&handle->extdmaqueue,
- struct ext_dma_buf, entry);
- if (edb) {
- dma_free_attrs(handle->queue.dev,
- edb->size, edb->vaddr,
- edb->addr,
- DMA_ATTR_WRITE_COMBINE);
- list_del(&edb->entry);
- kfree(edb);
- }
- }
- }
- #endif
- vb2_queue_release(&handle->queue);
- mutex_destroy(&handle->event_mutex);
- mutex_destroy(&handle->buffer_mutex);
- kfree(handle->event_buf.va);
- kfree(handle);
- }
- return 0;
- }
- static int subscribe_event(struct v4l2_fh *fh,
- const struct v4l2_event_subscription *sub)
- {
- int ret;
- unsigned long flags;
- struct viv_video_file *handle = priv_to_handle(fh);
- struct viv_video_device *vdev;
- if (!handle || !sub)
- return -EINVAL;
- if (unlikely(sub->type != VIV_VIDEO_EVENT_TYPE))
- return v4l2_ctrl_subscribe_event(fh, sub);
- ret = v4l2_event_subscribe(fh, sub, 10, 0);
- vdev = handle->vdev;
- if (!ret && vdev && sub->id == VIV_VIDEO_EVENT_GET_CAPS_SUPPORTS) {
- spin_lock_irqsave(&file_list_lock[vdev->id], flags);
- vdev->subscribed_cnt++;
- spin_unlock_irqrestore(&file_list_lock[vdev->id], flags);
- complete_all(&vdev->subscribed_wait);
- }
- return ret;
- }
- static int unsubscribe_event(struct v4l2_fh *fh,
- const struct v4l2_event_subscription *sub)
- {
- struct viv_video_file *handle = priv_to_handle(fh);
- struct viv_video_file *ph;
- struct viv_video_device *vdev;
- spinlock_t *lock;
- unsigned long flags;
- pr_debug("enter %s\n", __func__);
- if (!handle || !handle->vdev || !sub)
- return 0;
- if (unlikely(sub->type != VIV_VIDEO_EVENT_TYPE))
- return v4l2_event_unsubscribe(fh, sub);
- vdev = handle->vdev;
- lock = &file_list_lock[vdev->id];
- spin_lock_irqsave(lock, flags);
- list_for_each_entry(ph, &file_list_head[vdev->id], entry) {
- if (ph == handle && handle->streamid < 0) {
- if (sub->id == VIV_VIDEO_EVENT_GET_CAPS_SUPPORTS) {
- vdev->subscribed_cnt--;
- if (vdev->subscribed_cnt <= 0) {
- reinit_completion(
- &vdev->subscribed_wait);
- vdev->subscribed_cnt = 0;
- }
- }
- spin_unlock_irqrestore(lock, flags);
- return v4l2_event_unsubscribe(fh, sub);
- }
- }
- spin_unlock_irqrestore(lock, flags);
- return 0;
- }
- #ifndef ENABLE_IRQ
- static void viv_buffer_done(struct viv_video_file *handle, u64 addr)
- {
- struct vb2_buffer *vb;
- mutex_lock(&handle->buffer_mutex);
- list_for_each_entry(vb, &handle->queue.queued_list, queued_entry) {
- if (!vb)
- continue;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- if (vb2_dma_contig_plane_dma_addr(vb, DEF_PLANE_NO) == addr) {
- vb->planes[DEF_PLANE_NO].bytesused =
- handle->vdev->fmt.fmt.pix.sizeimage;
- #endif
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 0, 0)
- vb->timestamp = ktime_get_ns();
- #endif
- vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
- mutex_unlock(&handle->buffer_mutex);
- return;
- }
- }
- mutex_unlock(&handle->buffer_mutex);
- }
- #endif
- static int set_caps_mode_event(struct file *file)
- {
- struct viv_video_device *dev = video_drvdata(file);
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct v4l2_event event;
- struct viv_video_event *v_event;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = 0;
- v_event->file = &handle->vfh;
- v_event->sync = true;
- v_event->buf_index = dev->id;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_SET_CAPSMODE;
- return viv_post_event(&event, &handle->vfh, true);
- }
- static int get_caps_suppots_event(struct file *file)
- {
- struct viv_video_device *dev = video_drvdata(file);
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct v4l2_event event;
- struct viv_video_event *v_event;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = 0;
- v_event->file = &handle->vfh;
- v_event->sync = true;
- v_event->buf_index = dev->id;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_GET_CAPS_SUPPORTS;
- if (dev->subscribed_cnt == 0 &&
- wait_for_completion_timeout(&dev->subscribed_wait,
- msecs_to_jiffies(VIV_VIDEO_EVENT_TIMOUT_MS)) == 0)
- return -ETIMEDOUT;
- return viv_post_event(&event, &handle->vfh, true);
- }
- #ifdef ENABLE_IRQ
- static struct media_entity *viv_find_entity(struct viv_video_device *dev,
- const char *name)
- {
- struct v4l2_subdev *sd = NULL;
- int i;
- for (i = 0; i < dev->sdcount; ++i) {
- if (!strncmp(dev->subdevs[i]->name, name, strlen(name))) {
- sd = dev->subdevs[i];
- break;
- }
- }
- return sd ? &sd->entity : NULL;
- }
- static int viv_create_link(struct media_entity *source, u16 source_pad,
- struct media_entity *sink, u16 sink_pad)
- {
- int rc = 0;
- u32 flags = MEDIA_LNK_FL_ENABLED;
- if (!source || !sink)
- return -EINVAL;
- rc = media_create_pad_link(source, source_pad, sink, sink_pad, flags);
- if (rc)
- goto end;
- rc = media_entity_call(sink, link_setup, &sink->pads[sink_pad],
- &source->pads[source_pad], flags);
- if (rc)
- goto end;
- rc = media_entity_call(source, link_setup, &source->pads[source_pad],
- &sink->pads[sink_pad], flags);
- if (rc)
- goto end;
- end:
- return rc;
- }
- static int viv_create_default_links(struct viv_video_device *dev)
- {
- struct media_entity *source, *sink;
- source = viv_find_entity(dev, ISP_DEVICE_NAME);
- sink = &dev->video->entity;
- return viv_create_link(source, ISP_PAD_SOURCE, sink, 0);
- }
- static int viv_config_dwe(struct viv_video_file *handle, bool enable)
- {
- struct viv_video_device *vdev = handle->vdev;
- int rc;
- struct media_entity *source, *sink;
- if (!vdev || !vdev->sdcount)
- return -EINVAL;
- if (vdev->dweEnabled == enable)
- return 0;
- source = viv_find_entity(vdev, DWE_DEVICE_NAME);
- if (!source)
- return -EINVAL;
- sink = &vdev->video->entity;
- media_entity_remove_links(source);
- media_entity_remove_links(sink);
- if (!enable) {
- source = viv_find_entity(vdev, ISP_DEVICE_NAME);
- media_entity_remove_links(source);
- rc = viv_create_link(source, ISP_PAD_SOURCE, sink, 0);
- if (!rc)
- vdev->dweEnabled = false;
- return rc;
- }
- rc = viv_create_link(source, DWE_PAD_SOURCE, sink, 0);
- if (rc)
- goto end;
- if (vdev->sdcount > 1) {
- source = viv_find_entity(vdev, ISP_DEVICE_NAME);
- sink = viv_find_entity(vdev, DWE_DEVICE_NAME);
- media_entity_remove_links(source);
- if (viv_create_link(source, ISP_PAD_SOURCE, sink, DWE_PAD_SINK))
- pr_err("failed to create link between isp and dwe!\n");
- }
- vdev->dweEnabled = true;
- end:
- return rc;
- }
- #endif
- static inline void init_v4l2_fmt(struct v4l2_format *f, unsigned int bpp,
- unsigned int depth, unsigned int *bytesperline,
- unsigned int *sizeimage)
- {
- v4l_bound_align_image(&f->fmt.pix.width, 48, 3840, 2,
- &f->fmt.pix.height, 32, 2160, 0, 0);
- *bytesperline = ALIGN_UP(f->fmt.pix.width * bpp, 16);
- *sizeimage = f->fmt.pix.height * ALIGN_UP(f->fmt.pix.width * depth / 8, 16);
- }
- static int viv_set_modeinfo(struct viv_video_file *handle,
- struct vvcam_constant_modeinfo *modeinfo)
- {
- struct viv_video_device *vdev = handle->vdev;
- struct viv_video_fmt fmt;
- struct viv_video_fmt *pfmt = NULL;
- int i;
- if (modeinfo->w == 0 || modeinfo->h == 0 || modeinfo->fps == 0) {
- vdev->modeinfocount = 0;
- memset(vdev->modeinfo, 0, sizeof(vdev->modeinfo));
- memset(&vdev->crop, 0, sizeof(struct v4l2_rect));
- memset(&vdev->compose, 0, sizeof(struct v4l2_rect));
- return -EINVAL;
- }
- for (i = 0; i < vdev->modeinfocount; ++i) {
- if (vdev->modeinfo[i].index == modeinfo->index) {
- pr_debug("sensor mode info already configured!\n");
- return 0;
- }
- }
- if (vdev->modeinfocount < ARRAY_SIZE(vdev->modeinfo)) {
- memcpy(&vdev->modeinfo[vdev->modeinfocount],
- modeinfo, sizeof(*modeinfo));
- vdev->modeinfocount++;
- }
- if (!bayer_pattern_to_format(modeinfo->brpat, modeinfo->bitw, &fmt) &&
- vdev->formatscount < ARRAY_SIZE(vdev->formats)) {
- for (i = 0; i < vdev->formatscount; ++i)
- if (vdev->formats[i].fourcc == fmt.fourcc)
- break;
- if (i == vdev->formatscount) {
- memcpy(&vdev->formats[vdev->formatscount],
- &fmt, sizeof(fmt));
- vdev->formatscount++;
- }
- }
- if (vdev->fmt.fmt.pix.width == 0 || vdev->fmt.fmt.pix.height == 0) {
- if (vdev->formats[0].fourcc == 0 || vdev->formats[0].bpp == 0 ||
- vdev->formats[0].depth == 0 ||
- vdev->modeinfo[0].w == 0 || vdev->modeinfo[0].h == 0 ||
- vdev->modeinfo[0].fps == 0)
- pr_err("invalid default format!\n");
- if (vdev->fmt.fmt.pix.pixelformat == 0) {
- vdev->fmt.fmt.pix.pixelformat = vdev->formats[0].fourcc;
- }
- for (i = 0; i < vdev->formatscount; ++i) {
- if (vdev->fmt.fmt.pix.pixelformat == vdev->formats[i].fourcc) {
- pfmt = &vdev->formats[i];
- break;
- }
- }
- if (pfmt == NULL)
- pfmt = &vdev->formats[0];
- init_v4l2_fmt(&vdev->fmt, pfmt->bpp, pfmt->depth,
- &vdev->fmt.fmt.pix.bytesperline,
- &vdev->fmt.fmt.pix.sizeimage);
- vdev->timeperframe.numerator = 1;
- vdev->timeperframe.denominator = vdev->modeinfo[0].fps;
- }
- if (vdev->crop.width == 0 || vdev->crop.height == 0) {
- vdev->crop.width = vdev->modeinfo[0].w;
- vdev->crop.height = vdev->modeinfo[0].h;
- }
- if (vdev->compose.width == 0 || vdev->compose.height == 0) {
- vdev->compose.width = vdev->modeinfo[0].w;
- vdev->compose.height = vdev->modeinfo[0].h;
- }
- return 0;
- }
- static long private_ioctl(struct file *file, void *fh,
- bool valid_prio, unsigned int cmd, void *arg)
- {
- struct viv_video_file *handle;
- struct viv_video_file *ph;
- struct viv_video_event *v_event;
- struct ext_buf_info *ext_buf;
- struct viv_control_event *control_event;
- struct viv_caps_supports *pcaps_supports;
- struct viv_video_device *dev = video_drvdata(file);
- unsigned long flags;
- int rc = 0;
- struct reserved_mem *rmem;
- if (!file || !fh)
- return -EINVAL;
- handle = priv_to_handle(file->private_data);
- if (!handle || handle->state == -1) {
- pr_err("call ioctl after file closed\n");
- return -EINVAL;
- }
- switch (cmd) {
- case VIV_VIDIOC_EVENT_COMPLETE:
- v_event = (struct viv_video_event *)arg;
- if (v_event->file) {
- handle = priv_to_handle(v_event->file);
- spin_lock_irqsave(
- &file_list_lock[dev->id], flags);
- list_for_each_entry(ph,
- &file_list_head[dev->id], entry) {
- if (ph == handle) {
- complete(&handle->wait);
- break;
- }
- }
- spin_unlock_irqrestore(
- &file_list_lock[dev->id], flags);
- } else {
- complete(&dev->ctrls.wait);
- }
- break;
- #ifndef ENABLE_IRQ
- case VIV_VIDIOC_BUFDONE: {
- /* pr_debug("priv ioctl VIV_VIDIOC_BUFDONE\n"); */
- struct v4l2_user_buffer *user_buffer =
- (struct v4l2_user_buffer *)arg;
- if (!user_buffer->file)
- break;
- handle = priv_to_handle(user_buffer->file);
- if (!handle || handle->state != 2)
- break;
- /* handle the stream closed unexpected. */
- spin_lock_irqsave(&file_list_lock[dev->id], flags);
- list_for_each_entry(ph, &file_list_head[dev->id], entry) {
- if (ph == handle) {
- viv_buffer_done(handle, user_buffer->addr);
- break;
- }
- }
- spin_unlock_irqrestore(&file_list_lock[dev->id], flags);
- break;
- }
- #endif
- case VIV_VIDIOC_S_STREAMID:
- pr_debug("priv ioctl VIV_VIDIOC_S_STREAMID\n");
- handle->streamid = *((int *)arg);
- break;
- #ifdef ENABLE_IRQ
- case VIV_VIDIOC_S_DWECFG:
- viv_config_dwe(handle, !!*((int *)arg));
- break;
- case VIV_VIDIOC_G_DWECFG:
- *((int *)arg) = handle->vdev->dweEnabled ? 1 : 0;
- break;
- #endif
- case VIV_VIDIOC_BUFFER_ALLOC: {
- struct ext_buf_info *ext_buf = (struct ext_buf_info *)arg;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- struct ext_dma_buf *edb = kzalloc(sizeof(*edb), GFP_KERNEL);
- pr_debug("priv ioctl VIV_VIDIOC_BUFFER_ALLOC\n");
- if (!edb) {
- rc = -ENOMEM;
- break;
- }
- edb->vaddr = dma_alloc_attrs(handle->queue.dev,
- ext_buf->size, &ext_buf->addr,
- GFP_KERNEL, DMA_ATTR_WRITE_COMBINE);
- if (!edb->vaddr) {
- pr_err("failed to alloc dma buffer!\n");
- rc = -ENOMEM;
- } else {
- edb->addr = ext_buf->addr;
- edb->size = ext_buf->size;
- list_add_tail(&edb->entry, &handle->extdmaqueue);
- }
- #endif
- break;
- }
- case VIV_VIDIOC_BUFFER_FREE: {
- struct ext_buf_info *ext_buf = (struct ext_buf_info *)arg;
- #ifdef CONFIG_VIDEOBUF2_DMA_CONTIG
- struct ext_dma_buf *b, *edb = NULL;
- pr_debug("priv ioctl VIV_VIDIOC_BUFFER_FREE\n");
- list_for_each_entry(b, &handle->extdmaqueue, entry) {
- if (b->addr == ext_buf->addr) {
- edb = b;
- break;
- }
- }
- if (edb) {
- dma_free_attrs(handle->queue.dev, edb->size,
- edb->vaddr, edb->addr,
- DMA_ATTR_WRITE_COMBINE);
- list_del(&edb->entry);
- kfree(edb);
- }
- #endif
- break;
- }
- case VIV_VIDIOC_CONTROL_EVENT:
- pr_debug("priv ioctl VIV_VIDIOC_CONTROL_EVENT\n");
- control_event = (struct viv_control_event *)arg;
- rc = viv_post_control_event(handle->streamid, &handle->vfh,
- control_event);
- break;
- case VIV_VIDIOC_QUERY_EXTMEM:
- pr_debug("priv ioctl VIV_VIDIOC_QUERY_EXTMEM\n");
- ext_buf = (struct ext_buf_info *)arg;
- rmem = (struct reserved_mem *)dev->rmem;
- if (!rmem) {
- ext_buf->addr = 0;
- ext_buf->size = 0;
- } else {
- ext_buf->addr = rmem->base;
- ext_buf->size = rmem->size;
- }
- break;
- case VIV_VIDIOC_S_MODEINFO:
- rc = viv_set_modeinfo(handle, arg);
- break;
- case VIV_VIDIOC_S_CAPS_MODE:
- memcpy(&(dev->caps_mode), arg, sizeof(dev->caps_mode));
- rc = set_caps_mode_event(file);
- if (rc == 0)
- rc = dev->event_result;
- break;
- case VIV_VIDIOC_G_CAPS_MODE:
- memcpy(arg, &(dev->caps_mode), sizeof(dev->caps_mode));
- break;
- case VIV_VIDIOC_EVENT_RESULT:
- dev->event_result = *(int *)arg;
- break;
- case VIV_VIDIOC_GET_CAPS_SUPPORTS:{
- pcaps_supports = (struct viv_caps_supports *)arg;
- rc = get_caps_suppots_event(file);
- memcpy(pcaps_supports, &(dev->caps_supports),
- sizeof(dev->caps_supports));
- break;
- }
- case VIV_VIDIOC_SET_CAPS_SUPPORTS:
- pcaps_supports = (struct viv_caps_supports *)arg;
- memcpy(&(dev->caps_supports), arg, sizeof(dev->caps_supports));
- break;
- }
- return rc;
- }
- static int video_querycap(struct file *file, void *fh,
- struct v4l2_capability *cap)
- {
- struct viv_video_device *dev = video_drvdata(file);
- pr_debug("enter %s\n", __func__);
- strcpy(cap->driver, "viv_v4l2_device");
- strcpy(cap->card, "VIV");
- cap->bus_info[0] = 0;
- if (dev)
- snprintf((char *)cap->bus_info, sizeof(cap->bus_info),
- "platform:viv%d", dev->id);
- cap->capabilities = V4L2_CAP_VIDEO_CAPTURE |
- V4L2_CAP_STREAMING | V4L2_CAP_DEVICE_CAPS;
- cap->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING;
- return 0;
- }
- static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
- struct v4l2_fmtdesc *f)
- {
- struct viv_video_device *dev = video_drvdata(file);
- if (f->index < dev->formatscount) {
- f->pixelformat = dev->formats[f->index].fourcc;
- return 0;
- }
- return -EINVAL;
- }
- static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
- struct v4l2_format *f)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- *f = handle->vdev->fmt;
- return 0;
- }
- static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
- struct v4l2_format *f)
- {
- struct viv_video_device *dev = video_drvdata(file);
- struct viv_video_fmt *format = NULL;
- int bytesperline, sizeimage;
- int i;
- pr_debug("enter %s\n", __func__);
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- f->fmt.pix.width = ALIGN_UP(f->fmt.pix.width, 16);
- f->fmt.pix.height = ALIGN_UP(f->fmt.pix.height, 8);
- for (i = 0; i < dev->formatscount; ++i) {
- if (dev->formats[i].fourcc == f->fmt.pix.pixelformat) {
- format = &dev->formats[i];
- break;
- }
- }
- if (format == NULL)
- return -EINVAL;
- f->fmt.pix.field = dev->fmt.fmt.pix.field;
- f->fmt.pix.colorspace = dev->fmt.fmt.pix.colorspace;
- init_v4l2_fmt(f, format->bpp, format->depth, &bytesperline, &sizeimage);
- if (f->fmt.pix.bytesperline < bytesperline)
- f->fmt.pix.bytesperline = bytesperline;
- if (f->fmt.pix.sizeimage < sizeimage)
- f->fmt.pix.sizeimage = sizeimage;
- return 0;
- }
- static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
- struct v4l2_format *f)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct viv_video_device *vdev = handle->vdev;
- int ret;
- struct v4l2_event event;
- struct viv_video_event *v_event;
- struct viv_rect *rect = (struct viv_rect *)handle->event_buf.va;
- pr_debug("enter %s\n", __func__);
- if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- ret = vidioc_try_fmt_vid_cap(file, priv, f);
- if (ret < 0)
- return -EINVAL;
- handle->vdev->fmt = *f;
- if (vdev->crop.top == 0 &&
- vdev->crop.left == 0 &&
- vdev->crop.width == vdev->compose.width &&
- vdev->crop.height == vdev->compose.height) {
- vdev->compose.width = f->fmt.pix.width;
- vdev->compose.height = f->fmt.pix.height;
- vdev->crop.width = vdev->compose.width;
- vdev->crop.height = vdev->compose.height;
- rect->left = 0;
- rect->top = 0;
- rect->width = vdev->compose.width;
- rect->height = vdev->compose.height;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = handle->streamid;
- v_event->file = &(handle->vfh);
- v_event->sync = true;
- v_event->addr = handle->event_buf.pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_SET_COMPOSE;
- viv_post_event(&event, &handle->vfh, true);
- rect->left = 0;
- rect->top = 0;
- rect->width = 0;
- rect->height = 0;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = handle->streamid;
- v_event->file = &(handle->vfh);
- v_event->sync = true;
- v_event->addr = handle->event_buf.pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_SET_CROP;
- viv_post_event(&event, &handle->vfh, true);
- }
- return ret;
- }
- static int vidioc_reqbufs(struct file *file, void *priv,
- struct v4l2_requestbuffers *p)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct viv_video_file *ph;
- struct viv_video_device *vdev = handle->vdev;
- struct v4l2_event event;
- struct viv_video_event *v_event;
- unsigned long flags;
- int ret = 0;
- pr_debug("enter %s %d %d\n", __func__, p->count, p->memory);
- if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- spin_lock_irqsave(&file_list_lock[vdev->id], flags);
- list_for_each_entry(ph, &file_list_head[vdev->id], entry) {
- if (ph->streamid == handle->streamid &&
- ph != handle && ph->req) {
- pr_err("stream is busy %d\n", ph->streamid);
- spin_unlock_irqrestore(&file_list_lock[vdev->id],
- flags);
- return -EBUSY;
- }
- }
- spin_unlock_irqrestore(&file_list_lock[vdev->id], flags);
- if (p->count == 0)
- handle->req = false;
- else
- handle->req = true;
- mutex_lock(&handle->buffer_mutex);
- ret = vb2_reqbufs(&handle->queue, p);
- mutex_unlock(&handle->buffer_mutex);
- if (p->count == 0) {
- memset(p, 0, sizeof(*p));
- return ret;
- }
- if (ret < 0)
- return ret;
- if (handle->streamid < 0 || handle->state > 0)
- return ret;
- handle->state = 1;
- ret =
- viv_post_simple_event(VIV_VIDEO_EVENT_NEW_STREAM, handle->streamid,
- &handle->vfh, true);
- if (ret)
- return ret;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = handle->streamid;
- v_event->file = &handle->vfh;
- v_event->addr = handle->vdev->fmt.fmt.pix.width;
- v_event->response = handle->vdev->fmt.fmt.pix.height;
- v_event->buf_index = handle->vdev->fmt.fmt.pix.pixelformat;
- v_event->sync = true;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_SET_FMT;
- ret = viv_post_event(&event, &handle->vfh, true);
- return ret;
- }
- static int vidioc_querybuf(struct file *file, void *priv, struct v4l2_buffer *p)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int rc = 0;
- pr_debug("enter %s\n", __func__);
- if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- mutex_lock(&handle->buffer_mutex);
- rc = vb2_querybuf(&handle->queue, p);
- mutex_unlock(&handle->buffer_mutex);
- return rc;
- }
- static int vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *p)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int rc = 0;
- if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- mutex_lock(&handle->buffer_mutex);
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 0, 0)
- rc = vb2_qbuf(&handle->queue, NULL, p);
- #else
- rc = vb2_qbuf(&handle->queue, p);
- #endif
- mutex_unlock(&handle->buffer_mutex);
- return rc;
- }
- static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *p)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int rc = 0;
- rc = vb2_dqbuf(&handle->queue, p, file->f_flags & O_NONBLOCK);
- p->field = V4L2_FIELD_NONE;
- p->sequence = handle->sequence++;
- return rc;
- }
- static int vidioc_expbuf(struct file *file, void *priv,
- struct v4l2_exportbuffer *p)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- pr_debug("enter %s\n", __func__);
- return vb2_expbuf(&handle->queue, p);
- }
- static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- pr_debug("enter %s\n", __func__);
- return vb2_streamon(&handle->queue, i);
- }
- static int vidioc_streamoff(struct file *file, void *priv, enum v4l2_buf_type i)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int rc;
- pr_debug("enter %s\n", __func__);
- mutex_lock(&handle->buffer_mutex);
- rc = vb2_streamoff(&handle->queue, i);
- mutex_unlock(&handle->buffer_mutex);
- return rc;
- }
- static int vidioc_enum_input(struct file *filep, void *fh,
- struct v4l2_input *input)
- {
- if (input->index > 0)
- return -EINVAL;
- strlcpy(input->name, "camera", sizeof(input->name));
- input->type = V4L2_INPUT_TYPE_CAMERA;
- return 0;
- }
- static int vidioc_g_input(struct file *filep, void *fh, unsigned int *input)
- {
- *input = 0;
- return 0;
- }
- static int vidioc_s_input(struct file *filep, void *fh, unsigned int input)
- {
- return input == 0 ? 0 : -EINVAL;
- }
- static int vidioc_enum_framesizes(struct file *file, void *priv,
- struct v4l2_frmsizeenum *fsize)
- {
- struct viv_video_device *dev = video_drvdata(file);
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int i;
- if (dev->modeinfocount == 0) {
- viv_post_simple_event(VIV_VIDEO_EVENT_CREATE_PIPELINE,
- handle->streamid, &handle->vfh, true);
- }
- if (fsize->index >= dev->modeinfocount)
- return -EINVAL;
- for (i = 0; i < dev->formatscount; ++i)
- if (dev->formats[i].fourcc == fsize->pixel_format)
- break;
- if (i == dev->formatscount)
- return -EINVAL;
- fsize->stepwise.min_width = 176;
- fsize->stepwise.max_width = dev->modeinfo[fsize->index].w;
- fsize->stepwise.step_width = 16;
- fsize->stepwise.min_height = 144;
- fsize->stepwise.max_height = dev->modeinfo[fsize->index].h;
- fsize->stepwise.step_height = 8;
- fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
- return 0;
- }
- static inline void update_timeperframe(struct file *file)
- {
- struct viv_video_device *dev = video_drvdata(file);
- int i;
- if (dev->timeperframe.numerator == 0 ||
- dev->timeperframe.denominator == 0) {
- dev->timeperframe.numerator = 1;
- dev->timeperframe.denominator = 30;
- for (i = 0; i < dev->modeinfocount; ++i) {
- if (dev->fmt.fmt.pix.width == dev->modeinfo[i].w &&
- dev->fmt.fmt.pix.height == dev->modeinfo[i].h) {
- dev->timeperframe.denominator =
- dev->modeinfo[i].fps;
- break;
- }
- }
- }
- }
- static int vidioc_g_parm(struct file *file, void *fh,
- struct v4l2_streamparm *a)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- update_timeperframe(file);
- memset(&a->parm, 0, sizeof(a->parm));
- a->parm.capture.capability = V4L2_CAP_TIMEPERFRAME;
- a->parm.capture.timeperframe = handle->vdev->timeperframe;
- return 0;
- }
- static int vidioc_s_parm(struct file *file, void *fh,
- struct v4l2_streamparm *a)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct viv_video_device *vdev = handle->vdev;
- struct v4l2_event event;
- struct viv_video_event *v_event;
- if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- if (a->parm.capture.timeperframe.numerator == 0 ||
- a->parm.capture.timeperframe.denominator == 0) {
- update_timeperframe(file);
- memset(&a->parm, 0, sizeof(a->parm));
- a->parm.capture.capability = V4L2_CAP_TIMEPERFRAME;
- a->parm.capture.timeperframe = handle->vdev->timeperframe;
- return 0;
- }
- handle->vdev->timeperframe = a->parm.output.timeperframe;
- if (vdev->ctrls.buf_va == NULL)
- return -EINVAL;
- sprintf(vdev->ctrls.buf_va,"{<id>:<s.fps>;<fps>:%d}",handle->vdev->timeperframe.denominator);
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = 0;
- v_event->file = &handle->vfh;
- v_event->sync = true;
- v_event->addr = vdev->ctrls.buf_pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_EXTCTRL;
- viv_post_event(&event, &handle->vfh, true);
- return 0;
- }
- static int vidioc_enum_frameintervals(struct file *filp, void *priv,
- struct v4l2_frmivalenum *fival)
- {
- struct viv_video_device *dev = video_drvdata(filp);
- struct viv_video_file *handle = priv_to_handle(filp->private_data);
- int i;
- if (dev->modeinfocount == 0) {
- viv_post_simple_event(VIV_VIDEO_EVENT_CREATE_PIPELINE,
- handle->streamid, &handle->vfh, true);
- }
- for (i = 0; i < dev->formatscount; ++i)
- if (dev->formats[i].fourcc == fival->pixel_format)
- break;
- if (i == dev->formatscount)
- return -EINVAL;
- if (fival->index >= dev->modeinfo[0].fps)
- return -EINVAL;
- if (fival->width % 16 || fival->height % 8 ||
- fival->width < 176 || fival->height < 144 ||
- fival->width > dev->modeinfo[0].w ||
- fival->height > dev->modeinfo[0].h)
- return -EINVAL;
- fival->discrete.numerator = 1;
- fival->discrete.denominator = dev->modeinfo[0].fps - fival->index;
- fival->type = V4L2_FRMSIZE_TYPE_DISCRETE;
- return 0;
- }
- static int vidioc_g_pixelaspect(struct file *file, void *fh,
- int buf_type, struct v4l2_fract *aspect)
- {
- if (buf_type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- pr_debug("%s not implemented\n", __func__);
- return 0;
- }
- static int vidioc_g_selection(struct file *file, void *fh,
- struct v4l2_selection *s)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct viv_video_device *vdev = handle->vdev;
- if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- if (vdev->modeinfocount == 0) {
- viv_post_simple_event(VIV_VIDEO_EVENT_CREATE_PIPELINE,
- handle->streamid, &handle->vfh, true);
- }
- switch (s->target) {
- case V4L2_SEL_TGT_CROP_DEFAULT:
- case V4L2_SEL_TGT_CROP_BOUNDS:
- s->r.left = 0;
- s->r.top = 0;
- s->r.width = vdev->compose.width;
- s->r.height = vdev->compose.height;
- break;
- case V4L2_SEL_TGT_CROP:
- s->r = vdev->crop;
- break;
- case V4L2_SEL_TGT_COMPOSE_DEFAULT:
- case V4L2_SEL_TGT_COMPOSE_BOUNDS:
- s->r.left = 0;
- s->r.top = 0;
- s->r.width = 3840;
- s->r.height = 2160;
- break;
- case V4L2_SEL_TGT_COMPOSE:
- s->r = vdev->compose;
- break;
- default:
- return -EINVAL;
- }
- return 0;
- }
- static int vidioc_s_selection(struct file *file, void *fh,
- struct v4l2_selection *s)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- struct viv_video_device *vdev = handle->vdev;
- struct v4l2_rect *r;
- struct v4l2_event event;
- struct viv_video_event *v_event;
- struct viv_rect *rect = (struct viv_rect *)handle->event_buf.va;
- int rc;
- int crop_flag = 1;
- if (!rect)
- return -ENOMEM;
- if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
- return -EINVAL;
- if (vdev->modeinfocount == 0) {
- viv_post_simple_event(VIV_VIDEO_EVENT_CREATE_PIPELINE,
- handle->streamid, &handle->vfh, true);
- }
- switch (s->target) {
- case V4L2_SEL_TGT_CROP:
- r = &vdev->crop;
- break;
- case V4L2_SEL_TGT_COMPOSE:
- r = &vdev->compose;
- break;
- default:
- return -EINVAL;
- }
- if (s->r.top < 0 || s->r.left < 0)
- return -EINVAL;
- if (s->r.width == 0 || s->r.height == 0 ||
- s->r.width > 3840 || s->r.height > 2160)
- return -EINVAL;
- if (s->target == V4L2_SEL_TGT_CROP) {
- if (s->r.left + s->r.width > vdev->compose.width ||
- s->r.top + s->r.height > vdev->compose.height)
- return -EINVAL;
- }
- if (s->target == V4L2_SEL_TGT_COMPOSE) {
- if (vdev->crop.top == 0 &&
- vdev->crop.left == 0 &&
- vdev->crop.width == vdev->compose.width &&
- vdev->crop.height == vdev->compose.height) {
- crop_flag = 0;
- }
- }
- rect->left = s->r.left;
- rect->top = s->r.top;
- rect->width = s->r.width;
- rect->height = s->r.height;
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = handle->streamid;
- v_event->file = &(handle->vfh);
- v_event->sync = true;
- v_event->addr = handle->event_buf.pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- if (s->target == V4L2_SEL_TGT_CROP)
- event.id = VIV_VIDEO_EVENT_SET_CROP;
- else
- event.id = VIV_VIDEO_EVENT_SET_COMPOSE;
- rc = viv_post_event(&event, &handle->vfh, true);
- if (rc == 0) {
- s->r.left = rect->left;
- s->r.top = rect->top;
- s->r.width = rect->width;
- s->r.height = rect->height;
- *r = s->r;
- if (s->target == V4L2_SEL_TGT_COMPOSE && crop_flag == 0) {
- vdev->crop.width = vdev->compose.width;
- vdev->crop.height = vdev->compose.height;
- }
- }
- return rc;
- }
- int viv_gen_g_ctrl(struct v4l2_ctrl *ctrl)
- {
- struct viv_custom_ctrls *cc =
- container_of(ctrl->handler, struct viv_custom_ctrls, handler);
- struct viv_video_device *vdev =
- container_of(cc, struct viv_video_device, ctrls);
- struct v4l2_event event;
- struct viv_video_event *v_event;
- struct v4l2_ctrl_data *p_data;
- struct v4l2_ext_control *p_ctrl;
- pr_debug("%s:ctrl->id=0x%x\n", __func__, ctrl->id);
- memset(&event, 0, sizeof(event));
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->file = NULL;
- v_event->sync = true;
- v_event->addr = vdev->ctrls.buf_pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_EXTCTRL2;
- if(!video_event_subscribed(vdev->video, &event, RETRY_TIMES_MAX)) {
- pr_err("%s: unsubscribed event id =%d type=0x%08x",
- __func__, event.id, event.type);
- return -EINVAL;
- }
- p_data = (struct v4l2_ctrl_data *)vdev->ctrls.buf_va;
- if (unlikely(!p_data))
- return -ENOMEM;
- memset(p_data, 0, sizeof(*p_data));
- p_data->dir = V4L2_CTRL_GET;
- p_data->ctrls.count = 1;
- p_ctrl = nextof(p_data, struct v4l2_ext_control *);
- p_ctrl->id = ctrl->id;
- reinit_completion(&vdev->ctrls.wait);
- v4l2_event_queue(vdev->video, &event);
- if (wait_for_completion_timeout(&vdev->ctrls.wait,
- msecs_to_jiffies(VIV_VIDEO_EVENT_TIMOUT_MS)) == 0) {
- pr_err("connecting to server timed out (g)!");
- *ctrl->p_new.p_s32 = *ctrl->p_cur.p_s32;
- return 0;
- }
- if (p_ctrl->id == ctrl->id && !p_data->ret) {
- *ctrl->p_new.p_s32 = p_ctrl->value;
- return 0;
- }
- return -EINVAL;
- }
- int viv_gen_s_ctrl(struct v4l2_ctrl *ctrl)
- {
- struct viv_custom_ctrls *cc =
- container_of(ctrl->handler, struct viv_custom_ctrls, handler);
- struct viv_video_device *vdev =
- container_of(cc, struct viv_video_device, ctrls);
- struct v4l2_event event;
- struct viv_video_event *v_event;
- struct v4l2_ctrl_data *p_data;
- struct v4l2_ext_control *p_ctrl;
- pr_debug("%s:ctrl->id=0x%x\n", __func__, ctrl->id);
- memset(&event, 0, sizeof(event));
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->file = NULL;
- v_event->sync = true;
- v_event->addr = vdev->ctrls.buf_pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_EXTCTRL2;
- if(!video_event_subscribed(vdev->video, &event, RETRY_TIMES_MAX)) {
- pr_err("%s: unsubscribed event id =%d type=0x%08x",
- __func__, event.id, event.type);
- return -EINVAL;
- }
- p_data = (struct v4l2_ctrl_data *)vdev->ctrls.buf_va;
- if (unlikely(!p_data))
- return -ENOMEM;
- memset(p_data, 0, sizeof(*p_data));
- p_data->dir = V4L2_CTRL_SET;
- p_data->ctrls.count = 1;
- p_ctrl = nextof(p_data, struct v4l2_ext_control *);
- p_ctrl->id = ctrl->id;
- p_ctrl->value = *ctrl->p_new.p_s32;
- reinit_completion(&vdev->ctrls.wait);
- v4l2_event_queue(vdev->video, &event);
- if (wait_for_completion_timeout(&vdev->ctrls.wait,
- msecs_to_jiffies(VIV_VIDEO_EVENT_TIMOUT_MS)) == 0) {
- pr_err("connecting to server timed out (s)!");
- return 0;
- }
- if (p_ctrl->id == ctrl->id && !p_data->ret)
- return 0;
- return -EINVAL;
- }
- static const struct v4l2_ioctl_ops video_ioctl_ops = {
- .vidioc_querycap = video_querycap,
- .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
- .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
- .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
- .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
- .vidioc_reqbufs = vidioc_reqbufs,
- .vidioc_querybuf = vidioc_querybuf,
- .vidioc_qbuf = vidioc_qbuf,
- .vidioc_expbuf = vidioc_expbuf,
- .vidioc_dqbuf = vidioc_dqbuf,
- .vidioc_streamon = vidioc_streamon,
- .vidioc_streamoff = vidioc_streamoff,
- .vidioc_subscribe_event = subscribe_event,
- .vidioc_unsubscribe_event = unsubscribe_event,
- .vidioc_default = private_ioctl,
- .vidioc_enum_input = vidioc_enum_input,
- .vidioc_g_input = vidioc_g_input,
- .vidioc_s_input = vidioc_s_input,
- .vidioc_enum_framesizes = vidioc_enum_framesizes,
- .vidioc_enum_frameintervals = vidioc_enum_frameintervals,
- .vidioc_g_parm = vidioc_g_parm,
- .vidioc_s_parm = vidioc_s_parm,
- .vidioc_g_pixelaspect = vidioc_g_pixelaspect,
- .vidioc_g_selection = vidioc_g_selection,
- .vidioc_s_selection = vidioc_s_selection,
- };
- /* sys /dev/mem can't map large memory size */
- static int viv_private_mmap(struct file *file, struct vm_area_struct *vma)
- {
- /* Map reserved video memory. */
- if (remap_pfn_range(vma, vma->vm_start, vma->vm_pgoff,
- vma->vm_end - vma->vm_start, vma->vm_page_prot))
- return -EAGAIN;
- return 0;
- }
- int vidioc_mmap(struct file *file, struct vm_area_struct *vma)
- {
- int rc;
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- #ifndef ENABLE_IRQ
- struct viv_video_device *dev = video_drvdata(file);
- struct reserved_mem *rmem = (struct reserved_mem *)dev->rmem;
- unsigned long reserved_base_addr = 0;
- if (!rmem)
- reserved_base_addr = 0;
- else
- reserved_base_addr = rmem->base;
- #endif
- #ifdef ENABLE_IRQ
- if (handle->streamid < 0)
- #else
- if (vma->vm_pgoff >= (reserved_base_addr >> PAGE_SHIFT))
- #endif
- rc = viv_private_mmap(file, vma);
- else
- rc = vb2_mmap(&handle->queue, vma);
- return rc;
- }
- static unsigned int video_poll(struct file *file,
- struct poll_table_struct *wait)
- {
- struct viv_video_file *handle = priv_to_handle(file->private_data);
- int rc = 0;
- if (handle->streamid < 0) {
- poll_wait(file, &handle->vfh.wait, wait);
- if (v4l2_event_pending(&handle->vfh))
- rc = POLLIN | POLLRDNORM;
- } else {
- mutex_lock(&handle->buffer_mutex);
- rc = vb2_poll(&handle->queue, file, wait) |
- v4l2_ctrl_poll(file, wait);
- mutex_unlock(&handle->buffer_mutex);
- }
- return rc;
- }
- static struct v4l2_file_operations video_ops = {
- .owner = THIS_MODULE,
- .open = video_open,
- .release = video_close,
- .poll = video_poll,
- .unlocked_ioctl = video_ioctl2,
- .mmap = vidioc_mmap,
- };
- static void pdev_release(struct device *dev)
- {
- pr_debug("enter %s\n", __func__);
- }
- static struct platform_device viv_pdev = {
- .name = "vvcam-video",
- .dev.release = pdev_release,
- };
- static int viv_s_ctrl(struct v4l2_ctrl *ctrl)
- {
- struct v4l2_event event;
- struct viv_video_event *v_event;
- struct viv_custom_ctrls *cc =
- container_of(ctrl->handler, struct viv_custom_ctrls, handler);
- struct viv_video_device *vdev =
- container_of(cc, struct viv_video_device, ctrls);
- int ret = -1;
- char *szbuf = NULL;
- unsigned long timeout =
- msecs_to_jiffies(VIV_VIDEO_EVENT_TIMOUT_MS);
- switch (ctrl->id) {
- case V4L2_CID_VIV_STRING: {
- ret = 0;
- szbuf = (char *)vdev->ctrls.buf_va;
- if (!ctrl->p_new.p_char || !szbuf)
- return -EINVAL;
- strcpy(szbuf, ctrl->p_new.p_char);
- v_event = (struct viv_video_event *)&event.u.data[0];
- v_event->stream_id = 0;
- v_event->file = NULL;
- v_event->sync = true;
- v_event->addr = vdev->ctrls.buf_pa;
- event.type = VIV_VIDEO_EVENT_TYPE;
- event.id = VIV_VIDEO_EVENT_EXTCTRL;
- if(!video_event_subscribed(vdev->video, &event, RETRY_TIMES_MAX)) {
- pr_err("%s: unsubscribed event id =%d type=0x%08x",
- __func__, event.id, event.type);
- return -EINVAL;
- }
- reinit_completion(&vdev->ctrls.wait);
- v4l2_event_queue(vdev->video, &event);
- if (!wait_for_completion_timeout(&vdev->ctrls.wait, timeout))
- ret = -ETIMEDOUT;
- strcpy(ctrl->p_new.p_char, szbuf);
- break;
- }
- }
- return ret;
- }
- static const struct v4l2_ctrl_ops viv_ctrl_ops = {
- .s_ctrl = viv_s_ctrl,
- };
- static const struct v4l2_ctrl_config viv_ext_ctrl = {
- .ops = &viv_ctrl_ops,
- .id = V4L2_CID_VIV_STRING,
- .name = "viv_ext_ctrl",
- .type = V4L2_CTRL_TYPE_STRING,
- .max = VIV_JSON_BUFFER_SIZE-1,
- .step = 1,
- };
- #ifdef ENABLE_IRQ
- static int viv_notifier_bound(struct v4l2_async_notifier *notifier,
- struct v4l2_subdev *sd, struct v4l2_async_subdev *asd)
- {
- int i;
- struct viv_video_device *dev = container_of(notifier,
- struct viv_video_device, subdev_notifier);
- if (!dev)
- return 0;
- for (i = 0; i < dev->asdcount; ++i) {
- if (dev->asd[i]->match_type == V4L2_ASYNC_MATCH_FWNODE) {
- if (sd->dev && dev->asd[i]->match.fwnode ==
- of_fwnode_handle(sd->dev->of_node)) {
- dev->subdevs[dev->sdcount] = sd;
- dev->sdcount++;
- break;
- }
- } else if (dev->asd[i]->match_type ==
- V4L2_ASYNC_MATCH_DEVNAME) {
- if (sd->dev && !strcmp(dev->asd[i]->match.device_name,
- dev_name(sd->dev))) {
- dev->subdevs[dev->sdcount] = sd;
- dev->sdcount++;
- break;
- }
- }
- }
- return 0;
- }
- static int viv_notifier_complete(struct v4l2_async_notifier *notifier)
- {
- struct viv_video_device *dev = container_of(notifier,
- struct viv_video_device, subdev_notifier);
- int rc;
- if (!dev)
- return 0;
- if (dev->sdcount > 0) {
- mutex_lock(&dev->mdev->graph_mutex);
- rc = viv_create_default_links(dev);
- mutex_unlock(&dev->mdev->graph_mutex);
- if (rc) {
- pr_err("failed to create media links!\n");
- return rc;
- }
- }
- return v4l2_device_register_subdev_nodes(dev->v4l2_dev);
- }
- static const struct v4l2_async_notifier_operations sd_async_notifier_ops = {
- .bound = viv_notifier_bound,
- .complete = viv_notifier_complete,
- };
- static int viv_mdev_link_notify(struct media_link *link, unsigned int flags,
- unsigned int notification)
- {
- return 0;
- }
- static const struct media_device_ops viv_mdev_ops = {
- .link_notify = viv_mdev_link_notify,
- };
- static int viv_link_setup(struct media_entity *entity,
- const struct media_pad *local,
- const struct media_pad *remote, u32 flags)
- {
- return 0;
- }
- static const struct media_entity_operations viv_media_ops = {
- .link_setup = viv_link_setup,
- .link_validate = v4l2_subdev_link_validate,
- };
- static void viv_buf_notify(struct vvbuf_ctx *ctx, struct vb2_dc_buf *buf)
- {
- struct viv_video_file *fh;
- struct viv_video_device *vdev;
- u64 cur_ts, interval;
- u32 fps;
- int i;
- if (!buf || buf->vb.vb2_buf.state != VB2_BUF_STATE_ACTIVE)
- return;
- fh = container_of(buf->vb.vb2_buf.vb2_queue,
- struct viv_video_file, queue);
- vdev = fh->vdev;
- if (!vdev->active)
- return;
- buf->vb.vb2_buf.planes[DEF_PLANE_NO].bytesused =
- vdev->fmt.fmt.pix.sizeimage;
- cur_ts = ktime_get_ns();
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 0, 0)
- buf->vb.vb2_buf.timestamp = cur_ts;
- #endif
- vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE);
- /* print fps info for debugging purpose */
- interval = ktime_us_delta(cur_ts,vdev->last_ts);
- for (i = 0; i < VIDEO_NODE_NUM; i++) {
- if (vdev->id == i) {
- if (vdev->duration >= 3 * 1000000/*ms*/) {
- vdev->loop_cnt[i]++;
- if (vdev->loop_cnt[i] >= 10) {
- if (vdev->frame_flag) {
- fps = vdev->frameCnt[i] * 100000000 / vdev->duration;
- pr_info("###### video%d(%d) %d.%02d fps ######\n",
- vdev->video->num, vdev->id,
- fps / 100, fps % 100);
- } else {
- vdev->frame_flag = true;
- }
- vdev->loop_cnt[i] = 0;
- }
- vdev->frameCnt[i] = 0;
- vdev->duration = 0;
- } else if (interval > 0) {
- vdev->frameCnt[i]++;
- vdev->duration += interval;
- }
- }
- }
- vdev->last_ts = cur_ts;
- }
- static const struct vvbuf_ops viv_buf_ops = {
- .notify = viv_buf_notify,
- };
- #endif
- struct dev_node {
- enum v4l2_async_match_type match_type;
- struct device_node *node;
- int id;
- const char *name;
- };
- static const char * const dwe_dev_compat_name[] = {
- "32e30000.dwe", "fsl,fake-imx8mp-dwe.1"};
- static inline int viv_find_compatible_nodes(struct dev_node *nodes, int size)
- {
- static const char * const compat_name[] = {
- ISP_COMPAT_NAME};
- struct device_node *node, *avail;
- int i, rc, id, cnt = 0;
- for (i = 0; i < ARRAY_SIZE(compat_name) && cnt < size; ++i) {
- node = NULL;
- for (; cnt < size;) {
- node = of_find_compatible_node(node,
- NULL, compat_name[i]);
- if (!node)
- break;
- avail = NULL;
- id = -1;
- rc = fwnode_property_read_u32(
- of_fwnode_handle(node), "id", &id);
- if (rc) {
- if (of_device_is_available(node))
- avail = node;
- } else if (of_device_is_available(node))
- avail = node;
- if (avail) {
- nodes[cnt].node = avail;
- nodes[cnt].id = id;
- nodes[cnt].match_type = V4L2_ASYNC_MATCH_FWNODE;
- cnt++;
- nodes[cnt].id = id;
- nodes[cnt].match_type = V4L2_ASYNC_MATCH_DEVNAME;
- nodes[cnt].name = dwe_dev_compat_name[id];
- cnt++;
- }
- }
- }
- return cnt;
- }
- static struct reserved_mem * viv_find_isp_reserve_mem(int dev_id)
- {
- int i,rc;
- int id=0;
- struct device_node *node = NULL;
- struct device_node *mem_node;
- for (i=0; i<VIDEO_NODE_NUM; i++)
- {
- node = of_find_compatible_node(node,
- NULL, ISP_COMPAT_NAME);
- if (!node)
- break;
- rc = fwnode_property_read_u32(
- of_fwnode_handle(node), "id", &id);
- if (rc) {
- pr_err("%s:get fwnode id failed \n",__func__);
- break;
- }
- if (id == dev_id) {
- of_node_put(node);
- mem_node = of_parse_phandle(node, "memory-region", 0);
- if (!mem_node) {
- pr_err("No memory-region found\n");
- return NULL;
- }
- return of_reserved_mem_lookup(mem_node);
- }
- }
- if (node)
- of_node_put(node);
- return NULL;
- }
- static int viv_video_probe(struct platform_device *pdev)
- {
- struct viv_video_device *vdev;
- int rc = 0;
- int i,m, video_id;
- struct dev_node nodes[MAX_SUBDEVS_NUM];
- int nodecount;
- #ifdef ENABLE_IRQ
- int j;
- struct v4l2_async_subdev *asd;
- strscpy(mdev.model, "viv_media", sizeof(mdev.model));
- mdev.ops = &viv_mdev_ops;
- mdev.dev = &pdev->dev;
- media_device_init(&mdev);
- #endif
- memset(nodes, 0, sizeof(nodes));
- nodecount = viv_find_compatible_nodes(nodes, MAX_SUBDEVS_NUM);
- for (i = 0; i < VIDEO_NODE_NUM && i*2 < nodecount; i++) {
- if(nodes[i*2].node) {
- video_id = nodes[i*2].id ;
- if(video_id >= VIDEO_NODE_NUM) {
- pr_err("%s: id %d is too large (id > %d) \n",
- __func__, video_id, VIDEO_NODE_NUM);
- rc = -EINVAL;
- goto probe_end;
- }
- spin_lock_init(&file_list_lock[video_id]);
- INIT_LIST_HEAD(&file_list_head[video_id]);
- vvdev[video_id] = kzalloc(sizeof(*vdev), GFP_KERNEL);
- if (WARN_ON(!vvdev[video_id])) {
- rc = -ENOMEM;
- goto probe_end;
- }
- vdev = vvdev[video_id];
- vdev->id = video_id;
- vdev->rmem = viv_find_isp_reserve_mem(vdev->id);
- vdev->v4l2_dev = kzalloc(sizeof(*vdev->v4l2_dev), GFP_KERNEL);
- if (WARN_ON(!vdev->v4l2_dev)) {
- rc = -ENOMEM;
- goto probe_end;
- }
- init_completion(&vdev->subscribed_wait);
- vdev->subscribed_cnt = 0;
- vdev->video = video_device_alloc();
- vdev->video->v4l2_dev = vdev->v4l2_dev;
- rc = v4l2_device_register(&pdev->dev, vdev->video->v4l2_dev);
- if (WARN_ON(rc < 0))
- goto register_fail;
- sprintf(vdev->video->name, "viv_v4l2%d", video_id);
- v4l2_ctrl_handler_init(&vdev->ctrls.handler, 1);
- vdev->ctrls.request = v4l2_ctrl_new_custom(&vdev->ctrls.handler,
- &viv_ext_ctrl, NULL);
- create_controls(&vdev->ctrls.handler);
- vdev->video->release = video_device_release;
- vdev->video->fops = &video_ops;
- vdev->video->ioctl_ops = &video_ioctl_ops;
- vdev->video->minor = -1;
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 10, 0)
- vdev->video->vfl_type = VFL_TYPE_VIDEO;
- #else
- vdev->video->vfl_type = VFL_TYPE_GRABBER;
- #endif
- vdev->video->ctrl_handler = &vdev->ctrls.handler;
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 0, 0)
- vdev->video->device_caps =
- V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING;
- #endif
- #ifdef ENABLE_IRQ
- video_set_drvdata(vdev->video, vdev);
- vvbuf_ctx_init(&vdev->bctx);
- vdev->bctx.ops = &viv_buf_ops;
- vdev->mdev = &mdev;
- vdev->v4l2_dev->mdev = &mdev;
- vdev->video->entity.name = vdev->video->name;
- vdev->video->entity.obj_type = MEDIA_ENTITY_TYPE_VIDEO_DEVICE;
- vdev->video->entity.function = MEDIA_ENT_F_IO_V4L;
- vdev->video->entity.ops = &viv_media_ops;
- vdev->pad.flags = MEDIA_PAD_FL_SINK | MEDIA_PAD_FL_MUST_CONNECT;
- rc = media_entity_pads_init(&vdev->video->entity,
- 1, &vdev->pad);
- if (WARN_ON(rc < 0))
- goto register_fail;
- v4l2_async_notifier_init(&vdev->subdev_notifier);
- vdev->subdev_notifier.ops = &sd_async_notifier_ops;
- #endif
- #if LINUX_VERSION_CODE > KERNEL_VERSION(5, 10, 0)
- rc = video_register_device(vdev->video, VFL_TYPE_VIDEO, -1);
- #else
- rc = video_register_device(vdev->video, VFL_TYPE_GRABBER, -1);
- #endif
- if (WARN_ON(rc < 0))
- goto register_fail;
- #ifdef ENABLE_IRQ
- for (j = 0; j < nodecount; ++j) {
- if (nodes[j].id == video_id) {
- switch (nodes[j].match_type) {
- case V4L2_ASYNC_MATCH_FWNODE:
- asd = v4l2_async_notifier_add_fwnode_subdev(
- &vdev->subdev_notifier,
- of_fwnode_handle(nodes[j].node),
- sizeof(struct v4l2_async_subdev));
- break;
- case V4L2_ASYNC_MATCH_DEVNAME:
- asd = v4l2_async_notifier_add_devname_subdev(
- &vdev->subdev_notifier,
- nodes[j].name,
- sizeof(struct v4l2_async_subdev));
- break;
- default:
- asd = NULL;
- break;
- }
- if (asd) {
- vdev->asd[vdev->asdcount] = asd;
- vdev->asdcount++;
- }
- }
- }
- rc = v4l2_async_notifier_register(vdev->v4l2_dev,
- &vdev->subdev_notifier);
- if (WARN_ON(rc < 0))
- goto register_fail;
- #else
- video_set_drvdata(vdev->video, vdev);
- rc = v4l2_device_register_subdev_nodes(vdev->v4l2_dev);
- #endif
- vdev->ctrls.buf_va = kmalloc(VIV_JSON_BUFFER_SIZE, GFP_KERNEL);
- vdev->ctrls.buf_pa = __pa(vdev->ctrls.buf_va);
- init_completion(&vdev->ctrls.wait);
- vdev->fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
- vdev->fmt.fmt.pix.field = V4L2_FIELD_NONE;
- vdev->fmt.fmt.pix.colorspace = V4L2_COLORSPACE_REC709;
- if (sizeof(vdev->formats) >= sizeof(formats)) {
- memcpy(vdev->formats, formats, sizeof(formats));
- vdev->formatscount = ARRAY_SIZE(formats);
- }
- for (m = 0; m < VIDEO_NODE_NUM; m++) {
- vdev->loop_cnt[m] = 0;
- vdev->frameCnt[m] = 0;
- }
- vdev->duration = 0;
- vdev->last_ts = 0;
- continue;
- register_fail:
- video_device_release(vdev->video);
- }
- }
- #ifdef ENABLE_IRQ
- if (!rc)
- rc = media_device_register(&mdev);
- #endif
- probe_end:
- return rc;
- }
- static int viv_video_remove(struct platform_device *pdev)
- {
- struct viv_video_device *vdev;
- int i;
- for (i = VIDEO_NODE_NUM-1; i >= 0; i--) {
- vdev = vvdev[i];
- if (!vdev || !vdev->video)
- continue;
- #ifdef ENABLE_IRQ
- media_entity_cleanup(&vdev->video->entity);
- v4l2_async_notifier_cleanup(&vdev->subdev_notifier);
- v4l2_async_notifier_unregister(&vdev->subdev_notifier);
- v4l2_device_unregister(vdev->v4l2_dev);
- kfree(vdev->v4l2_dev);
- #endif
- video_unregister_device(vdev->video);
- #ifdef ENABLE_IRQ
- vvbuf_ctx_deinit(&vdev->bctx);
- #else
- v4l2_device_disconnect(vdev->video->v4l2_dev);
- v4l2_device_put(vdev->video->v4l2_dev);
- #endif
- kfree(vdev->ctrls.buf_va);
- v4l2_ctrl_handler_free(&vdev->ctrls.handler);
- kfree(vvdev[i]);
- vvdev[i] = NULL;
- }
- #ifdef ENABLE_IRQ
- media_device_unregister(&mdev);
- media_device_cleanup(&mdev);
- #endif
- return 0;
- }
- static struct platform_driver viv_video_driver = {
- .probe = viv_video_probe,
- .remove = viv_video_remove,
- .driver = {
- .name = "vvcam-video",
- .owner = THIS_MODULE,
- },
- };
- static int __init viv_video_init_module(void)
- {
- int ret = 0;
- pr_info("enter %s\n", __func__);
- ret = platform_device_register(&viv_pdev);
- if (ret) {
- pr_err("register platform device failed.\n");
- return ret;
- }
- ret = platform_driver_register(&viv_video_driver);
- if (ret) {
- pr_err("register platform driver failed.\n");
- platform_device_unregister(&viv_pdev);
- return ret;
- }
- return ret;
- }
- static void __exit viv_video_exit_module(void)
- {
- pr_info("enter %s\n", __func__);
- platform_driver_unregister(&viv_video_driver);
- msleep(100);
- platform_device_unregister(&viv_pdev);
- }
- module_init(viv_video_init_module);
- module_exit(viv_video_exit_module);
- MODULE_DESCRIPTION("Verisilicon V4L2 video driver");
- MODULE_AUTHOR("Verisilicon ISP SW Team");
- MODULE_LICENSE("GPL v2");
|