314 lines
9.2 KiB
C
314 lines
9.2 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2010-2013 Bluecherry, LLC <http://www.bluecherrydvr.com>
|
||
|
|
*
|
||
|
|
* Original author:
|
||
|
|
* Ben Collins <bcollins@ubuntu.com>
|
||
|
|
*
|
||
|
|
* Additional work by:
|
||
|
|
* John Brooks <john.brooks@bluecherry.net>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/videodev2.h>
|
||
|
|
#include <media/v4l2-ioctl.h>
|
||
|
|
|
||
|
|
#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 1024
|
||
|
|
#define SOLO_MOT_FLAG_AREA (SOLO_MOT_FLAG_SIZE * 16)
|
||
|
|
|
||
|
|
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));
|
||
|
|
|
||
|
|
/* On 6110, initialize mozaic darkness strength */
|
||
|
|
if (solo_dev->type == SOLO_DEV_6010)
|
||
|
|
solo_reg_write(solo_dev, SOLO_VI_FMT_CFG, 0);
|
||
|
|
else
|
||
|
|
solo_reg_write(solo_dev, SOLO_VI_FMT_CFG, 16 << 22);
|
||
|
|
|
||
|
|
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_vout_config_cursor(struct solo_dev *dev)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
/* Load (blank) cursor bitmap mask (2bpp) */
|
||
|
|
for (i = 0; i < 20; i++)
|
||
|
|
solo_reg_write(dev, SOLO_VO_CURSOR_MASK(i), 0);
|
||
|
|
|
||
|
|
solo_reg_write(dev, SOLO_VO_CURSOR_POS, 0);
|
||
|
|
|
||
|
|
solo_reg_write(dev, SOLO_VO_CURSOR_CLR,
|
||
|
|
(0x80 << 24) | (0x80 << 16) | (0x10 << 8) | 0x80);
|
||
|
|
solo_reg_write(dev, SOLO_VO_CURSOR_CLR2, (0xe0 << 8) | 0x80);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void solo_vout_config(struct solo_dev *solo_dev)
|
||
|
|
{
|
||
|
|
solo_dev->vout_hstart = 6;
|
||
|
|
solo_dev->vout_vstart = 8;
|
||
|
|
|
||
|
|
solo_reg_write(solo_dev, SOLO_VO_FMT_ENC,
|
||
|
|
solo_dev->video_type |
|
||
|
|
SOLO_VO_USER_COLOR_SET_NAV |
|
||
|
|
SOLO_VO_USER_COLOR_SET_NAH |
|
||
|
|
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));
|
||
|
|
|
||
|
|
/* Border & background colors */
|
||
|
|
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_DISP_ERASE, SOLO_VO_DISP_ERASE_ON);
|
||
|
|
|
||
|
|
solo_reg_write(solo_dev, SOLO_VI_WIN_SW, 0);
|
||
|
|
|
||
|
|
solo_reg_write(solo_dev, SOLO_VO_ZOOM_CTRL, 0);
|
||
|
|
solo_reg_write(solo_dev, SOLO_VO_FREEZE_CTRL, 0);
|
||
|
|
|
||
|
|
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_vout_config_cursor(solo_dev);
|
||
|
|
|
||
|
|
/* Enable channels we support */
|
||
|
|
solo_reg_write(solo_dev, SOLO_VI_CH_ENA,
|
||
|
|
(1 << solo_dev->nr_chans) - 1);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int solo_dma_vin_region(struct solo_dev *solo_dev, u32 off,
|
||
|
|
u16 val, int reg_size)
|
||
|
|
{
|
||
|
|
__le16 *buf;
|
||
|
|
const int n = 64, size = n * sizeof(*buf);
|
||
|
|
int i, ret = 0;
|
||
|
|
|
||
|
|
buf = kmalloc(size, GFP_KERNEL);
|
||
|
|
if (!buf)
|
||
|
|
return -ENOMEM;
|
||
|
|
|
||
|
|
for (i = 0; i < n; i++)
|
||
|
|
buf[i] = cpu_to_le16(val);
|
||
|
|
|
||
|
|
for (i = 0; i < reg_size; i += size) {
|
||
|
|
ret = solo_p2m_dma(solo_dev, 1, buf,
|
||
|
|
SOLO_MOTION_EXT_ADDR(solo_dev) + off + i,
|
||
|
|
size, 0, 0);
|
||
|
|
|
||
|
|
if (ret)
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
kfree(buf);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
int solo_set_motion_threshold(struct solo_dev *solo_dev, u8 ch, u16 val)
|
||
|
|
{
|
||
|
|
if (ch > solo_dev->nr_chans)
|
||
|
|
return -EINVAL;
|
||
|
|
|
||
|
|
return solo_dma_vin_region(solo_dev, SOLO_MOT_FLAG_AREA +
|
||
|
|
(ch * SOLO_MOT_THRESH_SIZE * 2),
|
||
|
|
val, SOLO_MOT_THRESH_SIZE);
|
||
|
|
}
|
||
|
|
|
||
|
|
int solo_set_motion_block(struct solo_dev *solo_dev, u8 ch,
|
||
|
|
const u16 *thresholds)
|
||
|
|
{
|
||
|
|
const unsigned size = sizeof(u16) * 64;
|
||
|
|
u32 off = SOLO_MOT_FLAG_AREA + ch * SOLO_MOT_THRESH_SIZE * 2;
|
||
|
|
__le16 *buf;
|
||
|
|
int x, y;
|
||
|
|
int ret = 0;
|
||
|
|
|
||
|
|
buf = kzalloc(size, GFP_KERNEL);
|
||
|
|
if (buf == NULL)
|
||
|
|
return -ENOMEM;
|
||
|
|
for (y = 0; y < SOLO_MOTION_SZ; y++) {
|
||
|
|
for (x = 0; x < SOLO_MOTION_SZ; x++)
|
||
|
|
buf[x] = cpu_to_le16(thresholds[y * SOLO_MOTION_SZ + x]);
|
||
|
|
ret |= solo_p2m_dma(solo_dev, 1, buf,
|
||
|
|
SOLO_MOTION_EXT_ADDR(solo_dev) + off + y * size,
|
||
|
|
size, 0, 0);
|
||
|
|
}
|
||
|
|
kfree(buf);
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* First 8k is motion flag (512 bytes * 16). Following that is an 8k+8k
|
||
|
|
* threshold and working table for each channel. At least that's what the
|
||
|
|
* spec says. However, this code (taken 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 +
|
||
|
|
(i * SOLO_MOT_THRESH_SIZE * 2) +
|
||
|
|
SOLO_MOT_THRESH_SIZE, 0x0000,
|
||
|
|
SOLO_MOT_THRESH_SIZE);
|
||
|
|
|
||
|
|
/* 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 (solo_dev->video_type == SOLO_VO_FMT_TYPE_NTSC) {
|
||
|
|
solo_dev->video_vsize = 240;
|
||
|
|
solo_dev->fps = 30;
|
||
|
|
} else {
|
||
|
|
solo_dev->video_vsize = 288;
|
||
|
|
solo_dev->fps = 25;
|
||
|
|
}
|
||
|
|
|
||
|
|
solo_vin_config(solo_dev);
|
||
|
|
solo_motion_config(solo_dev);
|
||
|
|
solo_vout_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_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);
|
||
|
|
}
|