mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-26 15:50:57 +07:00
b3d5496ea5
Some months ago, you killed the address ranges mechanism from all sensors i2c chip drivers (both the module parameters and the in-code address lists). I think it was a very good move, as the ranges can easily be replaced by individual addresses, and this allowed for significant cleanups in the i2c core (let alone the impressive size shrink for all these drivers). Unfortunately you did not do the same for non-sensors i2c chip drivers. These need the address ranges even less, so we could get rid of the ranges here as well for another significant i2c core cleanup. Here comes a patch which does just that. Since the process is exactly the same as what you did for the other drivers set already, I did not split this one in parts. A documentation update is included. The change saves 308 bytes in the i2c core, and an average 1382 bytes for chip drivers which use I2C_CLIENT_INSMOD, 126 bytes for those which do not. This change is required if we want to merge the sensors and non-sensors i2c code (and we want to do this). Signed-off-by: Jean Delvare <khali@linux-fr.org> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de> Index: gregkh-2.6/Documentation/i2c/writing-clients ===================================================================
843 lines
19 KiB
C
843 lines
19 KiB
C
/*
|
||
* Driver for the SAA5246A or SAA5281 Teletext (=Videotext) decoder chips from
|
||
* Philips.
|
||
*
|
||
* Only capturing of Teletext pages is tested. The videotext chips also have a
|
||
* TV output but my hardware doesn't use it. For this reason this driver does
|
||
* not support changing any TV display settings.
|
||
*
|
||
* Copyright (C) 2004 Michael Geng <linux@MichaelGeng.de>
|
||
*
|
||
* Derived from
|
||
*
|
||
* saa5249 driver
|
||
* Copyright (C) 1998 Richard Guenther
|
||
* <richard.guenther@student.uni-tuebingen.de>
|
||
*
|
||
* with changes by
|
||
* Alan Cox <Alan.Cox@linux.org>
|
||
*
|
||
* and
|
||
*
|
||
* vtx.c
|
||
* Copyright (C) 1994-97 Martin Buck <martin-2.buck@student.uni-ulm.de>
|
||
*
|
||
* 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 <linux/module.h>
|
||
#include <linux/kernel.h>
|
||
#include <linux/sched.h>
|
||
#include <linux/mm.h>
|
||
#include <linux/init.h>
|
||
#include <linux/i2c.h>
|
||
#include <linux/videotext.h>
|
||
#include <linux/videodev.h>
|
||
#include "saa5246a.h"
|
||
|
||
MODULE_AUTHOR("Michael Geng <linux@MichaelGeng.de>");
|
||
MODULE_DESCRIPTION("Philips SAA5246A, SAA5281 Teletext decoder driver");
|
||
MODULE_LICENSE("GPL");
|
||
|
||
struct saa5246a_device
|
||
{
|
||
u8 pgbuf[NUM_DAUS][VTX_VIRTUALSIZE];
|
||
int is_searching[NUM_DAUS];
|
||
struct i2c_client *client;
|
||
struct semaphore lock;
|
||
};
|
||
|
||
static struct video_device saa_template; /* Declared near bottom */
|
||
|
||
/* Addresses to scan */
|
||
static unsigned short normal_i2c[] = { I2C_ADDRESS, I2C_CLIENT_END };
|
||
I2C_CLIENT_INSMOD;
|
||
|
||
static struct i2c_client client_template;
|
||
|
||
static int saa5246a_attach(struct i2c_adapter *adap, int addr, int kind)
|
||
{
|
||
int pgbuf;
|
||
int err;
|
||
struct i2c_client *client;
|
||
struct video_device *vd;
|
||
struct saa5246a_device *t;
|
||
|
||
printk(KERN_INFO "saa5246a: teletext chip found.\n");
|
||
client=kmalloc(sizeof(*client), GFP_KERNEL);
|
||
if(client==NULL)
|
||
return -ENOMEM;
|
||
client_template.adapter = adap;
|
||
client_template.addr = addr;
|
||
memcpy(client, &client_template, sizeof(*client));
|
||
t = kmalloc(sizeof(*t), GFP_KERNEL);
|
||
if(t==NULL)
|
||
{
|
||
kfree(client);
|
||
return -ENOMEM;
|
||
}
|
||
memset(t, 0, sizeof(*t));
|
||
strlcpy(client->name, IF_NAME, I2C_NAME_SIZE);
|
||
init_MUTEX(&t->lock);
|
||
|
||
/*
|
||
* Now create a video4linux device
|
||
*/
|
||
|
||
vd = video_device_alloc();
|
||
if(vd==NULL)
|
||
{
|
||
kfree(t);
|
||
kfree(client);
|
||
return -ENOMEM;
|
||
}
|
||
i2c_set_clientdata(client, vd);
|
||
memcpy(vd, &saa_template, sizeof(*vd));
|
||
|
||
for (pgbuf = 0; pgbuf < NUM_DAUS; pgbuf++)
|
||
{
|
||
memset(t->pgbuf[pgbuf], ' ', sizeof(t->pgbuf[0]));
|
||
t->is_searching[pgbuf] = FALSE;
|
||
}
|
||
vd->priv=t;
|
||
|
||
|
||
/*
|
||
* Register it
|
||
*/
|
||
|
||
if((err=video_register_device(vd, VFL_TYPE_VTX,-1))<0)
|
||
{
|
||
kfree(t);
|
||
kfree(client);
|
||
video_device_release(vd);
|
||
return err;
|
||
}
|
||
t->client = client;
|
||
i2c_attach_client(client);
|
||
return 0;
|
||
}
|
||
|
||
/*
|
||
* We do most of the hard work when we become a device on the i2c.
|
||
*/
|
||
static int saa5246a_probe(struct i2c_adapter *adap)
|
||
{
|
||
if (adap->class & I2C_CLASS_TV_ANALOG)
|
||
return i2c_probe(adap, &addr_data, saa5246a_attach);
|
||
return 0;
|
||
}
|
||
|
||
static int saa5246a_detach(struct i2c_client *client)
|
||
{
|
||
struct video_device *vd = i2c_get_clientdata(client);
|
||
i2c_detach_client(client);
|
||
video_unregister_device(vd);
|
||
kfree(vd->priv);
|
||
kfree(client);
|
||
return 0;
|
||
}
|
||
|
||
static int saa5246a_command(struct i2c_client *device, unsigned int cmd,
|
||
void *arg)
|
||
{
|
||
return -EINVAL;
|
||
}
|
||
|
||
/*
|
||
* I2C interfaces
|
||
*/
|
||
|
||
static struct i2c_driver i2c_driver_videotext =
|
||
{
|
||
.owner = THIS_MODULE,
|
||
.name = IF_NAME, /* name */
|
||
.id = I2C_DRIVERID_SAA5249, /* in i2c.h */
|
||
.flags = I2C_DF_NOTIFY,
|
||
.attach_adapter = saa5246a_probe,
|
||
.detach_client = saa5246a_detach,
|
||
.command = saa5246a_command
|
||
};
|
||
|
||
static struct i2c_client client_template = {
|
||
.driver = &i2c_driver_videotext,
|
||
.name = "(unset)",
|
||
};
|
||
|
||
static int i2c_sendbuf(struct saa5246a_device *t, int reg, int count, u8 *data)
|
||
{
|
||
char buf[64];
|
||
|
||
buf[0] = reg;
|
||
memcpy(buf+1, data, count);
|
||
|
||
if(i2c_master_send(t->client, buf, count+1)==count+1)
|
||
return 0;
|
||
return -1;
|
||
}
|
||
|
||
static int i2c_senddata(struct saa5246a_device *t, ...)
|
||
{
|
||
unsigned char buf[64];
|
||
int v;
|
||
int ct=0;
|
||
va_list argp;
|
||
va_start(argp,t);
|
||
|
||
while((v=va_arg(argp,int))!=-1)
|
||
buf[ct++]=v;
|
||
return i2c_sendbuf(t, buf[0], ct-1, buf+1);
|
||
}
|
||
|
||
/* Get count number of bytes from I<>C-device at address adr, store them in buf.
|
||
* Start & stop handshaking is done by this routine, ack will be sent after the
|
||
* last byte to inhibit further sending of data. If uaccess is TRUE, data is
|
||
* written to user-space with put_user. Returns -1 if I<>C-device didn't send
|
||
* acknowledge, 0 otherwise
|
||
*/
|
||
static int i2c_getdata(struct saa5246a_device *t, int count, u8 *buf)
|
||
{
|
||
if(i2c_master_recv(t->client, buf, count)!=count)
|
||
return -1;
|
||
return 0;
|
||
}
|
||
|
||
/* When a page is found then the not FOUND bit in one of the status registers
|
||
* of the SAA5264A chip is cleared. Unfortunately this bit is not set
|
||
* automatically when a new page is requested. Instead this function must be
|
||
* called after a page has been requested.
|
||
*
|
||
* Return value: 0 if successful
|
||
*/
|
||
static int saa5246a_clear_found_bit(struct saa5246a_device *t,
|
||
unsigned char dau_no)
|
||
{
|
||
unsigned char row_25_column_8;
|
||
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
|
||
dau_no |
|
||
R8_DO_NOT_CLEAR_MEMORY,
|
||
|
||
R9_CURSER_ROW_25,
|
||
|
||
R10_CURSER_COLUMN_8,
|
||
|
||
COMMAND_END) ||
|
||
i2c_getdata(t, 1, &row_25_column_8))
|
||
{
|
||
return -EIO;
|
||
}
|
||
row_25_column_8 |= ROW25_COLUMN8_PAGE_NOT_FOUND;
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
|
||
dau_no |
|
||
R8_DO_NOT_CLEAR_MEMORY,
|
||
|
||
R9_CURSER_ROW_25,
|
||
|
||
R10_CURSER_COLUMN_8,
|
||
|
||
row_25_column_8,
|
||
|
||
COMMAND_END))
|
||
{
|
||
return -EIO;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
/* Requests one videotext page as described in req. The fields of req are
|
||
* checked and an error is returned if something is invalid.
|
||
*
|
||
* Return value: 0 if successful
|
||
*/
|
||
static int saa5246a_request_page(struct saa5246a_device *t,
|
||
vtx_pagereq_t *req)
|
||
{
|
||
if (req->pagemask < 0 || req->pagemask >= PGMASK_MAX)
|
||
return -EINVAL;
|
||
if (req->pagemask & PGMASK_PAGE)
|
||
if (req->page < 0 || req->page > PAGE_MAX)
|
||
return -EINVAL;
|
||
if (req->pagemask & PGMASK_HOUR)
|
||
if (req->hour < 0 || req->hour > HOUR_MAX)
|
||
return -EINVAL;
|
||
if (req->pagemask & PGMASK_MINUTE)
|
||
if (req->minute < 0 || req->minute > MINUTE_MAX)
|
||
return -EINVAL;
|
||
if (req->pgbuf < 0 || req->pgbuf >= NUM_DAUS)
|
||
return -EINVAL;
|
||
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R2,
|
||
|
||
R2_IN_R3_SELECT_PAGE_HUNDREDS |
|
||
req->pgbuf << 4 |
|
||
R2_BANK_0 |
|
||
R2_HAMMING_CHECK_OFF,
|
||
|
||
HUNDREDS_OF_PAGE(req->page) |
|
||
R3_HOLD_PAGE |
|
||
(req->pagemask & PG_HUND ?
|
||
R3_PAGE_HUNDREDS_DO_CARE :
|
||
R3_PAGE_HUNDREDS_DO_NOT_CARE),
|
||
|
||
TENS_OF_PAGE(req->page) |
|
||
(req->pagemask & PG_TEN ?
|
||
R3_PAGE_TENS_DO_CARE :
|
||
R3_PAGE_TENS_DO_NOT_CARE),
|
||
|
||
UNITS_OF_PAGE(req->page) |
|
||
(req->pagemask & PG_UNIT ?
|
||
R3_PAGE_UNITS_DO_CARE :
|
||
R3_PAGE_UNITS_DO_NOT_CARE),
|
||
|
||
TENS_OF_HOUR(req->hour) |
|
||
(req->pagemask & HR_TEN ?
|
||
R3_HOURS_TENS_DO_CARE :
|
||
R3_HOURS_TENS_DO_NOT_CARE),
|
||
|
||
UNITS_OF_HOUR(req->hour) |
|
||
(req->pagemask & HR_UNIT ?
|
||
R3_HOURS_UNITS_DO_CARE :
|
||
R3_HOURS_UNITS_DO_NOT_CARE),
|
||
|
||
TENS_OF_MINUTE(req->minute) |
|
||
(req->pagemask & MIN_TEN ?
|
||
R3_MINUTES_TENS_DO_CARE :
|
||
R3_MINUTES_TENS_DO_NOT_CARE),
|
||
|
||
UNITS_OF_MINUTE(req->minute) |
|
||
(req->pagemask & MIN_UNIT ?
|
||
R3_MINUTES_UNITS_DO_CARE :
|
||
R3_MINUTES_UNITS_DO_NOT_CARE),
|
||
|
||
COMMAND_END) || i2c_senddata(t, SAA5246A_REGISTER_R2,
|
||
|
||
R2_IN_R3_SELECT_PAGE_HUNDREDS |
|
||
req->pgbuf << 4 |
|
||
R2_BANK_0 |
|
||
R2_HAMMING_CHECK_OFF,
|
||
|
||
HUNDREDS_OF_PAGE(req->page) |
|
||
R3_UPDATE_PAGE |
|
||
(req->pagemask & PG_HUND ?
|
||
R3_PAGE_HUNDREDS_DO_CARE :
|
||
R3_PAGE_HUNDREDS_DO_NOT_CARE),
|
||
|
||
COMMAND_END))
|
||
{
|
||
return -EIO;
|
||
}
|
||
|
||
t->is_searching[req->pgbuf] = TRUE;
|
||
return 0;
|
||
}
|
||
|
||
/* This routine decodes the page number from the infobits contained in line 25.
|
||
*
|
||
* Parameters:
|
||
* infobits: must be bits 0 to 9 of column 25
|
||
*
|
||
* Return value: page number coded in hexadecimal, i. e. page 123 is coded 0x123
|
||
*/
|
||
static inline int saa5246a_extract_pagenum_from_infobits(
|
||
unsigned char infobits[10])
|
||
{
|
||
int page_hundreds, page_tens, page_units;
|
||
|
||
page_units = infobits[0] & ROW25_COLUMN0_PAGE_UNITS;
|
||
page_tens = infobits[1] & ROW25_COLUMN1_PAGE_TENS;
|
||
page_hundreds = infobits[8] & ROW25_COLUMN8_PAGE_HUNDREDS;
|
||
|
||
/* page 0x.. means page 8.. */
|
||
if (page_hundreds == 0)
|
||
page_hundreds = 8;
|
||
|
||
return((page_hundreds << 8) | (page_tens << 4) | page_units);
|
||
}
|
||
|
||
/* Decodes the hour from the infobits contained in line 25.
|
||
*
|
||
* Parameters:
|
||
* infobits: must be bits 0 to 9 of column 25
|
||
*
|
||
* Return: hour coded in hexadecimal, i. e. 12h is coded 0x12
|
||
*/
|
||
static inline int saa5246a_extract_hour_from_infobits(
|
||
unsigned char infobits[10])
|
||
{
|
||
int hour_tens, hour_units;
|
||
|
||
hour_units = infobits[4] & ROW25_COLUMN4_HOUR_UNITS;
|
||
hour_tens = infobits[5] & ROW25_COLUMN5_HOUR_TENS;
|
||
|
||
return((hour_tens << 4) | hour_units);
|
||
}
|
||
|
||
/* Decodes the minutes from the infobits contained in line 25.
|
||
*
|
||
* Parameters:
|
||
* infobits: must be bits 0 to 9 of column 25
|
||
*
|
||
* Return: minutes coded in hexadecimal, i. e. 10min is coded 0x10
|
||
*/
|
||
static inline int saa5246a_extract_minutes_from_infobits(
|
||
unsigned char infobits[10])
|
||
{
|
||
int minutes_tens, minutes_units;
|
||
|
||
minutes_units = infobits[2] & ROW25_COLUMN2_MINUTES_UNITS;
|
||
minutes_tens = infobits[3] & ROW25_COLUMN3_MINUTES_TENS;
|
||
|
||
return((minutes_tens << 4) | minutes_units);
|
||
}
|
||
|
||
/* Reads the status bits contained in the first 10 columns of the first line
|
||
* and extracts the information into info.
|
||
*
|
||
* Return value: 0 if successful
|
||
*/
|
||
static inline int saa5246a_get_status(struct saa5246a_device *t,
|
||
vtx_pageinfo_t *info, unsigned char dau_no)
|
||
{
|
||
unsigned char infobits[10];
|
||
int column;
|
||
|
||
if (dau_no >= NUM_DAUS)
|
||
return -EINVAL;
|
||
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
|
||
dau_no |
|
||
R8_DO_NOT_CLEAR_MEMORY,
|
||
|
||
R9_CURSER_ROW_25,
|
||
|
||
R10_CURSER_COLUMN_0,
|
||
|
||
COMMAND_END) ||
|
||
i2c_getdata(t, 10, infobits))
|
||
{
|
||
return -EIO;
|
||
}
|
||
|
||
info->pagenum = saa5246a_extract_pagenum_from_infobits(infobits);
|
||
info->hour = saa5246a_extract_hour_from_infobits(infobits);
|
||
info->minute = saa5246a_extract_minutes_from_infobits(infobits);
|
||
info->charset = ((infobits[7] & ROW25_COLUMN7_CHARACTER_SET) >> 1);
|
||
info->delete = !!(infobits[3] & ROW25_COLUMN3_DELETE_PAGE);
|
||
info->headline = !!(infobits[5] & ROW25_COLUMN5_INSERT_HEADLINE);
|
||
info->subtitle = !!(infobits[5] & ROW25_COLUMN5_INSERT_SUBTITLE);
|
||
info->supp_header = !!(infobits[6] & ROW25_COLUMN6_SUPPRESS_HEADER);
|
||
info->update = !!(infobits[6] & ROW25_COLUMN6_UPDATE_PAGE);
|
||
info->inter_seq = !!(infobits[6] & ROW25_COLUMN6_INTERRUPTED_SEQUENCE);
|
||
info->dis_disp = !!(infobits[6] & ROW25_COLUMN6_SUPPRESS_DISPLAY);
|
||
info->serial = !!(infobits[7] & ROW25_COLUMN7_SERIAL_MODE);
|
||
info->notfound = !!(infobits[8] & ROW25_COLUMN8_PAGE_NOT_FOUND);
|
||
info->pblf = !!(infobits[9] & ROW25_COLUMN9_PAGE_BEING_LOOKED_FOR);
|
||
info->hamming = 0;
|
||
for (column = 0; column <= 7; column++) {
|
||
if (infobits[column] & ROW25_COLUMN0_TO_7_HAMMING_ERROR) {
|
||
info->hamming = 1;
|
||
break;
|
||
}
|
||
}
|
||
if (!info->hamming && !info->notfound)
|
||
t->is_searching[dau_no] = FALSE;
|
||
return 0;
|
||
}
|
||
|
||
/* Reads 1 videotext page buffer of the SAA5246A.
|
||
*
|
||
* req is used both as input and as output. It contains information which part
|
||
* must be read. The videotext page is copied into req->buffer.
|
||
*
|
||
* Return value: 0 if successful
|
||
*/
|
||
static inline int saa5246a_get_page(struct saa5246a_device *t,
|
||
vtx_pagereq_t *req)
|
||
{
|
||
int start, end, size;
|
||
char *buf;
|
||
int err;
|
||
|
||
if (req->pgbuf < 0 || req->pgbuf >= NUM_DAUS ||
|
||
req->start < 0 || req->start > req->end || req->end >= VTX_PAGESIZE)
|
||
return -EINVAL;
|
||
|
||
buf = kmalloc(VTX_PAGESIZE, GFP_KERNEL);
|
||
if (!buf)
|
||
return -ENOMEM;
|
||
|
||
/* Read "normal" part of page */
|
||
err = -EIO;
|
||
|
||
end = min(req->end, VTX_PAGESIZE - 1);
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
req->pgbuf | R8_DO_NOT_CLEAR_MEMORY,
|
||
ROW(req->start), COLUMN(req->start), COMMAND_END))
|
||
goto out;
|
||
if (i2c_getdata(t, end - req->start + 1, buf))
|
||
goto out;
|
||
err = -EFAULT;
|
||
if (copy_to_user(req->buffer, buf, end - req->start + 1))
|
||
goto out;
|
||
|
||
/* Always get the time from buffer 4, since this stupid SAA5246A only
|
||
* updates the currently displayed buffer...
|
||
*/
|
||
if (REQ_CONTAINS_TIME(req)) {
|
||
start = max(req->start, POS_TIME_START);
|
||
end = min(req->end, POS_TIME_END);
|
||
size = end - start + 1;
|
||
err = -EINVAL;
|
||
if (size < 0)
|
||
goto out;
|
||
err = -EIO;
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
R8_ACTIVE_CHAPTER_4 | R8_DO_NOT_CLEAR_MEMORY,
|
||
R9_CURSER_ROW_0, start, COMMAND_END))
|
||
goto out;
|
||
if (i2c_getdata(t, size, buf))
|
||
goto out;
|
||
err = -EFAULT;
|
||
if (copy_to_user(req->buffer + start - req->start, buf, size))
|
||
goto out;
|
||
}
|
||
/* Insert the header from buffer 4 only, if acquisition circuit is still searching for a page */
|
||
if (REQ_CONTAINS_HEADER(req) && t->is_searching[req->pgbuf]) {
|
||
start = max(req->start, POS_HEADER_START);
|
||
end = min(req->end, POS_HEADER_END);
|
||
size = end - start + 1;
|
||
err = -EINVAL;
|
||
if (size < 0)
|
||
goto out;
|
||
err = -EIO;
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R8,
|
||
R8_ACTIVE_CHAPTER_4 | R8_DO_NOT_CLEAR_MEMORY,
|
||
R9_CURSER_ROW_0, start, COMMAND_END))
|
||
goto out;
|
||
if (i2c_getdata(t, end - start + 1, buf))
|
||
goto out;
|
||
err = -EFAULT;
|
||
if (copy_to_user(req->buffer + start - req->start, buf, size))
|
||
goto out;
|
||
}
|
||
err = 0;
|
||
out:
|
||
kfree(buf);
|
||
return err;
|
||
}
|
||
|
||
/* Stops the acquisition circuit given in dau_no. The page buffer associated
|
||
* with this acquisition circuit will no more be updated. The other daus are
|
||
* not affected.
|
||
*
|
||
* Return value: 0 if successful
|
||
*/
|
||
static inline int saa5246a_stop_dau(struct saa5246a_device *t,
|
||
unsigned char dau_no)
|
||
{
|
||
if (dau_no >= NUM_DAUS)
|
||
return -EINVAL;
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R2,
|
||
|
||
R2_IN_R3_SELECT_PAGE_HUNDREDS |
|
||
dau_no << 4 |
|
||
R2_BANK_0 |
|
||
R2_HAMMING_CHECK_OFF,
|
||
|
||
R3_PAGE_HUNDREDS_0 |
|
||
R3_HOLD_PAGE |
|
||
R3_PAGE_HUNDREDS_DO_NOT_CARE,
|
||
|
||
COMMAND_END))
|
||
{
|
||
return -EIO;
|
||
}
|
||
t->is_searching[dau_no] = FALSE;
|
||
return 0;
|
||
}
|
||
|
||
/* Handles ioctls defined in videotext.h
|
||
*
|
||
* Returns 0 if successful
|
||
*/
|
||
static int do_saa5246a_ioctl(struct inode *inode, struct file *file,
|
||
unsigned int cmd, void *arg)
|
||
{
|
||
struct video_device *vd = video_devdata(file);
|
||
struct saa5246a_device *t=vd->priv;
|
||
switch(cmd)
|
||
{
|
||
case VTXIOCGETINFO:
|
||
{
|
||
vtx_info_t *info = arg;
|
||
|
||
info->version_major = MAJOR_VERSION;
|
||
info->version_minor = MINOR_VERSION;
|
||
info->numpages = NUM_DAUS;
|
||
return 0;
|
||
}
|
||
|
||
case VTXIOCCLRPAGE:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
|
||
if (req->pgbuf < 0 || req->pgbuf >= NUM_DAUS)
|
||
return -EINVAL;
|
||
memset(t->pgbuf[req->pgbuf], ' ', sizeof(t->pgbuf[0]));
|
||
return 0;
|
||
}
|
||
|
||
case VTXIOCCLRFOUND:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
|
||
if (req->pgbuf < 0 || req->pgbuf >= NUM_DAUS)
|
||
return -EINVAL;
|
||
return(saa5246a_clear_found_bit(t, req->pgbuf));
|
||
}
|
||
|
||
case VTXIOCPAGEREQ:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
|
||
return(saa5246a_request_page(t, req));
|
||
}
|
||
|
||
case VTXIOCGETSTAT:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
vtx_pageinfo_t info;
|
||
int rval;
|
||
|
||
if ((rval = saa5246a_get_status(t, &info, req->pgbuf)))
|
||
return rval;
|
||
if(copy_to_user(req->buffer, &info,
|
||
sizeof(vtx_pageinfo_t)))
|
||
return -EFAULT;
|
||
return 0;
|
||
}
|
||
|
||
case VTXIOCGETPAGE:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
|
||
return(saa5246a_get_page(t, req));
|
||
}
|
||
|
||
case VTXIOCSTOPDAU:
|
||
{
|
||
vtx_pagereq_t *req = arg;
|
||
|
||
return(saa5246a_stop_dau(t, req->pgbuf));
|
||
}
|
||
|
||
case VTXIOCPUTPAGE:
|
||
case VTXIOCSETDISP:
|
||
case VTXIOCPUTSTAT:
|
||
return 0;
|
||
|
||
case VTXIOCCLRCACHE:
|
||
{
|
||
return 0;
|
||
}
|
||
|
||
case VTXIOCSETVIRT:
|
||
{
|
||
/* I do not know what "virtual mode" means */
|
||
return 0;
|
||
}
|
||
}
|
||
return -EINVAL;
|
||
}
|
||
|
||
/*
|
||
* Translates old vtx IOCTLs to new ones
|
||
*
|
||
* This keeps new kernel versions compatible with old userspace programs.
|
||
*/
|
||
static inline unsigned int vtx_fix_command(unsigned int cmd)
|
||
{
|
||
switch (cmd) {
|
||
case VTXIOCGETINFO_OLD:
|
||
cmd = VTXIOCGETINFO;
|
||
break;
|
||
case VTXIOCCLRPAGE_OLD:
|
||
cmd = VTXIOCCLRPAGE;
|
||
break;
|
||
case VTXIOCCLRFOUND_OLD:
|
||
cmd = VTXIOCCLRFOUND;
|
||
break;
|
||
case VTXIOCPAGEREQ_OLD:
|
||
cmd = VTXIOCPAGEREQ;
|
||
break;
|
||
case VTXIOCGETSTAT_OLD:
|
||
cmd = VTXIOCGETSTAT;
|
||
break;
|
||
case VTXIOCGETPAGE_OLD:
|
||
cmd = VTXIOCGETPAGE;
|
||
break;
|
||
case VTXIOCSTOPDAU_OLD:
|
||
cmd = VTXIOCSTOPDAU;
|
||
break;
|
||
case VTXIOCPUTPAGE_OLD:
|
||
cmd = VTXIOCPUTPAGE;
|
||
break;
|
||
case VTXIOCSETDISP_OLD:
|
||
cmd = VTXIOCSETDISP;
|
||
break;
|
||
case VTXIOCPUTSTAT_OLD:
|
||
cmd = VTXIOCPUTSTAT;
|
||
break;
|
||
case VTXIOCCLRCACHE_OLD:
|
||
cmd = VTXIOCCLRCACHE;
|
||
break;
|
||
case VTXIOCSETVIRT_OLD:
|
||
cmd = VTXIOCSETVIRT;
|
||
break;
|
||
}
|
||
return cmd;
|
||
}
|
||
|
||
/*
|
||
* Handle the locking
|
||
*/
|
||
static int saa5246a_ioctl(struct inode *inode, struct file *file,
|
||
unsigned int cmd, unsigned long arg)
|
||
{
|
||
struct video_device *vd = video_devdata(file);
|
||
struct saa5246a_device *t = vd->priv;
|
||
int err;
|
||
|
||
cmd = vtx_fix_command(cmd);
|
||
down(&t->lock);
|
||
err = video_usercopy(inode, file, cmd, arg, do_saa5246a_ioctl);
|
||
up(&t->lock);
|
||
return err;
|
||
}
|
||
|
||
static int saa5246a_open(struct inode *inode, struct file *file)
|
||
{
|
||
struct video_device *vd = video_devdata(file);
|
||
struct saa5246a_device *t = vd->priv;
|
||
int err;
|
||
|
||
err = video_exclusive_open(inode,file);
|
||
if (err < 0)
|
||
return err;
|
||
|
||
if (t->client==NULL) {
|
||
err = -ENODEV;
|
||
goto fail;
|
||
}
|
||
|
||
if (i2c_senddata(t, SAA5246A_REGISTER_R0,
|
||
|
||
R0_SELECT_R11 |
|
||
R0_PLL_TIME_CONSTANT_LONG |
|
||
R0_ENABLE_nODD_EVEN_OUTPUT |
|
||
R0_ENABLE_HDR_POLL |
|
||
R0_DO_NOT_FORCE_nODD_EVEN_LOW_IF_PICTURE_DISPLAYED |
|
||
R0_NO_FREE_RUN_PLL |
|
||
R0_NO_AUTOMATIC_FASTEXT_PROMPT,
|
||
|
||
R1_NON_INTERLACED_312_312_LINES |
|
||
R1_DEW |
|
||
R1_EXTENDED_PACKET_DISABLE |
|
||
R1_DAUS_ALL_ON |
|
||
R1_8_BITS_NO_PARITY |
|
||
R1_VCS_TO_SCS,
|
||
|
||
COMMAND_END) ||
|
||
i2c_senddata(t, SAA5246A_REGISTER_R4,
|
||
|
||
/* We do not care much for the TV display but nevertheless we
|
||
* need the currently displayed page later because only on that
|
||
* page the time is updated. */
|
||
R4_DISPLAY_PAGE_4,
|
||
|
||
COMMAND_END))
|
||
{
|
||
err = -EIO;
|
||
goto fail;
|
||
}
|
||
|
||
return 0;
|
||
|
||
fail:
|
||
video_exclusive_release(inode,file);
|
||
return err;
|
||
}
|
||
|
||
static int saa5246a_release(struct inode *inode, struct file *file)
|
||
{
|
||
struct video_device *vd = video_devdata(file);
|
||
struct saa5246a_device *t = vd->priv;
|
||
|
||
/* Stop all acquisition circuits. */
|
||
i2c_senddata(t, SAA5246A_REGISTER_R1,
|
||
|
||
R1_INTERLACED_312_AND_HALF_312_AND_HALF_LINES |
|
||
R1_DEW |
|
||
R1_EXTENDED_PACKET_DISABLE |
|
||
R1_DAUS_ALL_OFF |
|
||
R1_8_BITS_NO_PARITY |
|
||
R1_VCS_TO_SCS,
|
||
|
||
COMMAND_END);
|
||
video_exclusive_release(inode,file);
|
||
return 0;
|
||
}
|
||
|
||
static int __init init_saa_5246a (void)
|
||
{
|
||
printk(KERN_INFO
|
||
"SAA5246A (or compatible) Teletext decoder driver version %d.%d\n",
|
||
MAJOR_VERSION, MINOR_VERSION);
|
||
return i2c_add_driver(&i2c_driver_videotext);
|
||
}
|
||
|
||
static void __exit cleanup_saa_5246a (void)
|
||
{
|
||
i2c_del_driver(&i2c_driver_videotext);
|
||
}
|
||
|
||
module_init(init_saa_5246a);
|
||
module_exit(cleanup_saa_5246a);
|
||
|
||
static struct file_operations saa_fops = {
|
||
.owner = THIS_MODULE,
|
||
.open = saa5246a_open,
|
||
.release = saa5246a_release,
|
||
.ioctl = saa5246a_ioctl,
|
||
.llseek = no_llseek,
|
||
};
|
||
|
||
static struct video_device saa_template =
|
||
{
|
||
.owner = THIS_MODULE,
|
||
.name = IF_NAME,
|
||
.type = VID_TYPE_TELETEXT,
|
||
.hardware = VID_HARDWARE_SAA5249,
|
||
.fops = &saa_fops,
|
||
.release = video_device_release,
|
||
.minor = -1,
|
||
};
|