?? saa5249.c
字號:
static int virtual_mode = FALSE; switch(cmd) { case VTXIOCGETINFO: { vtx_info_t info; info.version_major = VTX_VER_MAJ; info.version_minor = VTX_VER_MIN; info.numpages = NUM_DAUS; /*info.cct_type = CCT_TYPE;*/ if(copy_to_user((void*)arg, &info, sizeof(vtx_info_t))) return -EFAULT; return 0; } case VTXIOCCLRPAGE: { vtx_pagereq_t req; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (req.pgbuf < 0 || req.pgbuf >= NUM_DAUS) return -EINVAL; memset(t->vdau[req.pgbuf].pgbuf, ' ', sizeof(t->vdau[0].pgbuf)); t->vdau[req.pgbuf].clrfound = TRUE; return 0; } case VTXIOCCLRFOUND: { vtx_pagereq_t req; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (req.pgbuf < 0 || req.pgbuf >= NUM_DAUS) return -EINVAL; t->vdau[req.pgbuf].clrfound = TRUE; return 0; } case VTXIOCPAGEREQ: { vtx_pagereq_t req; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (!(req.pagemask & PGMASK_PAGE)) req.page = 0; if (!(req.pagemask & PGMASK_HOUR)) req.hour = 0; if (!(req.pagemask & PGMASK_MINUTE)) req.minute = 0; if (req.page < 0 || req.page > 0x8ff) /* 7FF ?? */ return -EINVAL; req.page &= 0x7ff; if (req.hour < 0 || req.hour > 0x3f || req.minute < 0 || req.minute > 0x7f || req.pagemask < 0 || req.pagemask >= PGMASK_MAX || req.pgbuf < 0 || req.pgbuf >= NUM_DAUS) return -EINVAL; t->vdau[req.pgbuf].sregs[0] = (req.pagemask & PG_HUND ? 0x10 : 0) | (req.page / 0x100); t->vdau[req.pgbuf].sregs[1] = (req.pagemask & PG_TEN ? 0x10 : 0) | ((req.page / 0x10) & 0xf); t->vdau[req.pgbuf].sregs[2] = (req.pagemask & PG_UNIT ? 0x10 : 0) | (req.page & 0xf); t->vdau[req.pgbuf].sregs[3] = (req.pagemask & HR_TEN ? 0x10 : 0) | (req.hour / 0x10); t->vdau[req.pgbuf].sregs[4] = (req.pagemask & HR_UNIT ? 0x10 : 0) | (req.hour & 0xf); t->vdau[req.pgbuf].sregs[5] = (req.pagemask & MIN_TEN ? 0x10 : 0) | (req.minute / 0x10); t->vdau[req.pgbuf].sregs[6] = (req.pagemask & MIN_UNIT ? 0x10 : 0) | (req.minute & 0xf); t->vdau[req.pgbuf].stopped = FALSE; t->vdau[req.pgbuf].clrfound = TRUE; t->is_searching[req.pgbuf] = TRUE; return 0; } case VTXIOCGETSTAT: { vtx_pagereq_t req; u8 infobits[10]; vtx_pageinfo_t info; int a; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (req.pgbuf < 0 || req.pgbuf >= NUM_DAUS) return -EINVAL; if (!t->vdau[req.pgbuf].stopped) { if (i2c_senddata(t, 2, 0, -1) || i2c_sendbuf(t, 3, sizeof(t->vdau[0].sregs), t->vdau[req.pgbuf].sregs) || i2c_senddata(t, 8, 0, 25, 0, ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ', -1) || i2c_senddata(t, 2, 0, t->vdau[req.pgbuf].sregs[0] | 8, -1) || i2c_senddata(t, 8, 0, 25, 0, -1)) return -EIO; jdelay(PAGE_WAIT); if (i2c_getdata(t, 10, infobits)) return -EIO; if (!(infobits[8] & 0x10) && !(infobits[7] & 0xf0) && /* check FOUND-bit */ (memcmp(infobits, t->vdau[req.pgbuf].laststat, sizeof(infobits)) || time_after_eq(jiffies, t->vdau[req.pgbuf].expire))) { /* check if new page arrived */ if (i2c_senddata(t, 8, 0, 0, 0, -1) || i2c_getdata(t, VTX_PAGESIZE, t->vdau[req.pgbuf].pgbuf)) return -EIO; t->vdau[req.pgbuf].expire = jiffies + PGBUF_EXPIRE; memset(t->vdau[req.pgbuf].pgbuf + VTX_PAGESIZE, ' ', VTX_VIRTUALSIZE - VTX_PAGESIZE); if (t->virtual_mode) { /* Packet X/24 */ if (i2c_senddata(t, 8, 0, 0x20, 0, -1) || i2c_getdata(t, 40, t->vdau[req.pgbuf].pgbuf + VTX_PAGESIZE + 20 * 40)) return -EIO; /* Packet X/27/0 */ if (i2c_senddata(t, 8, 0, 0x21, 0, -1) || i2c_getdata(t, 40, t->vdau[req.pgbuf].pgbuf + VTX_PAGESIZE + 16 * 40)) return -EIO; /* Packet 8/30/0...8/30/15 * FIXME: AFAIK, the 5249 does hamming-decoding for some bytes in packet 8/30, * so we should undo this here. */ if (i2c_senddata(t, 8, 0, 0x22, 0, -1) || i2c_getdata(t, 40, t->vdau[req.pgbuf].pgbuf + VTX_PAGESIZE + 23 * 40)) return -EIO; } t->vdau[req.pgbuf].clrfound = FALSE; memcpy(t->vdau[req.pgbuf].laststat, infobits, sizeof(infobits)); } else { memcpy(infobits, t->vdau[req.pgbuf].laststat, sizeof(infobits)); } } else { memcpy(infobits, t->vdau[req.pgbuf].laststat, sizeof(infobits)); } info.pagenum = ((infobits[8] << 8) & 0x700) | ((infobits[1] << 4) & 0xf0) | (infobits[0] & 0x0f); if (info.pagenum < 0x100) info.pagenum += 0x800; info.hour = ((infobits[5] << 4) & 0x30) | (infobits[4] & 0x0f); info.minute = ((infobits[3] << 4) & 0x70) | (infobits[2] & 0x0f); info.charset = ((infobits[7] >> 1) & 7); info.delete = !!(infobits[3] & 8); info.headline = !!(infobits[5] & 4); info.subtitle = !!(infobits[5] & 8); info.supp_header = !!(infobits[6] & 1); info.update = !!(infobits[6] & 2); info.inter_seq = !!(infobits[6] & 4); info.dis_disp = !!(infobits[6] & 8); info.serial = !!(infobits[7] & 1); info.notfound = !!(infobits[8] & 0x10); info.pblf = !!(infobits[9] & 0x20); info.hamming = 0; for (a = 0; a <= 7; a++) { if (infobits[a] & 0xf0) { info.hamming = 1; break; } } if (t->vdau[req.pgbuf].clrfound) info.notfound = 1; if(copy_to_user(req.buffer, &info, sizeof(vtx_pageinfo_t))) return -EFAULT; if (!info.hamming && !info.notfound) { t->is_searching[req.pgbuf] = FALSE; } return 0; } case VTXIOCGETPAGE: { vtx_pagereq_t req; int start, end; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (req.pgbuf < 0 || req.pgbuf >= NUM_DAUS || req.start < 0 || req.start > req.end || req.end >= (virtual_mode ? VTX_VIRTUALSIZE : VTX_PAGESIZE)) return -EINVAL; if(copy_to_user(req.buffer, &t->vdau[req.pgbuf].pgbuf[req.start], req.end - req.start + 1)) return -EFAULT; /* * Always read the time directly from SAA5249 */ if (req.start <= 39 && req.end >= 32) { int len; char buf[16]; start = MAX(req.start, 32); end = MIN(req.end, 39); len=end-start+1; if (i2c_senddata(t, 8, 0, 0, start, -1) || i2c_getdata(t, len, buf)) return -EIO; if(copy_to_user(req.buffer+start-req.start, buf, len)) return -EFAULT; } /* Insert the current header if DAU is still searching for a page */ if (req.start <= 31 && req.end >= 7 && t->is_searching[req.pgbuf]) { char buf[32]; int len; start = MAX(req.start, 7); end = MIN(req.end, 31); len=end-start+1; if (i2c_senddata(t, 8, 0, 0, start, -1) || i2c_getdata(t, len, buf)) return -EIO; if(copy_to_user(req.buffer+start-req.start, buf, len)) return -EFAULT; } return 0; } case VTXIOCSTOPDAU: { vtx_pagereq_t req; if(copy_from_user(&req, (void*)arg, sizeof(vtx_pagereq_t))) return -EFAULT; if (req.pgbuf < 0 || req.pgbuf >= NUM_DAUS) return -EINVAL; t->vdau[req.pgbuf].stopped = TRUE; t->is_searching[req.pgbuf] = FALSE; return 0; } case VTXIOCPUTPAGE: case VTXIOCSETDISP: case VTXIOCPUTSTAT: return 0; case VTXIOCCLRCACHE: { if (i2c_senddata(t, 0, NUM_DAUS, 0, 8, -1) || i2c_senddata(t, 11, ' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ', ' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ', -1)) return -EIO; if (i2c_senddata(t, 3, 0x20, -1)) return -EIO; jdelay(10 * CLEAR_DELAY); /* I have no idea how long we have to wait here */ return 0; } case VTXIOCSETVIRT: { /* The SAA5249 has virtual-row reception turned on always */ t->virtual_mode = (int)arg; return 0; } } return -EINVAL;}/* * Handle the locking */ static int saa5249_ioctl(struct video_device *vd, unsigned int cmd, void *arg) { struct saa5249_device *t=vd->priv; int err; down(&t->lock); err = do_saa5249_ioctl(t, cmd, arg); up(&t->lock); return err;}static int saa5249_open(struct video_device *vd, int nb) { struct saa5249_device *t=vd->priv; int pgbuf; if (t->client==NULL) return -ENODEV; if (i2c_senddata(t, 0, 0, -1) || /* Select R11 */ /* Turn off parity checks (we do this ourselves) */ i2c_senddata(t, 1, disp_modes[t->disp_mode][0], 0, -1) || /* Display TV-picture, no virtual rows */ i2c_senddata(t, 4, NUM_DAUS, disp_modes[t->disp_mode][1], disp_modes[t->disp_mode][2], 7, -1)) /* Set display to page 4 */ { return -EIO; } for (pgbuf = 0; pgbuf < NUM_DAUS; pgbuf++) { memset(t->vdau[pgbuf].pgbuf, ' ', sizeof(t->vdau[0].pgbuf)); memset(t->vdau[pgbuf].sregs, 0, sizeof(t->vdau[0].sregs)); memset(t->vdau[pgbuf].laststat, 0, sizeof(t->vdau[0].laststat)); t->vdau[pgbuf].expire = 0; t->vdau[pgbuf].clrfound = TRUE; t->vdau[pgbuf].stopped = TRUE; t->is_searching[pgbuf] = FALSE; } t->virtual_mode=FALSE; return 0;}static void saa5249_release(struct video_device *vd) { struct saa5249_device *t=vd->priv; i2c_senddata(t, 1, 0x20, -1); /* Turn off CCT */ i2c_senddata(t, 5, 3, 3, -1); /* Turn off TV-display */ return;}static long saa5249_write(struct video_device *v, const char *buf, unsigned long l, int nb){ return -EINVAL;}static int __init init_saa_5249 (void){ printk(KERN_INFO "SAA5249 driver (" IF_NAME " interface) for VideoText version %d.%d\n", VTX_VER_MAJ, VTX_VER_MIN); return i2c_add_driver(&i2c_driver_videotext);}static void __exit cleanup_saa_5249 (void) { i2c_del_driver(&i2c_driver_videotext);}module_init(init_saa_5249);module_exit(cleanup_saa_5249);static struct video_device saa_template ={ owner: THIS_MODULE, name: IF_NAME, type: VID_TYPE_TELETEXT, /*| VID_TYPE_TUNER ?? */ hardware: VID_HARDWARE_SAA5249, open: saa5249_open, close: saa5249_release, write: saa5249_write, ioctl: saa5249_ioctl,};MODULE_LICENSE("GPL");
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -