1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207 |
- // SPDX-License-Identifier: LGPL-2.1 OR BSD-3-Clause
- /*
- * 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.
- */
- #include <stdio.h>
- #include <stdlib.h>
- #include "../vdi.h"
- #include "../vdi_osal.h"
- #include "../mm.h"
- #include "coda9/coda9_regdefine.h"
- #include "wave/wave5_regdefine.h"
- #include "vpuapi/vpuapi.h"
- #include "main_helper.h"
- #include "misc/debug.h"
- #if defined(_WIN32) || defined(__WIN32__) || defined(_WIN64) || defined(WIN32) || defined(__MINGW32__)
- #elif defined(linux) || defined(__linux) || defined(ANDROID)
- #else
- #if (REQUIRED_VPU_MEMORY_SIZE > VPUDRV_INIT_VIDEO_MEMORY_SIZE_IN_BYTE)
- #error "Warnning : VPU memory will be overflow"
- #endif
- #endif
- #define VPU_BIT_REG_SIZE (0x4000*MAX_NUM_VPU_CORE)
- # define VPU_BIT_REG_BASE 0x40000000
- #define VDI_SRAM_BASE_ADDR 0x00
- #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 VPU_DRAM_PHYSICAL_BASE 0x00
- #define VPU_DRAM_SIZE (128*1024*1024)
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- #define VPU_CORE_BASE_OFFSET 0x4000
- #endif
- #define VDI_SYSTEM_ENDIAN VDI_LITTLE_ENDIAN
- #define VDI_128BIT_BUS_SYSTEM_ENDIAN VDI_128BIT_LITTLE_ENDIAN
- typedef struct vpu_buffer_t vpudrv_buffer_t;
- typedef struct vpu_buffer_pool_t
- {
- vpudrv_buffer_t vdb;
- int inuse;
- } vpu_buffer_pool_t;
- typedef struct {
- unsigned long coreIdx;
- int vpu_fd;
- vpu_instance_pool_t *pvip;
- int task_num;
- int clock_state;
- vpudrv_buffer_t vdb_video_memory;
- vpudrv_buffer_t vdb_register;
- vpu_buffer_t vpu_common_memory;
- vpu_buffer_pool_t vpu_buffer_pool[MAX_VPU_BUFFER_POOL];
- int vpu_buffer_pool_count;
- int product_code;
- } vdi_info_t;
- static vdi_info_t s_vdi_info[MAX_VPU_CORE_NUM];
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- static vpu_instance_pool_t s_vip[MAX_VPU_CORE_NUM]; // it can be used for a buffer space to save context for app process. to support running VPU in multiple process. this space should be a shared buffer.
- #else
- static vpu_instance_pool_t s_vip; // it can be used for a buffer space to save context for app process. to support running VPU in multiple process. this space should be a shared buffer.
- #endif
- static int swap_endian(unsigned long coreIdx, unsigned char *data, int len, int endian);
- int vdi_lock(unsigned long coreIdx)
- {
- /* need to implement */
- return 0;
- }
- void vdi_unlock(unsigned long coreIdx)
- {
- /* need to implement */
- }
- int vdi_disp_lock(unsigned long coreIdx)
- {
- /* need to implement */
- return 0;
- }
- void vdi_disp_unlock(unsigned long coreIdx)
- {
- /* need to implement */
- }
- int vmem_lock_init(unsigned long coreIdx)
- {
- /* need to implement */
- return 0;
- }
- int vmem_lock(unsigned long coreIdx)
- {
- /* need to implement */
- return 0;
- }
- void vmem_unlock(unsigned long coreIdx)
- {
- /* need to implement */
- }
- int vmem_lock_deinit(unsigned long coreIdx)
- {
- /* need to implement */
- return 0;
- }
- int vdi_probe(unsigned long coreIdx)
- {
- int ret;
- ret = vdi_init(coreIdx);
- vdi_release(coreIdx);
- return ret;
- }
- int vdi_init(unsigned long coreIdx)
- {
- int ret;
- vdi_info_t *vdi;
- int i;
- Uint32 product_code;
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return 0;
- vdi = &s_vdi_info[coreIdx];
- if (vdi->vpu_fd != -1 && vdi->vpu_fd != 0x00)
- {
- vdi->task_num++;
- return 0;
- }
- vdi->vpu_fd = 1;
- osal_memset(vdi->vpu_buffer_pool, 0x00, sizeof(vpu_buffer_pool_t)*MAX_VPU_BUFFER_POOL);
- if (!vdi_get_instance_pool(coreIdx))
- {
- VLOG(ERR, "[VDI] fail to create shared info for saving context \n");
- goto ERR_VDI_INIT;
- }
- vdi->vdb_video_memory.phys_addr = VPU_DRAM_PHYSICAL_BASE;
- vdi->vdb_video_memory.size = VPU_DRAM_SIZE;
- #if 0
- if (REQUIRED_VPU_MEMORY_SIZE > vdi->vdb_video_memory.size)
- {
- VLOG(ERR, "[VDI] Warning : VPU memory will be overflow\n");
- }
- #endif
- if (vdi_allocate_common_memory(coreIdx) < 0)
- {
- VLOG(ERR, "[VDI] fail to get vpu common buffer from driver\n");
- goto ERR_VDI_INIT;
- }
- if (!vdi->pvip->instance_pool_inited)
- osal_memset(&vdi->pvip->vmem, 0x00, sizeof(video_mm_t));
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- ret = vmem_init(&vdi->pvip->vmem, vdi->vdb_video_memory.phys_addr + (vdi->pvip->vpu_common_buffer.size*MAX_VPU_CORE_NUM),
- vdi->vdb_video_memory.size - (vdi->pvip->vpu_common_buffer.size*MAX_VPU_CORE_NUM));
- #else
- ret = vmem_init(&vdi->pvip->vmem, vdi->vdb_video_memory.phys_addr + vdi->pvip->vpu_common_buffer.size,
- vdi->vdb_video_memory.size - vdi->pvip->vpu_common_buffer.size);
- #endif
- vmem_lock_init(coreIdx);
- if (ret < 0)
- {
- VLOG(ERR, "[VDI] fail to init vpu memory management logic\n");
- goto ERR_VDI_INIT;
- }
- vdi->vdb_register.phys_addr = VPU_BIT_REG_BASE;
- vdi->vdb_register.virt_addr = VPU_BIT_REG_BASE;
- vdi->vdb_register.size = VPU_BIT_REG_SIZE;
- vdi_set_clock_gate(coreIdx, TRUE);
- vdi->product_code = vdi_read_register(coreIdx, VPU_PRODUCT_CODE_REGISTER);
- product_code = vdi->product_code;
- if (PRODUCT_CODE_W_SERIES(product_code))
- {
- if (vdi_read_register(coreIdx, W5_VCPU_CUR_PC) == 0) // if BIT processor is not running.
- {
- for (i=0; i<64; i++)
- vdi_write_register(coreIdx, (i*4) + 0x100, 0x0);
- }
- }
- else // CODA9XX
- {
- if (vdi_read_register(coreIdx, BIT_CUR_PC) == 0) // if BIT processor is not running.
- {
- for (i=0; i<64; i++)
- vdi_write_register(coreIdx, (i*4) + 0x100, 0x0);
- }
- }
- vdi_set_clock_gate(coreIdx, FALSE);
- vdi->coreIdx = coreIdx;
- vdi->task_num++;
- VLOG(INFO, "[VDI] success to init driver \n");
- return 0;
- ERR_VDI_INIT:
- vdi_release(coreIdx);
- return -1;
- }
- int vdi_set_bit_firmware_to_pm(unsigned long coreIdx, const unsigned short *code)
- {
- return 0;
- }
- int vdi_release(unsigned long coreIdx)
- {
- int i;
- vpudrv_buffer_t vdb = {0, };
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- if (!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd == 0x00)
- return 0;
- if (vdi_lock(coreIdx) < 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(coreIdx);
- return 0;
- }
- vmem_lock_deinit(coreIdx);
- vmem_exit(&vdi->pvip->vmem);
- osal_memset(&vdi->vdb_register, 0x00, sizeof(vpudrv_buffer_t));
- // get common memory information to free virtual address
- vdb.size = 0;
- 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;
- }
- }
- if (vdb.size > 0)
- osal_memset(&vdi->vpu_common_memory, 0x00, sizeof(vpu_buffer_t));
- vdi->task_num--;
- vdi->vpu_fd = -1;
- vdi_unlock(coreIdx);
- osal_memset(vdi, 0x00, sizeof(vdi_info_t));
- return 0;
- }
- int vdi_get_common_memory(unsigned long coreIdx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- 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;
- 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;
- if (vdi->pvip->vpu_common_buffer.size == 0)
- {
- vdb.size = SIZE_COMMON*MAX_VPU_CORE_NUM;
- vdb.phys_addr = vdi->vdb_video_memory.phys_addr; // set at the beginning of base address
- vdb.virt_addr = vdi->vdb_video_memory.phys_addr;
- vdb.base = vdi->vdb_video_memory.base;
- // 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 int)(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 int)(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(vpudrv_buffer_t));
- }
- else
- {
- vdb.size = SIZE_COMMON*MAX_VPU_CORE_NUM;
- vdb.phys_addr = vdi->vdb_video_memory.phys_addr; // set at the beginning of base address
- vdb.base = vdi->vdb_video_memory.base;
- vdb.virt_addr = vdi->vdb_video_memory.phys_addr;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- vdi->pvip->vpu_common_buffer.virt_addr = (unsigned long)(vdb.virt_addr + (core_idx*SIZE_COMMON));
- #else
- vdi->pvip->vpu_common_buffer.virt_addr = vdb.virt_addr;
- #endif
- osal_memcpy(&vdi->vpu_common_memory, &vdi->pvip->vpu_common_buffer, sizeof(vpudrv_buffer_t));
- VLOG(INFO, "[VDI] vdi_allocate_common_memory, physaddr=0x%x, virtaddr=0x%x\n", (int)vdi->pvip->vpu_common_buffer.phys_addr, (int)vdi->pvip->vpu_common_buffer.virt_addr);
- }
- 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%x, size=%d, virtaddr=0x%x\n", vdi->vpu_common_memory.phys_addr, vdi->vpu_common_memory.size, vdi->vpu_common_memory.virt_addr);
- return 0;
- }
- vpu_instance_pool_t *vdi_get_instance_pool(unsigned long coreIdx)
- {
- vdi_info_t *vdi;
- if (coreIdx >= MAX_VPU_CORE_NUM)
- return NULL;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd == -1 || vdi->vpu_fd ==0x00 )
- return NULL;
- if (!vdi->pvip)
- {
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- vdi->pvip = &s_vip[coreIdx];
- #else
- vdi->pvip = &s_vip;
- #endif
- osal_memset(vdi->pvip, 0, sizeof(vpu_instance_pool_t));
- }
- return (vpu_instance_pool_t *)vdi->pvip;
- }
- int vdi_open_instance(unsigned long coreIdx, unsigned long instIdx)
- {
- vdi_info_t *vdi = NULL;
- if (coreIdx >= MAX_VPU_CORE_NUM)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd ==-1 || vdi->vpu_fd == 0x00)
- return -1;
- vdi->pvip->vpu_instance_num++;
- return 0;
- }
- int vdi_close_instance(unsigned long coreIdx, unsigned long instIdx)
- {
- vdi_info_t *vdi = NULL;
- if (coreIdx >= MAX_VPU_CORE_NUM)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd ==-1 || vdi->vpu_fd == 0x00)
- return -1;
- vdi->pvip->vpu_instance_num--;
- return 0;
- }
- int vdi_get_instance_num(unsigned long coreIdx)
- {
- vdi_info_t *vdi = NULL;
- if (coreIdx >= MAX_VPU_CORE_NUM)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd ==-1 || vdi->vpu_fd == 0x00)
- return -1;
- return vdi->pvip->vpu_instance_num;
- }
- int vdi_hw_reset(unsigned long coreIdx) // DEVICE_ADDR_SW_RESET
- {
- vdi_info_t *vdi = NULL;
- if (coreIdx >= MAX_VPU_CORE_NUM)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || !vdi || vdi->vpu_fd ==-1 || vdi->vpu_fd == 0x00)
- return -1;
- // to do any action for hw reset
- return 0;
- }
- void vdi_write_register(unsigned long coreIdx, unsigned int addr, unsigned int data)
- {
- vdi_info_t *vdi = NULL;
- unsigned long *reg_addr;
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[coreIdx];
- 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 + (coreIdx*VPU_CORE_BASE_OFFSET));
- #else
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr);
- #endif
- *(volatile unsigned long *)reg_addr = data;
- }
- unsigned int vdi_read_register(unsigned long coreIdx, unsigned int addr)
- {
- vdi_info_t *vdi = NULL;
- unsigned long *reg_addr;
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return (unsigned int)-1;
- vdi = &s_vdi_info[coreIdx];
- 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 + (coreIdx*VPU_CORE_BASE_OFFSET));
- #else
- reg_addr = (unsigned long *)(addr + (unsigned long)vdi->vdb_register.virt_addr);
- #endif
- return *(volatile unsigned long *)reg_addr;
- }
- #define FIO_TIMEOUT 10000
- unsigned int vdi_fio_read_register(unsigned long coreIdx, 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(coreIdx, W5_VPU_FIO_CTRL_ADDR, ctrl);
- count = FIO_TIMEOUT;
- while (count--) {
- ctrl = vdi_read_register(coreIdx, W5_VPU_FIO_CTRL_ADDR);
- if (ctrl & 0x80000000) {
- data = vdi_read_register(coreIdx, W5_VPU_FIO_DATA);
- break;
- }
- }
- return data;
- }
- void vdi_fio_write_register(unsigned long coreIdx, unsigned int addr, unsigned int data)
- {
- unsigned int ctrl;
- unsigned int count = 0;
- vdi_write_register(coreIdx, W5_VPU_FIO_DATA, data);
- ctrl = (addr&0xffff);
- ctrl |= (1<<16); /* write operation */
- vdi_write_register(coreIdx, W5_VPU_FIO_CTRL_ADDR, ctrl);
- count = FIO_TIMEOUT;
- while (count--) {
- ctrl = vdi_read_register(coreIdx, W5_VPU_FIO_CTRL_ADDR);
- if (ctrl & 0x80000000) {
- break;
- }
- }
- }
- int vdi_clear_memory(unsigned long coreIdx, 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
- coreIdx = 0;
- #endif
- 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;
- 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;
- }
- offset = (unsigned long)(addr - vdb.phys_addr);
- zero = (Uint8*)osal_malloc(len);
- osal_memset((void*)zero, 0x00, len);
- osal_memcpy((void *)((unsigned long)vdb.virt_addr+offset), zero, len);
- osal_free(zero);
- return len;
- }
- int vdi_write_memory(unsigned long coreIdx, PhysicalAddress addr, unsigned char *data, int len, int endian)
- {
- vdi_info_t *vdi;
- vpudrv_buffer_t vdb = {0};
- unsigned long offset;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- 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) { //lint !e644
- VLOG(ERR, "address 0x%08x is not mapped address!!!\n", addr);
- return -1;
- }
- offset = (unsigned long)(addr -vdb.phys_addr);
- swap_endian(coreIdx, data, len, endian);
- osal_memcpy((void *)((unsigned long)vdb.virt_addr+offset), data, len);
- return len;
- }
- int vdi_read_memory(unsigned long coreIdx, PhysicalAddress addr, unsigned char *data, int len, int endian)
- {
- vdi_info_t *vdi = NULL;
- vpudrv_buffer_t vdb = {0};
- unsigned long offset;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- 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;
- 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) //lint !e644
- return -1;
- offset = (unsigned long)(addr -vdb.phys_addr);
- osal_memcpy(data, (const void *)((unsigned long)vdb.virt_addr+offset), len);
- swap_endian(coreIdx, data, len, endian);
- return len;
- }
- int vdi_allocate_dma_memory(unsigned long coreIdx, vpu_buffer_t *vb, int memTypes, int instIndex)
- {
- vdi_info_t *vdi = NULL;
- int i;
- unsigned long offset;
- vpudrv_buffer_t vdb = {0};
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- 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;
- vdb.size = vb->size;
- vmem_lock(coreIdx);
- vdb.phys_addr = (PhysicalAddress)vmem_alloc(&vdi->pvip->vmem, vdb.size, 0);
- vmem_unlock(coreIdx);
- if ((PhysicalAddress)vdb.phys_addr == (PhysicalAddress)-1)
- return -1; // not enough memory
- offset = (unsigned long)(vdb.phys_addr - vdi->vdb_video_memory.phys_addr);
- vdb.base = (unsigned long )vdi->vdb_video_memory.base + offset;
- vdb.virt_addr = vdb.phys_addr;
- vb->phys_addr = (unsigned long)vdb.phys_addr;
- vb->base = (unsigned long)vdb.base;
- vb->virt_addr = (unsigned long)vb->phys_addr;
- 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;
- }
- }
- return 0;
- }
- int vdi_attach_dma_memory(unsigned long coreIdx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- int i;
- unsigned long offset;
- vpudrv_buffer_t vdb = {0};
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- vdb.size = vb->size;
- vdb.phys_addr = vb->phys_addr;
- offset = (unsigned long)(vdb.phys_addr - vdi->vdb_video_memory.phys_addr);
- vdb.base = (unsigned long )vdi->vdb_video_memory.base + offset;
- vdb.virt_addr = vb->virt_addr;
- 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;
- }
- }
- }
- return 0;
- }
- int vdi_dettach_dma_memory(unsigned long coreIdx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi;
- int i;
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return -1;
- vdi = &s_vdi_info[coreIdx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- if (vb->size == 0)
- return -1;
- 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;
- }
- }
- return 0;
- }
- void vdi_free_dma_memory(unsigned long coreIdx, vpu_buffer_t *vb, int memTypes, int instIndex)
- {
- vdi_info_t *vdi;
- int i;
- vpudrv_buffer_t vdb = {0};
- #ifdef SUPPORT_MULTI_CORE_IN_ONE_DRIVER
- coreIdx = 0;
- #endif
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return;
- vdi = &s_vdi_info[coreIdx];
- if(!vb || !vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return;
- if (vb->size == 0)
- return;
- 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--;
- vdb = vdi->vpu_buffer_pool[i].vdb;
- break;
- }
- }
- if (!vdb.size) //lint !e644
- {
- VLOG(ERR, "[VDI] invalid buffer to free address = 0x%x\n", (int)vdb.virt_addr);
- return ;
- }
- vmem_lock(coreIdx);
- vmem_free(&vdi->pvip->vmem, (unsigned long)vdb.phys_addr, 0);
- vmem_unlock(coreIdx);
- osal_memset(vb, 0, sizeof(vpu_buffer_t));
- }
- int vdi_get_sram_memory(unsigned long coreIdx, vpu_buffer_t *vb)
- {
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- Uint32 sram_size=0;
- if (coreIdx >= MAX_NUM_VPU_CORE)
- return -1;
- if(!vb || !vdi)
- return -1;
- 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 we can know the sram address directly in vdi layer, we use it first for sdram address
- vb->phys_addr = VDI_SRAM_BASE_ADDR+(coreIdx*sram_size);
- vb->size = sram_size;
- return 0;
- }
- int vdi_set_clock_gate(unsigned long coreIdx, int enable)
- {
- vdi_info_t *vdi = NULL;
- 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;
- 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;
- return 0;
- }
- int vdi_get_clock_gate(unsigned long coreIdx)
- {
- vdi_info_t *vdi = NULL;
- 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;
- return vdi->clock_state;
- }
- int vdi_wait_bus_busy(unsigned long coreIdx, int timeout, unsigned int gdi_busy_flag)
- {
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- //VDI must implement timeout action in this function for multi-vpu core scheduling efficiency.
- //the setting small value as timeout gives a chance to wait the other vpu core.
- 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(coreIdx, gdi_busy_flag) == 0x3f) break;
- }
- else if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- if (vdi_fio_read_register(coreIdx, gdi_busy_flag) == 0x738) break;
- }
- else {
- if (vdi_read_register(coreIdx, gdi_busy_flag) == 0x77) break;
- }
- //Sleep(1); // 1ms sec
- //if (count++ > timeout)
- // return -1;
- }
- return 0;
- }
- int vdi_wait_vpu_busy(unsigned long coreIdx, int timeout, unsigned int addr_bit_busy_flag)
- {
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- int normalReg = TRUE;
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- //VDI must implement timeout action in this function for multi-vpu core scheduling efficiency.
- //the setting small value as timeout gives a chance to wait the other vpu core.
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- if (addr_bit_busy_flag&0x8000) normalReg = FALSE;
- }
- while(1)
- {
- if (normalReg == TRUE) {
- if (vdi_read_register(coreIdx, addr_bit_busy_flag) == 0) break;
- }
- else {
- if (vdi_fio_read_register(coreIdx, addr_bit_busy_flag) == 0) break;
- }
- //Sleep(1); // 1ms sec
- //if (count++ > timeout)
- // return -1;
- }
- return 0;
- }
- int vdi_wait_vcpu_bus_busy(unsigned long coreIdx, int timeout, unsigned int addr_bit_busy_flag)
- {
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- int normalReg = TRUE;
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- //VDI must implement timeout action in this function for multi-vpu core scheduling efficiency.
- //the setting small value as timeout gives a chance to wait the other vpu core.
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- if (addr_bit_busy_flag&0x8000) normalReg = FALSE;
- }
- while(1)
- {
- if (normalReg == TRUE) {
- if (vdi_read_register(coreIdx, addr_bit_busy_flag) == 0x40) break;
- }
- else {
- if (vdi_fio_read_register(coreIdx, addr_bit_busy_flag) == 0x40) break;
- }
- //Sleep(1); // 1ms sec
- //if (count++ > timeout)
- // return -1;
- }
- return 0;
- }
- #ifdef SUPPORT_MULTI_INST_INTR
- int vdi_wait_interrupt(unsigned long core_idx, unsigned int instIdx, int timeout)
- #else
- int vdi_wait_interrupt(unsigned long core_idx, int timeout)
- #endif
- {
- vdi_info_t *vdi = &s_vdi_info[core_idx];
- int intr_reason;
- //unsigned long cur_time;
- //VDI must implement timeout action in this function for multi-vpu core scheduling efficiency.
- //the setting small value as timeout gives a chance to wait the other vpu core.
- #ifdef SUPPORT_INTERRUPT
- #error "Need to implement"
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- #else
- int int_sts_reg;
- int int_reason_reg;
- if(!vdi || vdi->vpu_fd==-1 || vdi->vpu_fd == 0x00)
- return -1;
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- int_sts_reg = W5_VPU_VPU_INT_STS;
- }
- else {
- int_sts_reg = BIT_INT_STS;
- }
- if (PRODUCT_CODE_W_SERIES(vdi->product_code)) {
- int_reason_reg = W5_VPU_VINT_REASON;
- }
- else {
- int_reason_reg = BIT_INT_REASON;
- }
- //cur_time = jiffies;
- while(1)
- {
- if (vdi_read_register(core_idx, int_sts_reg))
- {
- if ((intr_reason=vdi_read_register(core_idx, int_reason_reg)))
- {
- if (PRODUCT_CODE_W_SERIES(vdi->product_code))
- {
- vdi_write_register(core_idx, W5_VPU_VINT_REASON_CLR, intr_reason);
- vdi_write_register(core_idx, W5_VPU_VINT_CLEAR, 0x1);
- }
- else
- {
- vdi_write_register(core_idx, BIT_INT_CLEAR, 0x1);
- }
- break;
- }
- }
- /*
- if(jiffies_to_msecs(jiffies - cur_time) > timeout) {
- return -1;
- }
- */
- }
- #endif
- return intr_reason;
- }
- int vdi_get_system_endian(unsigned long coreIdx)
- {
- vdi_info_t *vdi = &s_vdi_info[coreIdx];
- 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
- return VDI_SYSTEM_ENDIAN;
- }
- int vdi_convert_endian(unsigned long coreIdx, unsigned int endian)
- {
- Uint32 productCode;
- productCode = vdi_read_register(coreIdx, VPU_PRODUCT_CODE_REGISTER);
- if (PRODUCT_CODE_W_SERIES(productCode)) {
- 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;
- }
- }
- 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 coreIdx, unsigned char *data, int len, int endian)
- {
- vdi_info_t* vdi = &s_vdi_info[coreIdx];
- int changes;
- int sys_endian;
- BOOL byteChange, wordChange, dwordChange, lwordChange;
- 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(coreIdx, endian);
- sys_endian = vdi_convert_endian(coreIdx, 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;
- }
|