123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665 |
- /*
- * Copyright (c) 2019, Chips&Media
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright notice,
- * this list of conditions and the following disclaimer in the documentation
- * and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
- * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
- * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
- * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
- * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #if defined(linux) || defined(__linux) || defined(ANDROID)
- #include <ctype.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <unistd.h>
- #ifdef _KERNEL_
- #include <linux/delay.h>
- #endif
- #include <signal.h> /* SIGIO */
- #include <fcntl.h> /* fcntl */
- #include <pthread.h>
- #include <sys/mman.h> /* mmap */
- #include <sys/ioctl.h> /* fopen/fread */
- #include <sys/errno.h> /* fopen/fread */
- #include <sys/types.h>
- #include <sys/time.h>
- #include "driver/vpu.h"
- #include "../vdi.h"
- #include "../vdi_osal.h"
- #include "coda9/coda9_regdefine.h"
- #include "wave/wave5_regdefine.h"
- #include "main_helper.h"
- #include "misc/debug.h"
- #define VPU_DEVICE_NAME "/dev/vdec"
- typedef pthread_mutex_t MUTEX_HANDLE;
- # define SUPPORT_INTERRUPT
- # define VDI_SRAM_BASE_ADDR 0x00000000 // if we can know the sram address in SOC directly for vdi layer. it is possible to set in vdi layer without allocation from driver
- #define VDI_SYSTEM_ENDIAN VDI_LITTLE_ENDIAN
- #define VDI_128BIT_BUS_SYSTEM_ENDIAN VDI_128BIT_LITTLE_ENDIAN
- #define VPU_BIT_REG_SIZE (0x4000*MAX_NUM_VPU_CORE)
- #define VDI_CODA9_SRAM_SIZE 0x34600 // FHD MAX size, 0x17D00 4K MAX size 0x34600
- #define VDI_WAVE511_SRAM_SIZE 0x2D000 /* H.265 Main10 : 8Kx4K -> 184320, 4Kx2K -> 92160
- * H.265 Main : 8Kx4K -> 155648, 4Kx2K -> 77824
- */
- #define VDI_WAVE521_SRAM_SIZE 0x20400 /* 10bit profile : 8Kx8K -> 132096, 4Kx2K -> 66560
- * 8bit profile : 8Kx8K -> 99328, 4Kx2K -> 51176
- */
- #define VDI_WAVE521C_SRAM_SIZE 0x2D000 /* H.265 Main10 : 8Kx4K -> 184320, 4Kx2K -> 92160
- * H.265 Main : 8Kx4K -> 155648, 4Kx2K -> 77824
- * NOTE: Decoder > Encoder
- */
- #define VDI_NUM_LOCK_HANDLES 4
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- #define VPU_CORE_BASE_OFFSET 0x4000
- #endif
- typedef struct vpudrv_buffer_pool_t
- {
- vpudrv_buffer_t vdb;
- int inuse;
- } vpudrv_buffer_pool_t;
- typedef struct {
- unsigned long core_idx;
- unsigned int product_code;
- int vpu_fd;
- vpu_instance_pool_t *pvip;
- int task_num;
- int clock_state;
- vpudrv_buffer_t vdb_register;
- vpu_buffer_t vpu_common_memory;
- vpudrv_buffer_pool_t vpu_buffer_pool[MAX_VPU_BUFFER_POOL];
- int vpu_buffer_pool_count;
- void* vpu_mutex;
- void* vpu_omx_mutex;
- void* vpu_disp_mutex;
- void* vmem_mutex;
- } vdi_info_t;
- static vdi_info_t s_vdi_info[MAX_NUM_VPU_CORE];
- static int swap_endian(unsigned long core_idx, unsigned char *data, int len, int endian);
- void vdi_flush_ddr(unsigned long core_idx,unsigned long start,unsigned long size,unsigned char flag)
- {
- vdi_info_t *vdi;
- vpudrv_flush_cache_t cache_info;
-
- vdi = &s_vdi_info[core_idx];
- cache_info.start = start;
- cache_info.size = size;
- cache_info.flag = flag;
- ioctl(vdi->vpu_fd, VDI_IOCTL_FLUSH_DCACHE, &cache_info);
- }
- static void restore_mutex_in_dead(MUTEX_HANDLE *mutex)
- {
- int mutex_value;
- if (!mutex)
- return;
- #if defined(ANDROID)
- mutex_value = mutex->value;
- #else
- memcpy(&mutex_value, mutex, sizeof(mutex_value));
- #endif
- if (mutex_value == (int)0xdead10cc) // destroy by device driver
- {
- pthread_mutexattr_t mutexattr;
- pthread_mutexattr_init(&mutexattr);
- pthread_mutexattr_setpshared(&mutexattr, PTHREAD_PROCESS_SHARED);
- pthread_mutex_init(mutex, &mutexattr);
- }
- }
- static void vmem_lock(vdi_info_t* vdi)
- {
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- #else
- const int MUTEX_TIMEOUT = 0x7fffffff;
- #endif
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- restore_mutex_in_dead((MUTEX_HANDLE *)vdi->vmem_mutex);
- pthread_mutex_lock((MUTEX_HANDLE*)vdi->vmem_mutex);
- #else
- if (pthread_mutex_lock((MUTEX_HANDLE *)vdi->vmem_mutex) != 0) {
- VLOG(ERR, "%s:%d failed to pthread_mutex_locK\n", __FUNCTION__, __LINE__);
- }
- #endif
- return; //lint !e454
- }
- static void vmem_unlock(vdi_info_t* vdi)
- {
- pthread_mutex_unlock((MUTEX_HANDLE *)vdi->vmem_mutex);//lint !e455
- }
- int vdi_probe(unsigned long core_idx)
- {
- int ret;
- ret = vdi_init(core_idx);
- vdi_release(core_idx);
- return ret;
- }
- int vdi_init(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- int i;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return 0;
- vdi = &s_vdi_info[core_idx];
- if (vdi->vpu_fd != -1 && vdi->vpu_fd != 0x00)
- {
- vdi->task_num++;
- return 0;
- }
- vdi->vpu_fd = open(VPU_DEVICE_NAME, O_RDWR); // if this API supports VPU parallel processing using multi VPU. the driver should be made to open multiple times.
- if (vdi->vpu_fd < 0) {
- VLOG(ERR, "[VDI] Can't open vpu driver. [error=%s]. try to run vdi/linux/driver/load.sh script \n", strerror(errno));
- return -1;
- }
- memset(vdi->vpu_buffer_pool, 0x00, sizeof(vpudrv_buffer_pool_t)*MAX_VPU_BUFFER_POOL);
- if (!vdi_get_instance_pool(core_idx))
- {
- VLOG(INFO, "[VDI] fail to create shared info for saving context \n");
- goto ERR_VDI_INIT;
- }
- if (vdi->pvip->instance_pool_inited == FALSE)
- {
- int* pCodecInst;
- pthread_mutexattr_t mutexattr;
- pthread_mutexattr_init(&mutexattr);
- pthread_mutexattr_setpshared(&mutexattr, PTHREAD_PROCESS_SHARED);
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- #else
- /* If a process or a thread is terminated abnormally,
- * pthread_mutexattr_setrobust_np(attr, PTHREAD_MUTEX_ROBUST_NP) makes
- * next onwer call pthread_mutex_lock() without deadlock.
- */
- pthread_mutexattr_setrobust_np(&mutexattr, PTHREAD_MUTEX_ROBUST_NP);
- #endif
- pthread_mutex_init((MUTEX_HANDLE *)vdi->vpu_mutex, &mutexattr);
- pthread_mutex_init((MUTEX_HANDLE *)vdi->vpu_disp_mutex, &mutexattr);
- pthread_mutex_init((MUTEX_HANDLE *)vdi->vmem_mutex, &mutexattr);
- for( i = 0; i < MAX_NUM_INSTANCE; i++) {
- pCodecInst = (int *)vdi->pvip->codecInstPool[i];
- pCodecInst[1] = i; // indicate instIndex of CodecInst
- pCodecInst[0] = 0; // indicate inUse of CodecInst
- }
- vdi->pvip->instance_pool_inited = TRUE;
- }
- #ifdef USE_VMALLOC_FOR_INSTANCE_POOL_MEMORY
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_GET_REGISTER_INFO, &vdi->vdb_register) < 0)
- {
- VLOG(ERR, "[VDI] fail to get host interface register\n");
- goto ERR_VDI_INIT;
- }
- #endif
- #ifdef USE_VMALLOC_FOR_INSTANCE_POOL_MEMORY
- vdi->vdb_register.virt_addr = (unsigned long)mmap(NULL, vdi->vdb_register.size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, vdi->vdb_register.phys_addr);
- #else
- vdi->vdb_register.size = VPU_BIT_REG_SIZE;
- vdi->vdb_register.virt_addr = (unsigned long)mmap(NULL, vdi->vdb_register.size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, 0);
- #endif
- if ((void *)vdi->vdb_register.virt_addr == MAP_FAILED)
- {
- VLOG(ERR, "[VDI] fail to map vpu registers \n");
- goto ERR_VDI_INIT;
- }
- VLOG(INFO, "[VDI] map vdb_register core_idx=%d, virtaddr=0x%lx, size=%d\n", core_idx, vdi->vdb_register.virt_addr, vdi->vdb_register.size);
- if (vdi_lock(core_idx) < 0)
- {
- VLOG(ERR, "[VDI] fail to handle lock function\n");
- goto ERR_VDI_INIT;
- }
- vdi_set_clock_gate(core_idx, 1);
- vdi->product_code = vdi_read_register(core_idx, VPU_PRODUCT_CODE_REGISTER);
- if (vdi_allocate_common_memory(core_idx) < 0)
- {
- VLOG(ERR, "[VDI] fail to get vpu common buffer from driver\n");
- goto ERR_VDI_INIT;
- }
- vdi->core_idx = core_idx;
- vdi->task_num++;
- vdi_set_clock_gate(core_idx, 0);
- vdi_unlock(core_idx);
- VLOG(INFO, "[VDI] success to init driver \n");
- return 0;
- ERR_VDI_INIT:
- vdi_unlock(core_idx);
- vdi_release(core_idx);
- return -1;
- }
- int vdi_set_bit_firmware_to_pm(unsigned long core_idx, const unsigned short *code)
- {
- int i;
- vpu_bit_firmware_info_t bit_firmware_info;
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return 0;
- vdi = &s_vdi_info[core_idx];
- if (!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return 0;
- bit_firmware_info.size = sizeof(vpu_bit_firmware_info_t);
- bit_firmware_info.core_idx = core_idx;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- bit_firmware_info.reg_base_offset = (core_idx*VPU_CORE_BASE_OFFSET);
- #else
- bit_firmware_info.reg_base_offset = 0;
- #endif
- for (i=0; i<512; i++)
- bit_firmware_info.bit_code[i] = code[i];
- if (write(vdi->vpu_fd, &bit_firmware_info, bit_firmware_info.size) < 0)
- {
- VLOG(ERR, "[VDI] fail to vdi_set_bit_firmware core=%d\n", bit_firmware_info.core_idx);
- return -1;
- }
- return 0;
- }
- #if defined(SUPPORT_SW_UART) || defined(SUPPORT_SW_UART_V2)
- int vdi_get_task_num(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- vdi = &s_vdi_info[core_idx];
- if (!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- return vdi->task_num;
- }
- #endif
- int vdi_release(unsigned long core_idx)
- {
- int i;
- vpudrv_buffer_t vdb;
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return 0;
- vdi = &s_vdi_info[core_idx];
- if (!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return 0;
- if (vdi_lock(core_idx) < 0)
- {
- VLOG(ERR, "[VDI] fail to handle lock function\n");
- return -1;
- }
- if (vdi->task_num > 1) // means that the opened instance remains
- {
- vdi->task_num--;
- vdi_unlock(core_idx);
- return 0;
- }
- if (vdi->vdb_register.virt_addr)
- munmap((void *)vdi->vdb_register.virt_addr, vdi->vdb_register.size);
- osal_memset(&vdi->vdb_register, 0x00, sizeof(vpudrv_buffer_t));
- vdb.size = 0;
- // get common memory information to free virtual address
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_common_memory.phys_addr >= vdi->vpu_buffer_pool[i].vdb.phys_addr &&
- vdi->vpu_common_memory.phys_addr < (vdi->vpu_buffer_pool[i].vdb.phys_addr + vdi->vpu_buffer_pool[i].vdb.size))
- {
- vdi->vpu_buffer_pool[i].inuse = 0;
- vdi->vpu_buffer_pool_count--;
- vdb = vdi->vpu_buffer_pool[i].vdb;
- break;
- }
- }
- vdi_unlock(core_idx);
- if (vdb.size > 0)
- {
- munmap((void *)vdb.virt_addr, vdb.size);
- memset(&vdi->vpu_common_memory, 0x00, sizeof(vpu_buffer_t));
- }
- vdi->task_num--;
- if (vdi->vpu_fd != -1 && vdi->vpu_fd != 0x00)
- {
- close(vdi->vpu_fd);
- vdi->vpu_fd = -1;
- }
- memset(vdi, 0x00, sizeof(vdi_info_t));
- return 0;
- }
- int vdi_get_common_memory(unsigned long core_idx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd==0x00)
- return -1;
- osal_memcpy(vb, &vdi->vpu_common_memory, sizeof(vpu_buffer_t));
- return 0;
- }
- int vdi_allocate_common_memory(unsigned long core_idx)
- {
- vdi_info_t *vdi = &s_vdi_info[core_idx];
- vpudrv_buffer_t vdb;
- int i;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd==0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- vdb.size = SIZE_COMMON*MAX_NUM_VPU_CORE;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_GET_COMMON_MEMORY, &vdb) < 0)
- {
- VLOG(ERR, "[VDI] fail to vdi_allocate_dma_memory size=%d\n", vdb.size);
- return -1;
- }
- vdb.virt_addr = (unsigned long)mmap(NULL, vdb.size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, DRAM_MEM2SYS(vdb.phys_addr));
- if ((void *)vdb.virt_addr == MAP_FAILED)
- {
- VLOG(ERR, "[VDI] fail to map common memory phyaddr=%#lx, size = %d\n", vdb.phys_addr, vdb.size);
- return -1;
- }
- VLOG(INFO, "[VDI] vdi_allocate_common_memory, physaddr=%#lx, virtaddr=%#lx\n", vdb.phys_addr, vdb.virt_addr);
- // convert os driver buffer type to vpu buffer type
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- vdi->pvip->vpu_common_buffer.size = SIZE_COMMON;
- vdi->pvip->vpu_common_buffer.phys_addr = (unsigned long)(vdb.phys_addr + (core_idx*SIZE_COMMON));
- vdi->pvip->vpu_common_buffer.base = (unsigned long)(vdb.base + (core_idx*SIZE_COMMON));
- vdi->pvip->vpu_common_buffer.virt_addr = (unsigned long)(vdb.virt_addr + (core_idx*SIZE_COMMON));
- #else
- vdi->pvip->vpu_common_buffer.size = SIZE_COMMON;
- vdi->pvip->vpu_common_buffer.phys_addr = (unsigned long)(vdb.phys_addr);
- vdi->pvip->vpu_common_buffer.base = (unsigned long)(vdb.base);
- vdi->pvip->vpu_common_buffer.virt_addr = (unsigned long)(vdb.virt_addr);
- #endif
- osal_memcpy(&vdi->vpu_common_memory, &vdi->pvip->vpu_common_buffer, sizeof(vpu_buffer_t));
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 0)
- {
- vdi->vpu_buffer_pool[i].vdb = vdb;
- vdi->vpu_buffer_pool_count++;
- vdi->vpu_buffer_pool[i].inuse = 1;
- break;
- }
- }
- VLOG(INFO, "[VDI] vdi_get_common_memory physaddr=0x%lx, size=%d, virtaddr=0x%lx\n", (int)vdi->vpu_common_memory.phys_addr, (int)vdi->vpu_common_memory.size, (int)vdi->vpu_common_memory.virt_addr);
- return 0;
- }
- vpu_instance_pool_t *vdi_get_instance_pool(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return NULL;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00 )
- return NULL;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- if (!vdi->pvip)
- {
- vdb.size = sizeof(vpu_instance_pool_t) + sizeof(MUTEX_HANDLE)*VDI_NUM_LOCK_HANDLES;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- vdb.size *= MAX_NUM_VPU_CORE;
- #endif
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_GET_INSTANCE_POOL, &vdb) < 0)
- {
- VLOG(ERR, "[VDI] fail to allocate get instance pool physical space=%d\n", (int)vdb.size);
- return NULL;
- }
- #ifdef USE_VMALLOC_FOR_INSTANCE_POOL_MEMORY
- vdb.virt_addr = (unsigned long)mmap(NULL, vdb.size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, 0);
- #else
- vdb.virt_addr = (unsigned long)mmap(NULL, vdb.size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, vdb.phys_addr);
- #endif
- if ((void *)vdb.virt_addr == MAP_FAILED)
- {
- VLOG(ERR, "[VDI] fail to map instance pool phyaddr=0x%lx, size = %d\n", (int)vdb.phys_addr, (int)vdb.size);
- return NULL;
- }
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- vdi->pvip = (vpu_instance_pool_t *)(vdb.virt_addr + (core_idx*(sizeof(vpu_instance_pool_t) + sizeof(MUTEX_HANDLE)*VDI_NUM_LOCK_HANDLES)));
- #else
- vdi->pvip = (vpu_instance_pool_t *)(vdb.virt_addr);
- #endif
- vdi->vpu_mutex = (void *)((unsigned long)vdi->pvip + sizeof(vpu_instance_pool_t)); //change the pointer of vpu_mutex to at end pointer of vpu_instance_pool_t to assign at allocated position.
- vdi->vpu_disp_mutex = (void *)((unsigned long)vdi->pvip + sizeof(vpu_instance_pool_t) + sizeof(MUTEX_HANDLE));
- vdi->vmem_mutex = (void *)((unsigned long)vdi->pvip + sizeof(vpu_instance_pool_t) + 2*sizeof(MUTEX_HANDLE));
- VLOG(INFO, "[VDI] instance pool physaddr=0x%lx, virtaddr=0x%lx, base=0x%lx, size=%ld\n", (int)vdb.phys_addr, (int)vdb.virt_addr, (int)vdb.base, (int)vdb.size);
- }
- return (vpu_instance_pool_t *)vdi->pvip;
- }
- int vdi_open_instance(unsigned long core_idx, unsigned long inst_idx)
- {
- vdi_info_t *vdi;
- vpudrv_inst_info_t inst_info;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- inst_info.core_idx = core_idx;
- inst_info.inst_idx = inst_idx;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_OPEN_INSTANCE, &inst_info) < 0)
- {
- VLOG(ERR, "[VDI] fail to deliver open instance num inst_idx=%d\n", (int)inst_idx);
- return -1;
- }
- vdi->pvip->vpu_instance_num = inst_info.inst_open_count;
- return 0;
- }
- int vdi_close_instance(unsigned long core_idx, unsigned long inst_idx)
- {
- vdi_info_t *vdi;
- vpudrv_inst_info_t inst_info = {0, };;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- inst_info.core_idx = core_idx;
- inst_info.inst_idx = inst_idx;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_CLOSE_INSTANCE, &inst_info) < 0)
- {
- VLOG(ERR, "[VDI] fail to deliver open instance num inst_idx=%d\n", (int)inst_idx);
- return -1;
- }
- vdi->pvip->vpu_instance_num = inst_info.inst_open_count;
- return 0;
- }
- int vdi_get_instance_num(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- return vdi->pvip->vpu_instance_num;
- }
- int vdi_hw_reset(unsigned long core_idx) // DEVICE_ADDR_SW_RESET
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- return ioctl(vdi->vpu_fd, VDI_IOCTL_RESET, 0);
- }
- int vdi_lock(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- #else
- const int MUTEX_TIMEOUT = 0x7fffffff;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- restore_mutex_in_dead((MUTEX_HANDLE *)vdi->vpu_mutex);
- pthread_mutex_lock((MUTEX_HANDLE*)vdi->vpu_mutex);
- #else
- if (pthread_mutex_lock((MUTEX_HANDLE *)vdi->vpu_mutex) != 0) {
- VLOG(ERR, "%s:%d failed to pthread_mutex_locK\n", __FUNCTION__, __LINE__);
- return -1;
- }
- #endif
- return 0;//lint !e454
- }
- void vdi_unlock(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return;
- pthread_mutex_unlock((MUTEX_HANDLE *)vdi->vpu_mutex);//lint !e455
- }
- int vdi_disp_lock(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- #else
- const int MUTEX_TIMEOUT = 5000; // ms
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- #if defined(ANDROID) || !defined(PTHREAD_MUTEX_ROBUST_NP)
- restore_mutex_in_dead((MUTEX_HANDLE *)vdi->vpu_disp_mutex);
- pthread_mutex_lock((MUTEX_HANDLE*)vdi->vpu_disp_mutex);
- #else
- if (pthread_mutex_lock((MUTEX_HANDLE *)vdi->vpu_disp_mutex) != 0)
- VLOG(ERR, "%s:%d failed to pthread_mutex_lock\n", __FUNCTION__, __LINE__);
- return -1;
- }
- #endif /* ANDROID */
- return 0;//lint !e454
- }
- void vdi_disp_unlock(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return;
- pthread_mutex_unlock((MUTEX_HANDLE *)vdi->vpu_disp_mutex);//lint !e455
- }
- void vdi_write_register(unsigned long core_idx, unsigned int addr, unsigned int data)
- {
- vdi_info_t *vdi;
- unsigned long *reg_addr;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr + (core_idx*VPU_CORE_BASE_OFFSET));
- #else
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr);
- #endif
- *(volatile unsigned int *)reg_addr = data;
- }
- unsigned int vdi_read_register(unsigned long core_idx, unsigned int addr)
- {
- vdi_info_t *vdi;
- unsigned long *reg_addr;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return (unsigned int)-1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return (unsigned int)-1;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr + (core_idx*VPU_CORE_BASE_OFFSET));
- #else
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr);
- #endif
- return *(volatile unsigned int *)reg_addr;
- }
- #define FIO_TIMEOUT 100
- unsigned int vdi_fio_read_register(unsigned long core_idx, unsigned int addr)
- {
- unsigned int ctrl;
- unsigned int count = 0;
- unsigned int data = 0xffffffff;
- ctrl = (addr&0xffff);
- ctrl |= (0<<16); /* read operation */
- vdi_write_register(core_idx, W5_VPU_FIO_CTRL_ADDR, ctrl);
- count = FIO_TIMEOUT;
- while (count--) {
- ctrl = vdi_read_register(core_idx, W5_VPU_FIO_CTRL_ADDR);
- if (ctrl & 0x80000000) {
- data = vdi_read_register(core_idx, W5_VPU_FIO_DATA);
- break;
- }
- }
- return data;
- }
- void vdi_fio_write_register(unsigned long core_idx, unsigned int addr, unsigned int data)
- {
- unsigned int ctrl;
- unsigned int count = 0;
- vdi_write_register(core_idx, W5_VPU_FIO_DATA, data);
- ctrl = (addr&0xffff);
- ctrl |= (1<<16); /* write operation */
- vdi_write_register(core_idx, W5_VPU_FIO_CTRL_ADDR, ctrl);
- count = FIO_TIMEOUT;
- while (count--) {
- ctrl = vdi_read_register(core_idx, W5_VPU_FIO_CTRL_ADDR);
- if (ctrl & 0x80000000) {
- break;
- }
- }
- }
- int vdi_clear_memory(unsigned long core_idx, PhysicalAddress addr, int len, int endian)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- unsigned long offset;
- int i;
- Uint8* zero;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 1)
- {
- vdb = vdi->vpu_buffer_pool[i].vdb;
- if (addr >= vdb.phys_addr && addr < (vdb.phys_addr + vdb.size))
- break;
- }
- }
- if (!vdb.size) {
- VLOG(ERR, "address 0x%08x is not mapped address!!!\n", (int)addr);
- return -1;
- }
- zero = (Uint8*)osal_malloc(len);
- osal_memset((void*)zero, 0x00, len);
- offset = addr - (unsigned long)vdb.phys_addr;
- osal_memcpy((void *)((unsigned long)vdb.virt_addr+offset), zero, len);
- vdi_flush_ddr(core_idx,(unsigned long )(vdb.phys_addr+offset),len,1);
- osal_free(zero);
- return len;
- }
- int vdi_write_memory(unsigned long core_idx, PhysicalAddress addr, unsigned char *data, int len, int endian)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- unsigned long offset;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- if (!data)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 1)
- {
- vdb = vdi->vpu_buffer_pool[i].vdb;
- if (addr >= vdb.phys_addr && addr < (vdb.phys_addr + vdb.size)) {
- break;
- }
- }
- }
- if (!vdb.size) {
- VLOG(ERR, "address 0x%08x is not mapped address!!!\n", (int)addr);
- return -1;
- }
- #if 0 //def CNM_FPGA_PLATFORM
- // to check some writing of common buffer
- if (vdb.phys_addr >= vdi->vpu_common_memory.phys_addr &&
- vdb.phys_addr < (vdi->vpu_common_memory.phys_addr + SIZE_COMMON))
- {
- if (PRODUCT_CODE_W_SERIES(vdi->product_code))
- {
- if (vdi_read_register(core_idx, W5_VCPU_CUR_PC) != 0)
- {
- VLOG(ERR, "not to permit writing common buffer addr=%lx, size=%d\n", vdb.phys_addr, vdb.size);
- VLOG(ERR, "this process will be exit\n");
- exit(-1);
- }
- }
- else if (PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- }
- #endif
- offset = addr - (unsigned long)vdb.phys_addr;
- swap_endian(core_idx, data, len, endian);
- osal_memcpy((void *)((unsigned long)vdb.virt_addr+offset), data, len);
- vdi_flush_ddr(core_idx,(unsigned long )(vdb.phys_addr+offset),len,1);
- return len;
- }
- int vdi_read_memory(unsigned long core_idx, PhysicalAddress addr, unsigned char *data, int len, int endian)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- unsigned long offset;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 1)
- {
- vdb = vdi->vpu_buffer_pool[i].vdb;
- if (addr >= vdb.phys_addr && addr < (vdb.phys_addr + vdb.size))
- break;
- }
- }
- if (!vdb.size)
- return -1;
- offset = addr - (unsigned long)vdb.phys_addr;
- vdi_flush_ddr(core_idx,(unsigned long )(vdb.phys_addr+offset),len,1);
- osal_memcpy(data, (const void *)((unsigned long)vdb.virt_addr+offset), len);
- swap_endian(core_idx, data, len, endian);
- return len;
- }
- // return the vpudrv_buffer_t virt addr, not copy data
- int vdi_read_memory2(unsigned long core_idx, PhysicalAddress addr, unsigned char **ppdata, int len, int endian)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- unsigned long offset;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 1)
- {
- vdb = vdi->vpu_buffer_pool[i].vdb;
- if (addr >= vdb.phys_addr && addr < (vdb.phys_addr + vdb.size))
- break;
- }
- }
- if (!vdb.size)
- return -1;
- offset = addr - (unsigned long)vdb.phys_addr;
- vdi_flush_ddr(core_idx,(unsigned long )(vdb.phys_addr+offset),len,1);
- *ppdata = (unsigned char *)(vdb.virt_addr + offset);
- swap_endian(core_idx, *ppdata, len, endian);
- return len;
- }
- void* vdi_map_virt2(unsigned long core_idx, int size, PhysicalAddress bufY)
- {
- vdi_info_t *vdi = &s_vdi_info[core_idx];
- void *virt_addr = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED, vdi->vpu_fd, bufY);
- return virt_addr;
- }
- int vdi_virt_to_phys(unsigned long core_idx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- vdb.virt_addr = vb->virt_addr;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_GET_PHYSICAL_MEMORY, &vdb) < 0)
- {
- VLOG(ERR, "[VDI] fail to GET_PHYSICAL_MEMORY\n");
- return -1;
- }
- vb->phys_addr = (unsigned long)vdb.phys_addr;
- vb->base = (unsigned long)vdb.base;
- VLOG(INFO, "get phy = %#x vb->phy = %#x, base=%lx\n", vdb.phys_addr, vb->phys_addr, vb->base);
- return 0;
- }
- int vdi_allocate_dma_memory(unsigned long core_idx, vpu_buffer_t *vb, int memTypes, int instIndex)
- {
- vdi_info_t *vdi;
- int i;
- vpudrv_buffer_t vdb;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- vdb.size = vb->size;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_ALLOCATE_PHYSICAL_MEMORY, &vdb) < 0)
- {
- VLOG(ERR, "[VDI] fail to vdi_allocate_dma_memory size=%d\n", vb->size);
- return -1;
- }
- vb->phys_addr = (unsigned long)vdb.phys_addr;
- vb->base = (unsigned long)vdb.base;
- //map to virtual address
- vdb.virt_addr = (unsigned long)mmap(NULL, vdb.size, PROT_READ | PROT_WRITE,
- MAP_SHARED, vdi->vpu_fd, DRAM_MEM2SYS(vdb.phys_addr));
- if ((void *)vdb.virt_addr == MAP_FAILED)
- {
- memset(vb, 0x00, sizeof(vpu_buffer_t));
- return -1;
- }
- vb->virt_addr = vdb.virt_addr;
- vmem_lock(vdi);
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].inuse == 0)
- {
- vdi->vpu_buffer_pool[i].vdb = vdb;
- vdi->vpu_buffer_pool_count++;
- vdi->vpu_buffer_pool[i].inuse = 1;
- break;
- }
- }
- vmem_unlock(vdi);
- VLOG(INFO, "[VDI] vdi_allocate_dma_memory, physaddr=%#x, virtaddr=%#lx~0x%#lx, size=%d, memType=%d\n",
- vb->phys_addr, vb->virt_addr, vb->virt_addr + vb->size, vb->size, memTypes);
- return 0;
- }
- unsigned long vdi_get_dma_memory_free_size(unsigned long coreIdx)
- {
- vdi_info_t *vdi;
- int size;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return (unsigned long)-1;
- if (ioctl(vdi->vpu_fd, VDI_IOCTL_GET_FREE_MEM_SIZE, &size) < 0) {
- VLOG(ERR, "[VDI] fail VDI_IOCTL_GET_FREE_MEM_SIZE size=%d\n", size);
- return 0;
- }
- return size;
- }
- int vdi_attach_dma_memory(unsigned long core_idx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- int i;
- vpudrv_buffer_t vdb;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- vdb.size = vb->size;
- vdb.phys_addr = vb->phys_addr;
- vdb.base = vb->base;
- vdb.virt_addr = vb->virt_addr;
- vmem_lock(vdi);
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].vdb.phys_addr == vb->phys_addr)
- {
- vdi->vpu_buffer_pool[i].vdb = vdb;
- vdi->vpu_buffer_pool[i].inuse = 1;
- break;
- }
- else
- {
- if (vdi->vpu_buffer_pool[i].inuse == 0)
- {
- vdi->vpu_buffer_pool[i].vdb = vdb;
- vdi->vpu_buffer_pool_count++;
- vdi->vpu_buffer_pool[i].inuse = 1;
- break;
- }
- }
- }
- vmem_unlock(vdi);
- VLOG(INFO, "[VDI] vdi_attach_dma_memory, physaddr=0x%#x, virtaddr=0x%lx, size=%d, index=%d\n", vb->phys_addr, vb->virt_addr, vb->size, i);
- return 0;
- }
- int vdi_dettach_dma_memory(unsigned long core_idx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- if (vb->size == 0)
- return -1;
- vmem_lock(vdi);
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- if (vdi->vpu_buffer_pool[i].vdb.phys_addr == vb->phys_addr)
- {
- vdi->vpu_buffer_pool[i].inuse = 0;
- vdi->vpu_buffer_pool_count--;
- break;
- }
- }
- vmem_unlock(vdi);
- return 0;
- }
- void vdi_free_dma_memory(unsigned long core_idx, vpu_buffer_t *vb, int memTypes, int instIndex)
- {
- vdi_info_t *vdi;
- int i;
- vpudrv_buffer_t vdb;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- core_idx = 0;
- #endif
- if (core_idx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[core_idx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return;
- if (vb->size == 0)
- return ;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- vmem_lock(vdi);
- for (i=0; i<MAX_VPU_BUFFER_POOL; i++)
- {
- /* add more constraints for finding the correct buffer */
- if ((vdi->vpu_buffer_pool[i].vdb.phys_addr == vb->phys_addr)
- && (vdi->vpu_buffer_pool[i].vdb.size == vb->size)
- && (vdi->vpu_buffer_pool[i].vdb.virt_addr == vb->virt_addr))
- {
- vdi->vpu_buffer_pool[i].inuse = 0;
- vdi->vpu_buffer_pool_count--;
- vdb = vdi->vpu_buffer_pool[i].vdb;
- break;
- }
- }
- vmem_unlock(vdi);
- if (!vdb.size)
- {
- VLOG(ERR, "[VDI] invalid buffer to free address = 0x%lx\n", (int)vdb.virt_addr);
- return ;
- }
- ioctl(vdi->vpu_fd, VDI_IOCTL_FREE_PHYSICALMEMORY, &vdb);
- if (munmap((void *)vdb.virt_addr, vdb.size) != 0)
- {
- VLOG(ERR, "[VDI] fail to vdi_free_dma_memory virtial address = 0x%lx\n", (int)vdb.virt_addr);
- }
- osal_memset(vb, 0, sizeof(vpu_buffer_t));
- }
- int vdi_get_sram_memory(unsigned long core_idx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi = NULL;
- vpudrv_buffer_t vdb;
- unsigned int sram_size = 0;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- osal_memset(&vdb, 0x00, sizeof(vpudrv_buffer_t));
- switch (vdi->product_code) {
- case BODA950_CODE:
- case CODA960_CODE:
- case CODA980_CODE:
- sram_size = VDI_CODA9_SRAM_SIZE; break;
- case WAVE511_CODE:
- sram_size = VDI_WAVE511_SRAM_SIZE; break;
- case WAVE521_CODE:
- sram_size = VDI_WAVE521_SRAM_SIZE; break;
- case WAVE521C_CODE:
- sram_size = VDI_WAVE521C_SRAM_SIZE; break;
- case WAVE521C_DUAL_CODE:
- sram_size = VDI_WAVE521C_SRAM_SIZE; break;
- case WAVE517_CODE:
- sram_size = VDI_WAVE521C_SRAM_SIZE; break;
- default:
- VLOG(ERR, "[VDI] check product_code(%x)\n", vdi->product_code);
- break;
- }
- if (sram_size > 0) // if we can know the sram address directly in vdi layer, we use it first for sdram address
- {
- vb->phys_addr = VDI_SRAM_BASE_ADDR+(core_idx*sram_size); // HOST can set DRAM base addr to VDI_SRAM_BASE_ADDR.
- vb->size = sram_size;
- return 0;
- }
- return 0;
- }
- int vdi_set_clock_gate(unsigned long core_idx, int enable)
- {
- vdi_info_t *vdi = NULL;
- int ret;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- if (vdi->product_code == WAVE512_CODE || vdi->product_code == WAVE515_CODE || vdi->product_code == WAVE517_CODE ||
- vdi->product_code == WAVE521_CODE || vdi->product_code == WAVE521C_CODE || vdi->product_code == WAVE511_CODE || vdi->product_code == WAVE521C_DUAL_CODE ) {
- return 0;
- }
- vdi->clock_state = enable;
- ret = ioctl(vdi->vpu_fd, VDI_IOCTL_SET_CLOCK_GATE, &enable);
- return ret;
- }
- int vdi_get_clock_gate(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- int ret;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- ret = vdi->clock_state;
- return ret;
- }
- static int get_pc_addr(Uint32 product_code)
- {
- if (PRODUCT_CODE_W_SERIES(product_code)) {
- return W5_VCPU_CUR_PC;
- }
- else if (PRODUCT_CODE_NOT_W_SERIES(product_code)) {
- return BIT_CUR_PC;
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", product_code);
- return -1;
- }
- }
- int vdi_wait_bus_busy(unsigned long core_idx, int timeout, unsigned int gdi_busy_flag)
- {
- Uint64 elapse, cur;
- Uint32 pc;
- vdi_info_t *vdi;
- vdi = &s_vdi_info[core_idx];
- elapse = osal_gettime();
- pc = get_pc_addr(vdi->product_code);
- while(1)
- {
- if (vdi->product_code == WAVE521_CODE || vdi->product_code == WAVE521C_CODE || vdi->product_code == WAVE511_CODE || vdi->product_code == WAVE521C_DUAL_CODE ||
- vdi->product_code == WAVE517_CODE) {
- if (vdi_fio_read_register(core_idx, gdi_busy_flag) == 0x3f) break;
- }
- else if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- if (vdi_fio_read_register(core_idx, gdi_busy_flag) == 0x738) break;
- }
- else if (PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- if (vdi_read_register(core_idx, gdi_busy_flag) == 0x77) break;
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- if (timeout > 0) {
- cur = osal_gettime();
- if ((cur - elapse) > timeout) {
- print_busy_timeout_status(core_idx, vdi->product_code, pc);
- return -1;
- }
- }
- }
- return 0;
- }
- int vdi_wait_vpu_busy(unsigned long core_idx, int timeout, unsigned int addr_bit_busy_flag)
- {
- Uint64 elapse, cur;
- Uint32 pc;
- Uint32 normalReg = TRUE;
- vdi_info_t *vdi;
- vdi = &s_vdi_info[core_idx];
- elapse = osal_gettime();
- pc = get_pc_addr(vdi->product_code);
- if (PRODUCT_CODE_W_SERIES(vdi->product_code) && (addr_bit_busy_flag&0x8000) ) {
- normalReg = FALSE;
- }
- while(1)
- {
- if (normalReg == TRUE) {
- if (vdi_read_register(core_idx, addr_bit_busy_flag) == 0) break;
- }
- else {
- if (vdi_fio_read_register(core_idx, addr_bit_busy_flag) == 0) break;
- }
- if (timeout > 0) {
- cur = osal_gettime();
- if ((cur - elapse) > timeout) {
- print_busy_timeout_status(core_idx, vdi->product_code, pc);
- return -1;
- }
- }
- }
- return 0;
- }
- int vdi_wait_vcpu_bus_busy(unsigned long core_idx, int timeout, unsigned int addr_bit_busy_flag)
- {
- Uint64 elapse, cur;
- Uint32 pc;
- Uint32 normalReg = TRUE;
- vdi_info_t *vdi;
- vdi = &s_vdi_info[core_idx];
- elapse = osal_gettime();
- pc = get_pc_addr(vdi->product_code);
- if (PRODUCT_CODE_W_SERIES(vdi->product_code) && (addr_bit_busy_flag&0x8000) ) {
- normalReg = FALSE;
- }
- while(1)
- {
- if (normalReg == TRUE) {
- if (vdi_read_register(core_idx, addr_bit_busy_flag) == 0x40) break;
- }
- else {
- if (vdi_fio_read_register(core_idx, addr_bit_busy_flag) == 0x40) break;
- }
- if (timeout > 0) {
- cur = osal_gettime();
- if ((cur - elapse) > timeout) {
- print_busy_timeout_status(core_idx, vdi->product_code, pc);
- return -1;
- }
- }
- }
- return 0;
- }
- #ifdef SUPPORT_MULTI_INST_INTR
- int vdi_wait_interrupt(unsigned long coreIdx, unsigned int instIdx, int timeout)
- #else
- int vdi_wait_interrupt(unsigned long coreIdx, int timeout)
- #endif
- {
- int intr_reason = 0;
- #ifdef SUPPORT_INTERRUPT
- int ret;
- #endif
- vdi_info_t *vdi;
- vpudrv_intr_info_t intr_info;
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- #ifdef SUPPORT_INTERRUPT
- intr_info.timeout = timeout;
- intr_info.intr_reason = 0;
- #ifdef SUPPORT_MULTI_INST_INTR
- intr_info.intr_inst_index = instIdx;
- #endif
- ret = ioctl(vdi->vpu_fd, VDI_IOCTL_WAIT_INTERRUPT, (void*)&intr_info);
- if (ret != 0)
- return -1;
- intr_reason = intr_info.intr_reason;
- #else
- struct timeval tv = {0};
- Uint32 int_sts_reg;
- Uint32 int_reason_reg;
- Uint64 startTime, endTime;
- UNREFERENCED_PARAMETER(intr_info);
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- int_sts_reg = W5_VPU_VPU_INT_STS;
- }
- else if (PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- int_sts_reg = BIT_INT_STS;
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- int_reason_reg = W5_VPU_VINT_REASON;
- }
- else {
- int_reason_reg = BIT_INT_REASON;
- }
- startTime = osal_gettime();
- while (TRUE) {
- if (vdi_read_register(coreIdx, int_sts_reg)) {
- if ((intr_reason=vdi_read_register(coreIdx, int_reason_reg))) {
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- vdi_write_register(coreIdx, W5_VPU_VINT_REASON_CLR, intr_reason);
- vdi_write_register(coreIdx, W5_VPU_VINT_CLEAR, 0x1);
- }
- else {
- vdi_write_register(coreIdx, BIT_INT_CLEAR, 0x1);
- }
- break;
- }
- }
- endTime = osal_gettime();
- if (timeout > 0 && (endTime-startTime) >= timeout) {
- return -1;
- }
- }
- #endif
- return intr_reason;
- }
- //------------------------------------------------------------------------------
- // LOG & ENDIAN functions
- //------------------------------------------------------------------------------
- int vdi_get_system_endian(unsigned long core_idx)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- return VDI_128BIT_BUS_SYSTEM_ENDIAN;
- }
- else if(PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- return VDI_SYSTEM_ENDIAN;
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- }
- int vdi_convert_endian(unsigned long core_idx, unsigned int endian)
- {
- vdi_info_t *vdi;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || !vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- switch (endian) {
- case VDI_LITTLE_ENDIAN: endian = 0x00; break;
- case VDI_BIG_ENDIAN: endian = 0x0f; break;
- case VDI_32BIT_LITTLE_ENDIAN: endian = 0x04; break;
- case VDI_32BIT_BIG_ENDIAN: endian = 0x03; break;
- }
- }
- else if(PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- return (endian&0x0f);
- }
- static Uint32 convert_endian_coda9_to_wave4(Uint32 endian)
- {
- Uint32 converted_endian = endian;
- switch(endian) {
- case VDI_LITTLE_ENDIAN: converted_endian = 0; break;
- case VDI_BIG_ENDIAN: converted_endian = 7; break;
- case VDI_32BIT_LITTLE_ENDIAN: converted_endian = 4; break;
- case VDI_32BIT_BIG_ENDIAN: converted_endian = 3; break;
- }
- return converted_endian;
- }
- int swap_endian(unsigned long core_idx, unsigned char *data, int len, int endian)
- {
- vdi_info_t *vdi;
- int changes;
- int sys_endian;
- BOOL byteChange, wordChange, dwordChange, lwordChange;
- if (core_idx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[core_idx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return -1;
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- sys_endian = VDI_128BIT_BUS_SYSTEM_ENDIAN;
- }
- else if(PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- sys_endian = VDI_SYSTEM_ENDIAN;
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- endian = vdi_convert_endian(core_idx, endian);
- sys_endian = vdi_convert_endian(core_idx, sys_endian);
- if (endian == sys_endian)
- return 0;
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- }
- else if (PRODUCT_CODE_NOT_W_SERIES(vdi->product_code)) {
- endian = convert_endian_coda9_to_wave4(endian);
- sys_endian = convert_endian_coda9_to_wave4(sys_endian);
- }
- else {
- VLOG(ERR, "Unknown product id : %08x\n", vdi->product_code);
- return -1;
- }
- changes = endian ^ sys_endian;
- byteChange = changes&0x01;
- wordChange = ((changes&0x02) == 0x02);
- dwordChange = ((changes&0x04) == 0x04);
- lwordChange = ((changes&0x08) == 0x08);
- if (byteChange) byte_swap(data, len);
- if (wordChange) word_swap(data, len);
- if (dwordChange) dword_swap(data, len);
- if (lwordChange) lword_swap(data, len);
- return 1;
- }
- #endif //#if defined(linux) || defined(__linux) || defined(ANDROID)
|