diff options
Diffstat (limited to 'src/video_out/vidix/drivers/unichrome_vid.c')
-rw-r--r-- | src/video_out/vidix/drivers/unichrome_vid.c | 772 |
1 files changed, 0 insertions, 772 deletions
diff --git a/src/video_out/vidix/drivers/unichrome_vid.c b/src/video_out/vidix/drivers/unichrome_vid.c deleted file mode 100644 index b5ff314e6..000000000 --- a/src/video_out/vidix/drivers/unichrome_vid.c +++ /dev/null @@ -1,772 +0,0 @@ -/* - Driver for VIA CLE266 Unichrome - Version 0.1.0 - - Copyright (C) 2004 by Timothy Lee - - Based on Cyberblade/i driver by Alastair M. Robison. - - Thanks to Gilles Frattini for bugfixes - - 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; if not, write to the Free Software - Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA - - Changes: - 2004-03-10 - Initial version - - To Do: -*/ - -#include <errno.h> -#include <stdio.h> -#include <stdlib.h> -#include <string.h> -#include <inttypes.h> -#include <unistd.h> - -#include "vidix.h" -#include "fourcc.h" -#include "libdha.h" -#include "pci_ids.h" -#include "pci_names.h" - -#include "unichrome_regs.h" - -pciinfo_t pci_info; - -uint8_t *uc_mem; -static vidix_grkey_t uc_grkey; -static int frames[VID_PLAY_MAXFRAMES]; -uint8_t *vio; -uint8_t mclk_save[3]; - -#define VIA_OUT(hwregs, reg, val) *(volatile uint32_t *)((hwregs) + (reg)) = (val) -#define VIA_IN(hwregs, reg) *(volatile uint32_t *)((hwregs) + (reg)) -#define VGA_OUT8(hwregs, reg, val) *(volatile uint8_t *)((hwregs) + (reg) + 0x8000) = (val) -#define VGA_IN8(hwregs, reg) *(volatile uint8_t *)((hwregs) + (reg) + 0x8000) -#define VIDEO_OUT(hwregs, reg, val) VIA_OUT((hwregs)+0x200, reg, val) -#define VIDEO_IN(hwregs, reg) VIA_IN((hwregs)+0x200, reg) - -#define outb(val,reg) OUTPORT8(reg,val) -#define inb(reg) INPORT8(reg) - -#define ALIGN_TO(v, n) (((v) + (n-1)) & ~(n-1)) -#define UC_MAP_V1_FIFO_CONTROL(depth, pre_thr, thr) \ - (((depth)-1) | ((thr) << 8) | ((pre_thr) << 24)) - -#define FRAMEBUFFER_START 0x600000 -#define FRAMEBUFFER_SIZE 0x200000 - -#ifdef DEBUG_LOGFILE -FILE *logfile=0; -#define LOGWRITE(x) {if(logfile) fprintf(logfile,x);} -#else -#define LOGWRITE(x) -#endif - - -static vidix_capability_t uc_cap = -{ - "VIA CLE266 Unichrome driver", - "Timothy Lee <timothy@siriushk.com>", - TYPE_OUTPUT, - { 0, 0, 0, 0 }, - 4096, - 4096, - 4, - 4, - -1, - FLAG_UPSCALER|FLAG_DOWNSCALER, - VENDOR_VIA2, - -1, - { 0, 0, 0, 0 } -}; - - -unsigned int vixGetVersion(void) -{ - return(VIDIX_VERSION); -} - - -static unsigned short uc_card_ids[] = -{ - DEVICE_VIA2_VT8623_APOLLO_CLE266 -}; - - -static int find_chip(unsigned chip_id) -{ - unsigned i; - for(i = 0;i < sizeof(uc_card_ids)/sizeof(unsigned short);i++) - { - if(chip_id == uc_card_ids[i]) return i; - } - return -1; -} - - -/** - * Map hw settings for vertical scaling. - * - * @param sh source height - * @param dh destination height - * @param zoom will hold vertical setting of zoom register. - * @param mini will hold vertical setting of mini register. - * - * @returns 1 if successful. - * 0 if the zooming factor is too large or small. - * - * @note Derived from VIA's V4L driver. - * See ddover.c, DDOVER_HQVCalcZoomHeight() - */ - -static int uc_ovl_map_vzoom(int sh, int dh, uint32_t* zoom, uint32_t* mini) -{ - uint32_t sh1, tmp, d; - int zoom_ok = 1; - - if (sh == dh) { // No zoom - // Do nothing - } - else if (sh < dh) { // Zoom in - - tmp = (sh * 0x0400) / dh; - zoom_ok = !(tmp > 0x3ff); - - *zoom |= (tmp & 0x3ff) | V1_Y_ZOOM_ENABLE; - *mini |= V1_Y_INTERPOLY | V1_YCBCR_INTERPOLY; - } - else { // sw > dh - Zoom out - - // Find a suitable divider (1 << d) = {2, 4, 8 or 16} - - sh1 = sh; - for (d = 1; d < 5; d++) { - sh1 >>= 1; - if (sh1 <= dh) break; - } - if (d == 5) { // Too small. - d = 4; - zoom_ok = 0; - } - - *mini |= ((d<<1)-1) << 16; // <= {1,3,5,7} << 16 - - // Add scaling - - if (sh1 < dh) { - tmp = (sh1 * 0x400) / dh; - *zoom |= ((tmp & 0x3ff) | V1_Y_ZOOM_ENABLE); - *mini |= V1_Y_INTERPOLY | V1_YCBCR_INTERPOLY; - } - } - - return zoom_ok; -} - - -/** - * Map hw settings for horizontal scaling. - * - * @param sw source width - * @param dw destination width - * - * @param zoom will hold horizontal setting of zoom register. - * @param mini will hold horizontal setting of mini register. - * @param falign will hold fetch aligment - * @param dcount will hold display count - * - * @returns 1 if successful. - * 0 if the zooming factor is too large or small. - * - * @note Derived from VIA's V4L driver. - * See ddover.c, DDOVER_HQVCalcZoomWidth() and DDOver_GetDisplayCount() - */ -static int uc_ovl_map_hzoom(int sw, int dw, uint32_t* zoom, uint32_t* mini, - int* falign, int* dcount) -{ - uint32_t tmp, sw1, d; - int md; // Minify-divider - int zoom_ok = 1; - - md = 1; - *falign = 0; - - if (sw == dw) { // No zoom - // Do nothing - } - else if (sw < dw) { // Zoom in - - tmp = (sw * 0x0800) / dw; - zoom_ok = !(tmp > 0x7ff); - - *zoom |= ((tmp & 0x7ff) << 16) | V1_X_ZOOM_ENABLE; - *mini |= V1_X_INTERPOLY; - } - else { // sw > dw - Zoom out - - // Find a suitable divider (1 << d) = {2, 4, 8 or 16} - - sw1 = sw; - for (d = 1; d < 5; d++) { - sw1 >>= 1; - if (sw1 <= dw) break; - } - if (d == 5) { // Too small. - d = 4; - zoom_ok = 0; - } - - md = 1 << d; // <= {2,4,8,16} - *falign = ((md<<1)-1) & 0xf; // <= {3,7,15,15} - *mini |= V1_X_INTERPOLY; - *mini |= ((d<<1)-1) << 24; // <= {1,3,5,7} << 24 - - // Add scaling - - if (sw1 < dw) { - //CLE bug - //tmp = sw1*0x0800 / dw; - tmp = (sw1 - 2) * 0x0800 / dw; - *zoom |= ((tmp & 0x7ff) << 16) | V1_X_ZOOM_ENABLE; - } - } - - *dcount = sw - md; - - return zoom_ok; -} - - -/** - * @param format overlay pixel format - * @param sw source width - * - * @returns qword fetch register setting - * - * @note Derived from VIA's V4L driver. See ddover.c, DDOver_GetFetch() - * @note Only call after uc_ovl_map_hzoom() - */ -static uint32_t uc_ovl_map_qwfetch(uint32_t format, int sw) -{ - uint32_t fetch = 0; - - switch (format) { - case IMGFMT_YV12: - case IMGFMT_I420: - fetch = ALIGN_TO(sw, 32) >> 4; - break; - case IMGFMT_UYVY: - case IMGFMT_YVYU: - case IMGFMT_YUY2: - fetch = (ALIGN_TO(sw << 1, 16) >> 4) + 1; - break; - case IMGFMT_BGR15: - case IMGFMT_BGR16: - fetch = (ALIGN_TO(sw << 1, 16) >> 4) + 1; - break; - case IMGFMT_BGR32: - fetch = (ALIGN_TO(sw << 2, 16) >> 4) + 1; - break; - default: - printf("[unichrome] Unexpected pixelformat!"); - break; - } - - if (fetch < 4) - fetch = 4; - - return fetch; -} - - -/** - * Map pixel format. - * - * @note Derived from VIA's V4L driver. See ddover.c, DDOver_GetV1Format() - */ -static uint32_t uc_ovl_map_format(uint32_t format) -{ - switch (format) { - case IMGFMT_UYVY: - case IMGFMT_YVYU: - case IMGFMT_YUY2: - return V1_COLORSPACE_SIGN | V1_YUV422; - case IMGFMT_IYUV: - return V1_COLORSPACE_SIGN | V1_YCbCr420 | V1_SWAP_SW; - case IMGFMT_YV12: - case IMGFMT_I420: - return V1_COLORSPACE_SIGN | V1_YCbCr420; - case IMGFMT_BGR15: - return V1_RGB15; - case IMGFMT_BGR16: - return V1_RGB16; - case IMGFMT_BGR32: - return V1_RGB32; - default : - printf("[unichrome] Unexpected pixelformat!"); - return V1_YUV422; - } -} - - -/** - * Calculate V1 control and fifo-control register values - * @param format pixel format - * @param sw source width - * @param hwrev CLE266 hardware revision - * @param extfifo_on set this 1 if the extended FIFO is enabled - * @param control will hold value for V1_CONTROL - * @param fifo will hold value for V1_FIFO_CONTROL - */ -static void uc_ovl_map_v1_control(uint32_t format, int sw, - int hwrev, int extfifo_on, - uint32_t* control, uint32_t* fifo) -{ - *control = V1_BOB_ENABLE | uc_ovl_map_format(format); - - if (hwrev == 0x10) { - *control |= V1_EXPIRE_NUM_F; - } - else { - if (extfifo_on) { - *control |= V1_EXPIRE_NUM_A | V1_FIFO_EXTENDED; - } - else { - *control |= V1_EXPIRE_NUM; - } - } - - if ((format == IMGFMT_YV12) || (format == IMGFMT_I420)) { - //Minified video will be skewed without this workaround. - if (sw <= 80) { //Fetch count <= 5 - *fifo = UC_MAP_V1_FIFO_CONTROL(16,0,0); - } - else { - if (hwrev == 0x10) - *fifo = UC_MAP_V1_FIFO_CONTROL(64,56,56); - else - *fifo = UC_MAP_V1_FIFO_CONTROL(16,12,8); - } - } - else { - if (hwrev == 0x10) { - *fifo = UC_MAP_V1_FIFO_CONTROL(64,56,56); // Default rev 0x10 - } - else { - if (extfifo_on) - *fifo = UC_MAP_V1_FIFO_CONTROL(48,40,40); - else - *fifo = UC_MAP_V1_FIFO_CONTROL(32,29,16); // Default - } - } -} - - -static void uc_ovl_setup_fifo(int *extfifo_on, int dst_w) -{ - if (dst_w <= 1024) - { - // Disable extended FIFO - outb(0x16, 0x3c4); outb(mclk_save[0], 0x3c5); - outb(0x17, 0x3c4); outb(mclk_save[1], 0x3c5); - outb(0x18, 0x3c4); outb(mclk_save[2], 0x3c5); - *extfifo_on = 0; - } - else - { - // Enable extended FIFO - outb(0x17, 0x3c4); outb(0x2f, 0x3c5); - outb(0x16, 0x3c4); outb((mclk_save[0] & 0xf0) | 0x14, 0x3c5); - outb(0x18, 0x3c4); outb(0x56, 0x3c5); - *extfifo_on = 1; - } -} - - -static void uc_ovl_vcmd_wait(volatile uint8_t* vio) -{ - while ((VIDEO_IN(vio, V_COMPOSE_MODE) - & (V1_COMMAND_FIRE | V3_COMMAND_FIRE))); -} - - -int vixProbe(int verbose, int force) -{ - pciinfo_t lst[MAX_PCI_DEVICES]; - unsigned i,num_pci; - int err; - err = pci_scan(lst,&num_pci); - if(err) - { - printf("[unichrome] Error occurred during pci scan: %s\n",strerror(err)); - return err; - } - else - { - err = ENXIO; - for(i=0; i < num_pci; i++) - { - if(lst[i].vendor == VENDOR_VIA2) - { - int idx; - const char *dname; - idx = find_chip(lst[i].device); - if(idx == -1) - continue; - dname = pci_device_name(VENDOR_VIA2, lst[i].device); - dname = dname ? dname : "Unknown chip"; - printf("[unichrome] Found chip: %s\n", dname); - uc_cap.device_id = lst[i].device; - err = 0; - memcpy(&pci_info, &lst[i], sizeof(pciinfo_t)); - break; - } - } - } - - if(err && verbose) printf("[unichrome] Can't find chip\n"); - return err; -} - - -int vixInit(const char *args) -{ - long tmp; - uc_mem = map_phys_mem(pci_info.base0, 0x800000); - enable_app_io(); - - outb(0x2f, 0x3c4); - tmp = inb(0x3c5) << 0x18; - vio = map_phys_mem(tmp,0x1000); - - outb(0x16, 0x3c4); mclk_save[0] = inb(0x3c5); - outb(0x17, 0x3c4); mclk_save[1] = inb(0x3c5); - outb(0x18, 0x3c4); mclk_save[2] = inb(0x3c5); - - uc_grkey.ckey.blue = 0x00; - uc_grkey.ckey.green = 0x00; - uc_grkey.ckey.red = 0x00; - -#ifdef DEBUG_LOGFILE - logfile=fopen("/tmp/uc_vidix.log","w"); -#endif - return 0; -} - -void vixDestroy(void) -{ -#ifdef DEBUG_LOGFILE - if(logfile) - fclose(logfile); -#endif - outb(0x16, 0x3c4); outb(mclk_save[0], 0x3c5); - outb(0x17, 0x3c4); outb(mclk_save[1], 0x3c5); - outb(0x18, 0x3c4); outb(mclk_save[2], 0x3c5); - - disable_app_io(); - unmap_phys_mem(uc_mem, 0x800000); - unmap_phys_mem(vio, 0x1000); -} - - -int vixGetCapability(vidix_capability_t *to) -{ - memcpy(to, &uc_cap, sizeof(vidix_capability_t)); - return 0; -} - - -static int is_supported_fourcc(uint32_t fourcc) -{ - switch(fourcc) - { - case IMGFMT_YV12: - case IMGFMT_I420: - case IMGFMT_UYVY: - case IMGFMT_YVYU: - case IMGFMT_YUY2: - case IMGFMT_BGR15: - case IMGFMT_BGR16: - case IMGFMT_BGR32: - return 1; - default: - return 0; - } -} - -int vixQueryFourcc(vidix_fourcc_t *to) -{ - if(is_supported_fourcc(to->fourcc)) - { - to->depth = VID_DEPTH_1BPP | VID_DEPTH_2BPP | - VID_DEPTH_4BPP | VID_DEPTH_8BPP | - VID_DEPTH_12BPP| VID_DEPTH_15BPP| - VID_DEPTH_16BPP| VID_DEPTH_24BPP| - VID_DEPTH_32BPP; - to->flags = VID_CAP_EXPAND | VID_CAP_SHRINK | VID_CAP_COLORKEY; - return 0; - } - else - to->depth = to->flags = 0; - return ENOSYS; -} - - -int vixGetGrKeys(vidix_grkey_t *grkey) -{ - memcpy(grkey, &uc_grkey, sizeof(vidix_grkey_t)); - return(0); -} - - -int vixSetGrKeys(const vidix_grkey_t *grkey) -{ - unsigned long dwCompose = VIDEO_IN(vio, V_COMPOSE_MODE) & ~0x0f; - memcpy(&uc_grkey, grkey, sizeof(vidix_grkey_t)); - if (uc_grkey.ckey.op != CKEY_FALSE) - { - // Set colorkey - // (how do I detect BPP in hardware??) - unsigned long ckey; - if (1) // Assume 16-bit graphics - { - ckey = (grkey->ckey.blue & 0x1f) - | ((grkey->ckey.green & 0x3f) << 5) - | ((grkey->ckey.red & 0x1f) << 11); - } - else - { - ckey = (grkey->ckey.blue) - | (grkey->ckey.green << 8) - | (grkey->ckey.red << 16); - } - VIDEO_OUT(vio, V_COLOR_KEY, ckey); - dwCompose |= SELECT_VIDEO_IF_COLOR_KEY; - } - - // Execute the changes - VIDEO_OUT(vio, V_COMPOSE_MODE, dwCompose | V1_COMMAND_FIRE); - return(0); -} - - -vidix_video_eq_t equal = -{ - VEQ_CAP_BRIGHTNESS | VEQ_CAP_SATURATION | VEQ_CAP_HUE, - 300, 100, 0, 0, 0, 0, 0, 0 -}; - -int vixPlaybackGetEq( vidix_video_eq_t * eq) -{ - memcpy(eq,&equal,sizeof(vidix_video_eq_t)); - return 0; -} - -int vixPlaybackSetEq( const vidix_video_eq_t * eq) -{ - return 0; -} - - -static int YOffs,UOffs,VOffs; - -int vixConfigPlayback(vidix_playback_t *info) -{ - int src_w, drw_w; - int src_h, drw_h; - long base0, pitch; - int uv_size, swap_uv; - unsigned int i; - int extfifo_on; - - // Overlay register settings - uint32_t win_start, win_end; - uint32_t zoom, mini; - uint32_t dcount, falign, qwfetch; - uint32_t v_ctrl, fifo_ctrl; - - if(!is_supported_fourcc(info->fourcc)) - return -1; - - src_w = info->src.w; - src_h = info->src.h; - - drw_w = info->dest.w; - drw_h = info->dest.h; - - // Setup FIFO - uc_ovl_setup_fifo(&extfifo_on, src_w); - - // Get image format, FIFO size, etc. - uc_ovl_map_v1_control(info->fourcc, src_w, 3, extfifo_on, - &v_ctrl, &fifo_ctrl); - - // Setup layer window - win_start = (info->dest.x << 16) | info->dest.y; - win_end = ((info->dest.x + drw_w - 1) << 16) | - (info->dest.y + drw_h - 1); - - // Get scaling and data-fetch parameters - zoom = 0; - mini = 0; - uc_ovl_map_vzoom(src_h, drw_h, &zoom, &mini); - uc_ovl_map_hzoom(src_w, drw_w, &zoom, &mini, &falign, &dcount); - qwfetch = uc_ovl_map_qwfetch(info->fourcc, src_w); - - // Calculate buffer sizes - swap_uv = 0; - switch(info->fourcc) - { - default: - case IMGFMT_YV12: - swap_uv = 1; - case IMGFMT_I420: - case IMGFMT_UYVY: - case IMGFMT_YVYU: - pitch = ALIGN_TO (src_w, 32); - uv_size = (pitch >> 1) * (src_h >> 1); - break; - - case IMGFMT_YUY2: - case IMGFMT_BGR15: - case IMGFMT_BGR16: - pitch = ALIGN_TO (src_w << 1, 32); - uv_size = 0; - break; - - case IMGFMT_BGR32: - pitch = ALIGN_TO (src_w << 2, 32); - uv_size = 0; - break; - } - if ((src_w > 4096) || (src_h > 4096) || - (src_w < 32) || (src_h < 1) || (pitch > 0x1fff)) - { - printf("[unichrome] Layer size out of bounds\n"); - } - - // Calculate offsets - info->offset.y = 0; - info->offset.v = info->offset.y + pitch * src_h; - info->offset.u = info->offset.v + uv_size; - info->frame_size = info->offset.u + uv_size; - YOffs = info->offset.y; - UOffs = (swap_uv ? info->offset.v : info->offset.u); - VOffs = (swap_uv ? info->offset.u : info->offset.v); - - /* Assume we have 2 MB to play with */ - info->num_frames = FRAMEBUFFER_SIZE / info->frame_size; - if(info->num_frames > VID_PLAY_MAXFRAMES) - info->num_frames = VID_PLAY_MAXFRAMES; - - /* Start at 6 MB. Let's hope it's not in use. */ - base0 = FRAMEBUFFER_START; - info->dga_addr = uc_mem + base0; - - info->dest.pitch.y = 32; - info->dest.pitch.u = 32; - info->dest.pitch.v = 32; - - for(i = 0; i < info->num_frames; i++) - { - info->offsets[i] = info->frame_size * i; - frames[i] = base0+info->offsets[i]; - } - - // Write to the hardware - uc_ovl_vcmd_wait(vio); - - // Configure diy_pitchlay parameters now - if (v_ctrl & V1_COLORSPACE_SIGN) - { - VIDEO_OUT (vio, V1_ColorSpaceReg_2, ColorSpaceValue_2); - VIDEO_OUT (vio, V1_ColorSpaceReg_1, ColorSpaceValue_1); - } - - VIDEO_OUT(vio, V1_CONTROL, v_ctrl); - VIDEO_OUT(vio, V_FIFO_CONTROL, fifo_ctrl); - - VIDEO_OUT(vio, V1_WIN_START_Y, win_start); - VIDEO_OUT(vio, V1_WIN_END_Y, win_end); - - VIDEO_OUT(vio, V1_SOURCE_HEIGHT, (src_h << 16) | dcount); - - VIDEO_OUT(vio, V12_QWORD_PER_LINE, qwfetch << 20); - VIDEO_OUT(vio, V1_STRIDE, pitch | ((pitch >> 1) << 16)); - - VIDEO_OUT(vio, V1_MINI_CONTROL, mini); - VIDEO_OUT(vio, V1_ZOOM_CONTROL, zoom); - - // Configure buffer address and execute the changes now! - vixPlaybackFrameSelect(0); - - return 0; -} - - -int vixPlaybackOn(void) -{ - LOGWRITE("Enable overlay\n"); - - // Turn on overlay - VIDEO_OUT(vio, V1_CONTROL, VIDEO_IN(vio, V1_CONTROL) | V1_ENABLE); - - // Execute the changes - VIDEO_OUT(vio, V_COMPOSE_MODE, - VIDEO_IN(vio, V_COMPOSE_MODE) | V1_COMMAND_FIRE); - - return 0; -} - - -int vixPlaybackOff(void) -{ - LOGWRITE("Disable overlay\n"); - - uc_ovl_vcmd_wait(vio); - - // Restore FIFO - VIDEO_OUT(vio, V_FIFO_CONTROL, UC_MAP_V1_FIFO_CONTROL(16,12,8)); - - // Turn off overlay - VIDEO_OUT(vio, V1_CONTROL, VIDEO_IN(vio, V1_CONTROL) & ~V1_ENABLE); - - // Execute the changes - VIDEO_OUT(vio, V_COMPOSE_MODE, - VIDEO_IN(vio, V_COMPOSE_MODE) | V1_COMMAND_FIRE); - - return 0; -} - - -int vixPlaybackFrameSelect(unsigned int frame) -{ - LOGWRITE("Frame select\n"); - - uc_ovl_vcmd_wait(vio); - - // Configure buffer address - VIDEO_OUT(vio, V1_STARTADDR_Y0, frames[frame]+YOffs); - VIDEO_OUT(vio, V1_STARTADDR_CB0, frames[frame]+UOffs); - VIDEO_OUT(vio, V1_STARTADDR_CR0, frames[frame]+VOffs); - - // Execute the changes - VIDEO_OUT(vio, V_COMPOSE_MODE, - VIDEO_IN(vio, V_COMPOSE_MODE) | V1_COMMAND_FIRE); - - return 0; -} - |