/* * Copyright (C) 2010 Bluecherry, LLC www.bluecherrydvr.com * Copyright (C) 2010 Ben Collins * * 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. */ #include #include #include #include #include "solo6x10.h" #define SOLO_VCLK_DELAY 3 #define SOLO_PROGRESSIVE_VSIZE 1024 #define SOLO_MOT_THRESH_W 64 #define SOLO_MOT_THRESH_H 64 #define SOLO_MOT_THRESH_SIZE 8192 #define SOLO_MOT_THRESH_REAL (SOLO_MOT_THRESH_W * SOLO_MOT_THRESH_H) #define SOLO_MOT_FLAG_SIZE 512 #define SOLO_MOT_FLAG_AREA (SOLO_MOT_FLAG_SIZE * 32) static unsigned video_type; module_param(video_type, uint, 0644); MODULE_PARM_DESC(video_type, "video_type (0 = NTSC/Default, 1 = PAL)"); static void solo_vin_config(struct solo_dev *solo_dev) { solo_dev->vin_hstart = 8; solo_dev->vin_vstart = 2; solo_reg_write(solo_dev, SOLO_SYS_VCLK, SOLO_VCLK_SELECT(2) | SOLO_VCLK_VIN1415_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN1213_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN1011_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN0809_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN0607_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN0405_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN0203_DELAY(SOLO_VCLK_DELAY) | SOLO_VCLK_VIN0001_DELAY(SOLO_VCLK_DELAY)); solo_reg_write(solo_dev, SOLO_VI_ACT_I_P, SOLO_VI_H_START(solo_dev->vin_hstart) | SOLO_VI_V_START(solo_dev->vin_vstart) | SOLO_VI_V_STOP(solo_dev->vin_vstart + solo_dev->video_vsize)); solo_reg_write(solo_dev, SOLO_VI_ACT_I_S, SOLO_VI_H_START(solo_dev->vout_hstart) | SOLO_VI_V_START(solo_dev->vout_vstart) | SOLO_VI_V_STOP(solo_dev->vout_vstart + solo_dev->video_vsize)); solo_reg_write(solo_dev, SOLO_VI_ACT_P, SOLO_VI_H_START(0) | SOLO_VI_V_START(1) | SOLO_VI_V_STOP(SOLO_PROGRESSIVE_VSIZE)); solo_reg_write(solo_dev, SOLO_VI_CH_FORMAT, SOLO_VI_FD_SEL_MASK(0) | SOLO_VI_PROG_MASK(0)); solo_reg_write(solo_dev, SOLO_VI_FMT_CFG, 0); solo_reg_write(solo_dev, SOLO_VI_PAGE_SW, 2); if (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) { solo_reg_write(solo_dev, SOLO_VI_PB_CONFIG, SOLO_VI_PB_USER_MODE); solo_reg_write(solo_dev, SOLO_VI_PB_RANGE_HV, SOLO_VI_PB_HSIZE(858) | SOLO_VI_PB_VSIZE(246)); solo_reg_write(solo_dev, SOLO_VI_PB_ACT_V, SOLO_VI_PB_VSTART(4) | SOLO_VI_PB_VSTOP(4 + 240)); } else { solo_reg_write(solo_dev, SOLO_VI_PB_CONFIG, SOLO_VI_PB_USER_MODE | SOLO_VI_PB_PAL); solo_reg_write(solo_dev, SOLO_VI_PB_RANGE_HV, SOLO_VI_PB_HSIZE(864) | SOLO_VI_PB_VSIZE(294)); solo_reg_write(solo_dev, SOLO_VI_PB_ACT_V, SOLO_VI_PB_VSTART(4) | SOLO_VI_PB_VSTOP(4 + 288)); } solo_reg_write(solo_dev, SOLO_VI_PB_ACT_H, SOLO_VI_PB_HSTART(16) | SOLO_VI_PB_HSTOP(16 + 720)); } static void solo_disp_config(struct solo_dev *solo_dev) { solo_dev->vout_hstart = 6; solo_dev->vout_vstart = 8; solo_reg_write(solo_dev, SOLO_VO_BORDER_LINE_COLOR, (0xa0 << 24) | (0x88 << 16) | (0xa0 << 8) | 0x88); solo_reg_write(solo_dev, SOLO_VO_BORDER_FILL_COLOR, (0x10 << 24) | (0x8f << 16) | (0x10 << 8) | 0x8f); solo_reg_write(solo_dev, SOLO_VO_BKG_COLOR, (16 << 24) | (128 << 16) | (16 << 8) | 128); solo_reg_write(solo_dev, SOLO_VO_FMT_ENC, solo_dev->video_type | SOLO_VO_USER_COLOR_SET_NAV | SOLO_VO_NA_COLOR_Y(0) | SOLO_VO_NA_COLOR_CB(0) | SOLO_VO_NA_COLOR_CR(0)); solo_reg_write(solo_dev, SOLO_VO_ACT_H, SOLO_VO_H_START(solo_dev->vout_hstart) | SOLO_VO_H_STOP(solo_dev->vout_hstart + solo_dev->video_hsize)); solo_reg_write(solo_dev, SOLO_VO_ACT_V, SOLO_VO_V_START(solo_dev->vout_vstart) | SOLO_VO_V_STOP(solo_dev->vout_vstart + solo_dev->video_vsize)); solo_reg_write(solo_dev, SOLO_VO_RANGE_HV, SOLO_VO_H_LEN(solo_dev->video_hsize) | SOLO_VO_V_LEN(solo_dev->video_vsize)); solo_reg_write(solo_dev, SOLO_VI_WIN_SW, 5); solo_reg_write(solo_dev, SOLO_VO_DISP_CTRL, SOLO_VO_DISP_ON | SOLO_VO_DISP_ERASE_COUNT(8) | SOLO_VO_DISP_BASE(SOLO_DISP_EXT_ADDR)); solo_reg_write(solo_dev, SOLO_VO_DISP_ERASE, SOLO_VO_DISP_ERASE_ON); /* Enable channels we support */ solo_reg_write(solo_dev, SOLO_VI_CH_ENA, (1 << solo_dev->nr_chans) - 1); /* Disable the watchdog */ solo_reg_write(solo_dev, SOLO_WATCHDOG, 0); } static int solo_dma_vin_region(struct solo_dev *solo_dev, u32 off, u16 val, int reg_size) { u16 buf[64]; int i; int ret = 0; for (i = 0; i < sizeof(buf) >> 1; i++) buf[i] = val; for (i = 0; i < reg_size; i += sizeof(buf)) ret |= solo_p2m_dma(solo_dev, SOLO_P2M_DMA_ID_VIN, 1, buf, SOLO_MOTION_EXT_ADDR(solo_dev) + off + i, sizeof(buf)); return ret; } void solo_set_motion_threshold(struct solo_dev *solo_dev, u8 ch, u16 val) { if (ch > solo_dev->nr_chans) return; solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA + (ch * SOLO_MOT_THRESH_SIZE * 2), val, SOLO_MOT_THRESH_REAL); } /* First 8k is motion flag (512 bytes * 16). Following that is an 8k+8k * threshold and working table for each channel. Atleast that's what the * spec says. However, this code (take from rdk) has some mystery 8k * block right after the flag area, before the first thresh table. */ static void solo_motion_config(struct solo_dev *solo_dev) { int i; for (i = 0; i < solo_dev->nr_chans; i++) { /* Clear motion flag area */ solo_dma_vin_region(solo_dev, i * SOLO_MOT_FLAG_SIZE, 0x0000, SOLO_MOT_FLAG_SIZE); /* Clear working cache table */ solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA + SOLO_MOT_THRESH_SIZE + (i * SOLO_MOT_THRESH_SIZE * 2), 0x0000, SOLO_MOT_THRESH_REAL); /* Set default threshold table */ solo_set_motion_threshold(solo_dev, i, SOLO_DEF_MOT_THRESH); } /* Default motion settings */ solo_reg_write(solo_dev, SOLO_VI_MOT_ADR, SOLO_VI_MOTION_EN(0) | (SOLO_MOTION_EXT_ADDR(solo_dev) >> 16)); solo_reg_write(solo_dev, SOLO_VI_MOT_CTRL, SOLO_VI_MOTION_FRAME_COUNT(3) | SOLO_VI_MOTION_SAMPLE_LENGTH(solo_dev->video_hsize / 16) | /* SOLO_VI_MOTION_INTR_START_STOP | */ SOLO_VI_MOTION_SAMPLE_COUNT(10)); solo_reg_write(solo_dev, SOLO_VI_MOTION_BORDER, 0); solo_reg_write(solo_dev, SOLO_VI_MOTION_BAR, 0); } int solo_disp_init(struct solo_dev *solo_dev) { int i; solo_dev->video_hsize = 704; if (video_type == 0) { solo_dev->video_type = SOLO_VO_FMT_TYPE_NTSC; solo_dev->video_vsize = 240; solo_dev->fps = 30; } else { solo_dev->video_type = SOLO_VO_FMT_TYPE_PAL; solo_dev->video_vsize = 288; solo_dev->fps = 25; } solo_vin_config(solo_dev); solo_motion_config(solo_dev); solo_disp_config(solo_dev); for (i = 0; i < solo_dev->nr_chans; i++) solo_reg_write(solo_dev, SOLO_VI_WIN_ON(i), 1); return 0; } void solo_disp_exit(struct solo_dev *solo_dev) { int i; solo_irq_off(solo_dev, SOLO_IRQ_MOTION); solo_reg_write(solo_dev, SOLO_VO_DISP_CTRL, 0); solo_reg_write(solo_dev, SOLO_VO_ZOOM_CTRL, 0); solo_reg_write(solo_dev, SOLO_VO_FREEZE_CTRL, 0); for (i = 0; i < solo_dev->nr_chans; i++) { solo_reg_write(solo_dev, SOLO_VI_WIN_CTRL0(i), 0); solo_reg_write(solo_dev, SOLO_VI_WIN_CTRL1(i), 0); solo_reg_write(solo_dev, SOLO_VI_WIN_ON(i), 0); } /* Set default border */ for (i = 0; i < 5; i++) solo_reg_write(solo_dev, SOLO_VO_BORDER_X(i), 0); for (i = 0; i < 5; i++) solo_reg_write(solo_dev, SOLO_VO_BORDER_Y(i), 0); solo_reg_write(solo_dev, SOLO_VO_BORDER_LINE_MASK, 0); solo_reg_write(solo_dev, SOLO_VO_BORDER_FILL_MASK, 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_CTRL(0), 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_START(0), 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_STOP(0), 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_CTRL(1), 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_START(1), 0); solo_reg_write(solo_dev, SOLO_VO_RECTANGLE_STOP(1), 0); }