1 /*
2  * test.c - Test program for new API
3  *
4  * Copyright (C) 2000 Ralph  Metzler <ralph@convergence.de>
5  *                  & Marcus Metzler <marcus@convergence.de>
6                       for convergence integrated media GmbH
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU Lesser General Public License
10  * as published by the Free Software Foundation; either version 2.1
11  * of the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU Lesser General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
21  *
22  */
23 
24 #include <sys/ioctl.h>
25 #include <stdio.h>
26 #include <stdint.h>
27 #include <sys/types.h>
28 #include <sys/stat.h>
29 #include <fcntl.h>
30 #include <time.h>
31 
32 #include <linux/dvb/dmx.h>
33 #include <linux/dvb/frontend_old.h>
34 #include <linux/dvb/sec.h>
35 #include <linux/dvb/video.h>
36 
37 uint8_t reverse[] = {
38 0x00,0x80,0x40,0xC0,0x20,0xA0,0x60,0xE0,0x10,0x90,0x50,0xD0,0x30,0xB0,0x70,0xF0,
39 0x08,0x88,0x48,0xC8,0x28,0xA8,0x68,0xE8,0x18,0x98,0x58,0xD8,0x38,0xB8,0x78,0xF8,
40 0x04,0x84,0x44,0xC4,0x24,0xA4,0x64,0xE4,0x14,0x94,0x54,0xD4,0x34,0xB4,0x74,0xF4,
41 0x0C,0x8C,0x4C,0xCC,0x2C,0xAC,0x6C,0xEC,0x1C,0x9C,0x5C,0xDC,0x3C,0xBC,0x7C,0xFC,
42 0x02,0x82,0x42,0xC2,0x22,0xA2,0x62,0xE2,0x12,0x92,0x52,0xD2,0x32,0xB2,0x72,0xF2,
43 0x0A,0x8A,0x4A,0xCA,0x2A,0xAA,0x6A,0xEA,0x1A,0x9A,0x5A,0xDA,0x3A,0xBA,0x7A,0xFA,
44 0x06,0x86,0x46,0xC6,0x26,0xA6,0x66,0xE6,0x16,0x96,0x56,0xD6,0x36,0xB6,0x76,0xF6,
45 0x0E,0x8E,0x4E,0xCE,0x2E,0xAE,0x6E,0xEE,0x1E,0x9E,0x5E,0xDE,0x3E,0xBE,0x7E,0xFE,
46 0x01,0x81,0x41,0xC1,0x21,0xA1,0x61,0xE1,0x11,0x91,0x51,0xD1,0x31,0xB1,0x71,0xF1,
47 0x09,0x89,0x49,0xC9,0x29,0xA9,0x69,0xE9,0x19,0x99,0x59,0xD9,0x39,0xB9,0x79,0xF9,
48 0x05,0x85,0x45,0xC5,0x25,0xA5,0x65,0xE5,0x15,0x95,0x55,0xD5,0x35,0xB5,0x75,0xF5,
49 0x0D,0x8D,0x4D,0xCD,0x2D,0xAD,0x6D,0xED,0x1D,0x9D,0x5D,0xDD,0x3D,0xBD,0x7D,0xFD,
50 0x03,0x83,0x43,0xC3,0x23,0xA3,0x63,0xE3,0x13,0x93,0x53,0xD3,0x33,0xB3,0x73,0xF3,
51 0x0B,0x8B,0x4B,0xCB,0x2B,0xAB,0x6B,0xEB,0x1B,0x9B,0x5B,0xDB,0x3B,0xBB,0x7B,0xFB,
52 0x07,0x87,0x47,0xC7,0x27,0xA7,0x67,0xE7,0x17,0x97,0x57,0xD7,0x37,0xB7,0x77,0xF7,
53 0x0F,0x8F,0x4F,0xCF,0x2F,0xAF,0x6F,0xEF,0x1F,0x9F,0x5F,0xDF,0x3F,0xBF,0x7F,0xFF
54 };
55 
t2a(uint8_t c)56 inline t2a(uint8_t c)
57 {
58   c=reverse[c]&0x7f;
59   if (c<0x20)
60     c=0x20;
61 
62   return c;
63 }
64 
testpesfilter(void)65 void testpesfilter(void)
66 {
67         uint8_t buf[4096], id;
68 	int i,j;
69 	int len;
70 	int fd=open("/dev/ost/demux1", O_RDWR);
71 	struct dmx_pes_filter_params pesFilterParams;
72 
73 	pesFilterParams.input = DMX_IN_FRONTEND;
74 	pesFilterParams.output = DMX_OUT_TS_TAP;
75 	pesFilterParams.pes_type = DMX_PES_TELETEXT;
76 	pesFilterParams.flags = DMX_IMMEDIATE_START;
77 
78 	pesFilterParams.pid = 0x2c ;
79 	if (ioctl(fd, DMX_SET_PES_FILTER, &pesFilterParams) < 0) {
80 	        printf("Could not set PES filter\n");
81 		close(fd);
82 		return;
83 	}
84 	ioctl(fd, DMX_STOP, 0);
85 /*
86 	pesFilterParams.pid = 54;
87 	if (ioctl(fd, DMX_SET_PES_FILTER, &pesFilterParams) < 0) {
88 	        printf("Could not set PES filter\n");
89 		close(fd);
90 		return;
91 	}
92 	ioctl(fd, DMX_STOP, 0);
93 
94 	pesFilterParams.pid = 55;
95 	if (ioctl(fd, DMX_SET_PES_FILTER, &pesFilterParams) < 0) {
96 	        printf("Could not set PES filter\n");
97 		close(fd);
98 		return;
99 	}
100 */
101 	while(1) {
102 		len=read(fd, buf, 4096);
103 		if (len>0) write(1, buf, len);
104 	}
105 
106 	do {
107 	        read(fd, buf, 4);
108 		if (htonl(*(uint32_t *)buf)!=0x00001bd)
109 		        continue;
110 		read(fd, buf+4, 2);
111 		len=(buf[4]<<8)|buf[5];
112 	        read(fd, buf+6, len);
113 		fprintf(stderr,"read %d bytes PES\n", len);
114 		write (1, buf, len+6);
115 
116 		id=buf[45];
117 		fprintf(stderr,"id=%02x\n", id);
118 
119 		for (i=0; i<(len+6-46)/46; i++) {
120 		  for (j=6; j<46; j++) {
121 		    fprintf(stderr,"%c", t2a(buf[i*46+46+j]));
122 		  }
123 		    fprintf(stderr,"\n");
124 		}
125 
126 	} while (1);
127 
128 
129 	/*
130 	pesFilterParams.pid = 55;
131 	pesFilterParams.input = DMX_IN_FRONTEND;
132 	pesFilterParams.output = DMX_OUT_DECODER;
133 	pesFilterParams.pes_type = DMX_PES_TELETEXT;
134 	pesFilterParams.flags = DMX_IMMEDIATE_START;
135 
136 	ioctl(fd, DMX_SET_PES_FILTER, &pesFilterParams);
137 	close(fd);
138 	*/
139 }
140 
141 
senf()142 senf()
143 {
144   int ret;
145   int len;
146   struct secCommand scmd;
147   struct secCmdSequence scmds;
148   struct dmx_pes_filter_params pesFilterParams;
149   struct dmx_sct_filter_params secFilterParams;
150   FrontendParameters frp;
151   uint8_t buf[4096];
152 
153   int vout=open("qv", O_RDWR|O_CREAT);
154   int aout=open("qa", O_RDWR|O_CREAT);
155 
156   int fd_video=open("/dev/ost/video", O_RDWR);
157   int fd_audio=open("/dev/ost/audio", O_RDWR);
158   int fd_tt=open("/dev/ost/demux", O_RDWR);
159   int fd_frontend=open("/dev/ost/frontend", O_RDWR);
160   int fd_sec=open("/dev/ost/sec", O_RDWR);
161   int fd_demux=open("/dev/ost/demux", O_RDWR|O_NONBLOCK);
162   int fd_demux2=open("/dev/ost/demux", O_RDWR|O_NONBLOCK);
163   int fd_section=open("/dev/ost/demux", O_RDWR);
164   int fd_section2=open("/dev/ost/demux", O_RDWR);
165 
166   printf("%d\n",fd_section);
167 
168   //if (ioctl(fd_sec, SEC_SET_VOLTAGE, SEC_VOLTAGE_13) < 0)  return;
169   //if (ioctl(fd_sec, SEC_SET_TONE, SEC_TONE_ON) < 0)  return;
170 #if 0
171   scmd.type=0;
172   scmd.u.diseqc.addr=0x10;
173   scmd.u.diseqc.cmd=0x38;
174   scmd.u.diseqc.numParams=1;
175   scmd.u.diseqc.params[0]=0xf0;
176 
177   scmds.voltage=SEC_VOLTAGE_13;
178   scmds.miniCommand=SEC_MINI_NONE;
179   scmds.continuousTone=SEC_TONE_ON;
180   scmds.numCommands=1;
181   scmds.commands=&scmd;
182   if (ioctl(fd_sec, SEC_SEND_SEQUENCE, &scmds) < 0)  return;
183   printf("SEC OK\n");
184 
185   frp.Frequency=(12666000-10600000);
186   frp.u.qpsk.SymbolRate=22000000;
187   frp.u.qpsk.FEC_inner=FEC_AUTO;
188 
189   if (ioctl(fd_frontend, FE_SET_FRONTEND, &frp) < 0)  return;
190   printf("QPSK OK\n");
191 #endif
192 
193 #if 0
194   ret=ioctl(fd_demux2, DMX_SET_BUFFER_SIZE, 64*1024);
195     if (ret<0)
196       perror("DMX_SET_BUFFER_SIZE\n");
197   printf("Audio filter size OK\n");
198   pesFilterParams.pid = 0x60;
199   pesFilterParams.input = DMX_IN_FRONTEND;
200   pesFilterParams.output = DMX_OUT_DECODER;
201   pesFilterParams.pes_type = DMX_PES_AUDIO;
202   pesFilterParams.flags = DMX_IMMEDIATE_START;
203 
204   if (ioctl(fd_demux2, DMX_SET_PES_FILTER, &pesFilterParams) < 0)   return(1);
205   printf("Audio filter OK\n");
206 
207   if (ioctl(fd_demux, DMX_SET_BUFFER_SIZE, 64*1024) < 0)  return(1);
208   pesFilterParams.pid = 0xa2;
209   pesFilterParams.input = DMX_IN_FRONTEND;
210   pesFilterParams.output = DMX_OUT_DECODER;
211   pesFilterParams.pes_type = DMX_PES_VIDEO;
212   pesFilterParams.flags = DMX_IMMEDIATE_START;
213   if (ioctl(fd_demux, DMX_SET_PES_FILTER, &pesFilterParams) < 0)  return(1);
214   printf("Video filter OK\n");
215 #endif
216   /*
217   pesFilterParams.pid = 56;
218   pesFilterParams.input = DMX_IN_FRONTEND;
219   pesFilterParams.output = DMX_OUT_DECODER;
220   pesFilterParams.pes_type = DMX_PES_TELETEXT;
221   pesFilterParams.flags = DMX_IMMEDIATE_START;
222   if (ioctl(fd_tt, DMX_SET_PES_FILTER, &pesFilterParams) < 0)  return(1);
223   printf("TT filter OK\n");
224   */
225   //while (1);
226   /* {
227     len=read(fd_demux, buf, 4096);
228     if (len>0) write (vout, buf, len);
229     len=read(fd_demux2, buf, 4096);
230     if (len>0) write (aout, buf, len);
231     }*/
232 
233 
234   memset(&secFilterParams.filter.filter, 0, DMX_FILTER_SIZE);
235   memset(&secFilterParams.filter.mask, 0, DMX_FILTER_SIZE);
236   secFilterParams.filter.filter[0]=0x00;
237   secFilterParams.filter.mask[0]=0x00;
238   secFilterParams.timeout=5000;
239   secFilterParams.flags=DMX_IMMEDIATE_START;
240 
241   /*
242   // this one should timeout after 2 seconds
243   secFilterParams.pid=0xa4;
244   if (ioctl(fd_section, DMX_SET_FILTER, &secFilterParams) < 0)  return;
245   len=read(fd_section, buf, 4096);
246   */
247 
248   /*
249   {
250     int32_t snr, str;
251     ioctl(fd_frontend, FE_READ_SNR, &snr);
252     ioctl(fd_frontend, FE_READ_SIGNAL_STRENGTH, &str);
253 
254     printf("snr=%d, str=%d\n", snr, str);
255   }
256   */
257 
258   secFilterParams.pid=0x11;
259   //printf("section filter\n");
260   if (ioctl(fd_section, DMX_SET_FILTER, &secFilterParams) < 0)  return;
261   //if (ioctl(fd_section2, DMX_SET_FILTER, &secFilterParams) < 0)  return;
262   //close(fd_section2);
263   //while (1)
264 {
265     len=read(fd_section, buf, 4096);
266     if (len>0) write(1, buf, len);
267     //printf("read section with length %d\n", len);
268     //if (len>0) write(1,buf,len);
269     //len=read(fd_section2, buf, 4096);
270     //if (len>0) write(1,buf,len);
271     //printf("read section with length %d\n", len);
272   }
273 
274 }
275 
main()276 main()
277 {
278 	//senf();
279   testpesfilter();
280 }
281