/*
    Sliced vbi autodetection demonstration utility
    Copyright (C) 2004  Hans Verkuil  <hverkuil@xs4all.nl>

    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 <unistd.h>
#include <features.h>		/* Uses _GNU_SOURCE to define getsubopt in stdlib.h */
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <inttypes.h>
#include <getopt.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <errno.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include <math.h>
#include <linux/types.h>
#include <linux/videodev2.h>
#include <linux/ivtv.h>

static void detect(int fh, struct v4l2_sliced_vbi_format *fmt)
{
	struct v4l2_sliced_vbi_data *buf = malloc(fmt->io_size);
        int cnt;

        for (cnt = 0; cnt < 5; cnt++) {
		int size = read(fh, buf, fmt->io_size);
		int i;

		if (size <= 0) {
                        printf("size = %d\n", size);
			break;
                }
                if (cnt == 0)
                        continue;
		for (i = 0; i < size / sizeof(*buf); i++) {
                        int field, line;

                        line = buf[i].line;
                        field = buf[i].field;
                        if (buf[i].id == 0)
                                continue;
                        if (line < 0 || line >= 24) {
                                printf("line %d out of range\n", line);
                                free(buf);
                                return;
                        }
                        fmt->service_lines[field][line] |= buf[i].id;
		}
	}
        free(buf);
}

void v2s(int id)
{
        switch (id) {
                case V4L2_SLICED_TELETEXT_B: printf(" TELETEXT"); break;
                case V4L2_SLICED_CAPTION_525: printf(" CC"); break;
                case V4L2_SLICED_WSS_625: printf(" WSS"); break;
                case V4L2_SLICED_VPS: printf(" VPS"); break;
                default: printf(" UNKNOWN %x", id); break;
        }
}

int main(int argc, char **argv)
{
	char *device = "/dev/vbi0";
	struct v4l2_format vbifmt;
	struct v4l2_sliced_vbi_format vbiresult;
	int fh;
        int f, i, b;

	if (argc == 2)
                device = argv[1];
        fh = open(device, O_RDONLY);

        if (fh == -1) {
                fprintf(stderr, "cannot open %s\n", device);
                return 1;
        }
        memset(&vbiresult, 0, sizeof(vbiresult));
        for (i = 0; i < 16; i++) {
                int l;
                int set = 0;

                memset(&vbifmt, 0, sizeof(vbifmt));
                vbifmt.type = V4L2_BUF_TYPE_SLICED_VBI_CAPTURE;
                for (l = 0; l < 24; l++) {
                        vbifmt.fmt.sliced.service_lines[0][l] = 1 << i;
                        vbifmt.fmt.sliced.service_lines[1][l] = 1 << i;
                }
	        if (ioctl(fh, VIDIOC_S_FMT, &vbifmt) < 0) {
                        if (errno == EINVAL)
                                continue;
                        perror("IVTV_IOC_S_VBI_FMT");
                        exit(-1);
                }
                vbiresult.io_size = vbifmt.fmt.sliced.io_size;
                for (l = 0; l < 24; l++) {
                        set |= vbifmt.fmt.sliced.service_lines[0][l] | 
                               vbifmt.fmt.sliced.service_lines[1][l];
                }
                detect(fh, &vbiresult);
        }
	close(fh);
        for (f = 0; f < 2; f++) {
                printf("Field %d:\n", f);
                for (i = 6; i < 24; i++) {
                        unsigned set = vbiresult.service_lines[f][i];

                        printf("  Line %2d:", i);
                        for (b = 0; b < 16; b++) {
                                if (set & (1 << b)) 
                                        v2s(1 << b);
                        }
                        printf("\n");
                }
        }
	return 0;
}
