1 | #include "globals.h"
|
---|
2 | extern struct s_reader *reader;
|
---|
3 |
|
---|
4 | #define CWS_NETMSGSIZE 272
|
---|
5 |
|
---|
6 | #define CWS_FIRSTCMDNO 0xe0
|
---|
7 | typedef enum
|
---|
8 | {
|
---|
9 | MSG_CLIENT_2_SERVER_LOGIN = CWS_FIRSTCMDNO,
|
---|
10 | MSG_CLIENT_2_SERVER_LOGIN_ACK,
|
---|
11 | MSG_CLIENT_2_SERVER_LOGIN_NAK,
|
---|
12 | MSG_CARD_DATA_REQ,
|
---|
13 | MSG_CARD_DATA,
|
---|
14 | MSG_SERVER_2_CLIENT_NAME,
|
---|
15 | MSG_SERVER_2_CLIENT_NAME_ACK,
|
---|
16 | MSG_SERVER_2_CLIENT_NAME_NAK,
|
---|
17 | MSG_SERVER_2_CLIENT_LOGIN,
|
---|
18 | MSG_SERVER_2_CLIENT_LOGIN_ACK,
|
---|
19 | MSG_SERVER_2_CLIENT_LOGIN_NAK,
|
---|
20 | MSG_ADMIN,
|
---|
21 | MSG_ADMIN_ACK,
|
---|
22 | MSG_ADMIN_LOGIN,
|
---|
23 | MSG_ADMIN_LOGIN_ACK,
|
---|
24 | MSG_ADMIN_LOGIN_NAK,
|
---|
25 | MSG_ADMIN_COMMAND,
|
---|
26 | MSG_ADMIN_COMMAND_ACK,
|
---|
27 | MSG_ADMIN_COMMAND_NAK,
|
---|
28 | MSG_KEEPALIVE = CWS_FIRSTCMDNO + 0x1d,
|
---|
29 | MSG_SERVER_2_CLIENT_OSD = 0xd1,
|
---|
30 | MSG_SERVER_2_CLIENT_ALLCARDS = 0xd2,
|
---|
31 | MSG_SERVER_2_CLIENT_ADDCARD = 0xd3,
|
---|
32 | MSG_SERVER_2_CLIENT_REMOVECARD = 0xd4,
|
---|
33 | MSG_SERVER_2_CLIENT_CHANGE_KEY = 0xd5,
|
---|
34 | MSG_SERVER_2_CLIENT_GET_VERSION = 0xd6,
|
---|
35 | MSG_SERVER_2_CLIENT_ADDSID = 0xd7,
|
---|
36 | MSG_CLIENT_2_SERVER_CARDDISCOVER = 0xd8
|
---|
37 | } net_msg_type_t;
|
---|
38 |
|
---|
39 | typedef enum
|
---|
40 | {
|
---|
41 | COMMTYPE_CLIENT,
|
---|
42 | COMMTYPE_SERVER
|
---|
43 | } comm_type_t;
|
---|
44 |
|
---|
45 |
|
---|
46 | typedef struct custom_data
|
---|
47 | {
|
---|
48 | unsigned short sid;
|
---|
49 | unsigned short caid;
|
---|
50 | int provid;
|
---|
51 | uchar x;
|
---|
52 | } custom_data_t;
|
---|
53 |
|
---|
54 | #define REQ_SIZE 2
|
---|
55 | static uchar *req=0;
|
---|
56 | static int ncd_proto=NCD_AUTO;
|
---|
57 |
|
---|
58 | static int network_message_send(int handle, uint16 *netMsgId, uint8 *buffer,
|
---|
59 | int len, uint8 *deskey, comm_type_t commType,
|
---|
60 | ushort sid, custom_data_t *cd)
|
---|
61 | {
|
---|
62 | uint8 netbuf[CWS_NETMSGSIZE];
|
---|
63 | int head_size;
|
---|
64 | head_size = (ncd_proto==NCD_524)?8:12;
|
---|
65 |
|
---|
66 | if (len < 3 || len + head_size > CWS_NETMSGSIZE || handle < 0)
|
---|
67 | return -1;
|
---|
68 | buffer[1] = (buffer[1] & 0xf0) | (((len - 3) >> 8) & 0x0f);
|
---|
69 | buffer[2] = (len - 3) & 0xff;
|
---|
70 | memcpy(netbuf+head_size, buffer, len);
|
---|
71 | len += head_size;
|
---|
72 | if (netMsgId) {
|
---|
73 | switch(commType)
|
---|
74 | {
|
---|
75 | case COMMTYPE_CLIENT:
|
---|
76 | (*netMsgId)++;
|
---|
77 | break;
|
---|
78 | case COMMTYPE_SERVER:
|
---|
79 | if( *netMsgId == 0xFFFE ) *netMsgId = 0; // ??? 0xFFFF ?
|
---|
80 | break;
|
---|
81 | }
|
---|
82 | netbuf[2] = (*netMsgId) >> 8;
|
---|
83 | netbuf[3] = (*netMsgId) & 0xff;
|
---|
84 | }
|
---|
85 | else
|
---|
86 | netbuf[2] = netbuf[3] = 0;
|
---|
87 | memset(netbuf+4, 0, (ncd_proto==NCD_524)?4:8);
|
---|
88 | if( sid ) {
|
---|
89 | netbuf[(ncd_proto==NCD_524)?6:4] = (uchar)(sid>>8); //sid
|
---|
90 | netbuf[(ncd_proto==NCD_524)?7:5] = (uchar)(sid);
|
---|
91 | }
|
---|
92 | if ((!ncd_proto==NCD_524) && (buffer[0] >= 0xd1) && (buffer[0]<= 0xd8)) { // extended proto for mg
|
---|
93 | cs_debug("newcamd: extended: msg");
|
---|
94 | if (cd) {
|
---|
95 | cs_debug("newcamd: extended: has cd");
|
---|
96 | netbuf[4] = cd->sid >> 8;
|
---|
97 | netbuf[5] = cd->sid & 0xff;
|
---|
98 | netbuf[6] = cd->caid >> 8;
|
---|
99 | netbuf[7] = cd->caid & 0xff;
|
---|
100 | netbuf[8] = (cd->provid >> 16) & 0xFF;
|
---|
101 | netbuf[9] = (cd->provid >> 8) & 0xff;
|
---|
102 | netbuf[10] = cd->provid & 0xff;
|
---|
103 | }
|
---|
104 | }
|
---|
105 | netbuf[0] = (len - 2) >> 8;
|
---|
106 | netbuf[1] = (len - 2) & 0xff;
|
---|
107 | cs_ddump(netbuf, len, "send %d bytes to %s", len, remote_txt());
|
---|
108 | if ((len = des_encrypt(netbuf, len, deskey)) < 0)
|
---|
109 | return -1;
|
---|
110 | netbuf[0] = (len - 2) >> 8;
|
---|
111 | netbuf[1] = (len - 2) & 0xff;
|
---|
112 | return send(handle, netbuf, len, 0);
|
---|
113 | }
|
---|
114 |
|
---|
115 | static int network_message_receive(int handle, uint16 *netMsgId, uint8 *buffer,
|
---|
116 | uint8 *deskey, comm_type_t commType)
|
---|
117 | {
|
---|
118 | int len, ncd_off, msgid;
|
---|
119 | uint8 netbuf[CWS_NETMSGSIZE];
|
---|
120 | int returnLen;
|
---|
121 |
|
---|
122 | if (!buffer || handle < 0)
|
---|
123 | return -1;
|
---|
124 | len = recv(handle, netbuf, 2, 0);
|
---|
125 | cs_debug("nmr(): len=%d, errno=%d", len, (len==-1)?errno:0);
|
---|
126 | if (!len) {
|
---|
127 | cs_debug("nmr: 1 return 0");
|
---|
128 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
129 | return 0;
|
---|
130 | }
|
---|
131 | if (len != 2) {
|
---|
132 | cs_debug("nmr: len!=2");
|
---|
133 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
134 | return -1;
|
---|
135 | }
|
---|
136 | if (((netbuf[0] << 8) | netbuf[1]) > CWS_NETMSGSIZE - 2) {
|
---|
137 | cs_debug("nmr: 1 return -1");
|
---|
138 | return -1;
|
---|
139 | }
|
---|
140 |
|
---|
141 | len = recv(handle, netbuf+2, (netbuf[0] << 8) | netbuf[1], 0);
|
---|
142 | if (!len) {
|
---|
143 | cs_debug("nmr: 2 return 0");
|
---|
144 | return 0;
|
---|
145 | }
|
---|
146 | if (len != ((netbuf[0] << 8) | netbuf[1])) {
|
---|
147 | cs_debug("nmr: 2 return -1");
|
---|
148 | return -1;
|
---|
149 | }
|
---|
150 | len += 2;
|
---|
151 | if ((len = des_decrypt(netbuf, len, deskey)) < 11 ) { // 15(newcamd525) or 11 ???
|
---|
152 | cs_debug("nmr: can't decrypt, invalid des key?");
|
---|
153 | cs_sleepms(2000);
|
---|
154 | return -1;
|
---|
155 | }
|
---|
156 | //cs_ddump(netbuf, len, "nmr: decrypted data, len=%d", len);
|
---|
157 | msgid = (netbuf[2] << 8) | netbuf[3];
|
---|
158 |
|
---|
159 | if( ncd_proto==NCD_AUTO ) {
|
---|
160 | // auto detect
|
---|
161 | int l5 = (((netbuf[13] & 0x0f) << 8) | netbuf[14]) + 3;
|
---|
162 | int l4 = (((netbuf[9] & 0x0f) << 8) | netbuf[10]) + 3;
|
---|
163 |
|
---|
164 | if( (l5<=len-12) && ((netbuf[12]&0xF0)==0xE0 || (netbuf[12]&0xF0)==0x80) )
|
---|
165 | ncd_proto = NCD_525;
|
---|
166 | else if( (l4<=len-8) && ((netbuf[8]&0xF0)==0xE0 || (netbuf[9]&0xF0)==0x80) )
|
---|
167 | ncd_proto = NCD_524;
|
---|
168 | else {
|
---|
169 | cs_debug("nmr: 4 return -1");
|
---|
170 | return -1;
|
---|
171 | }
|
---|
172 |
|
---|
173 | cs_debug("nmr: autodetect: newcamd52%d used", (ncd_proto==NCD_525)?5:4);
|
---|
174 | }
|
---|
175 |
|
---|
176 | ncd_off=(ncd_proto==NCD_525)?4:0;
|
---|
177 |
|
---|
178 | returnLen = (((netbuf[9+ncd_off] & 0x0f) << 8) | netbuf[10+ncd_off]) + 3;
|
---|
179 | if ( returnLen > (len-(8+ncd_off)) ) {
|
---|
180 | cs_debug("nmr: 4 return -1");
|
---|
181 | return -1;
|
---|
182 | }
|
---|
183 |
|
---|
184 | // cs_ddump(netbuf, len, "nmr: decrypted data");
|
---|
185 | if (netMsgId)
|
---|
186 | {
|
---|
187 | switch (commType)
|
---|
188 | {
|
---|
189 | case COMMTYPE_SERVER:
|
---|
190 | *netMsgId = msgid;
|
---|
191 | break;
|
---|
192 |
|
---|
193 | case COMMTYPE_CLIENT:
|
---|
194 | //if (*netMsgId != ((netbuf[2] << 8) | netbuf[3])) {
|
---|
195 | cs_debug("nmr: netMsgId=%d, from server=%d, ", *netMsgId, msgid );
|
---|
196 | //return -2;
|
---|
197 | //}
|
---|
198 | break;
|
---|
199 |
|
---|
200 | default:
|
---|
201 | cs_debug("nmr: 5 return -1");
|
---|
202 | return -1;
|
---|
203 | break;
|
---|
204 | }
|
---|
205 | }
|
---|
206 | switch(commType)
|
---|
207 | {
|
---|
208 | case COMMTYPE_SERVER:
|
---|
209 | buffer[0]=(ncd_proto==NCD_525)?netbuf[4]:netbuf[6]; // sid
|
---|
210 | buffer[1]=(ncd_proto==NCD_525)?netbuf[5]:netbuf[7];
|
---|
211 | break;
|
---|
212 | case COMMTYPE_CLIENT:
|
---|
213 | buffer[0]=netbuf[2]; // msgid
|
---|
214 | buffer[1]=netbuf[3];
|
---|
215 | break;
|
---|
216 | }
|
---|
217 |
|
---|
218 | memcpy(buffer+2, netbuf+(8+ncd_off), returnLen);
|
---|
219 | return returnLen+2;
|
---|
220 | }
|
---|
221 |
|
---|
222 | static void network_cmd_no_data_send(int handle, uint16 *netMsgId,
|
---|
223 | net_msg_type_t cmd, uint8 *deskey,
|
---|
224 | comm_type_t commType)
|
---|
225 | {
|
---|
226 | uint8 buffer[CWS_NETMSGSIZE];
|
---|
227 |
|
---|
228 | buffer[0] = cmd; buffer[1] = 0;
|
---|
229 | network_message_send(handle, netMsgId, buffer, 3, deskey, commType, 0, NULL);
|
---|
230 | }
|
---|
231 |
|
---|
232 | static int network_cmd_no_data_receive(int handle, uint16 *netMsgId,
|
---|
233 | uint8 *deskey, comm_type_t commType)
|
---|
234 | {
|
---|
235 | uint8 buffer[CWS_NETMSGSIZE];
|
---|
236 |
|
---|
237 | if (network_message_receive(handle, netMsgId, buffer, deskey, commType) != 3+2)
|
---|
238 | return -1;
|
---|
239 | return buffer[2];
|
---|
240 | }
|
---|
241 |
|
---|
242 | void newcamd_reply_ka()
|
---|
243 | {
|
---|
244 | if(!client[cs_idx].udp_fd)
|
---|
245 | {
|
---|
246 | cs_debug("invalid client fd=%d", client[cs_idx].udp_fd);
|
---|
247 | return;
|
---|
248 | }
|
---|
249 |
|
---|
250 | cs_debug("send keepalive to client fd=%d", client[cs_idx].udp_fd);
|
---|
251 |
|
---|
252 | network_cmd_no_data_send(client[cs_idx].udp_fd, &client[cs_idx].ncd_msgid,
|
---|
253 | MSG_KEEPALIVE, client[cs_idx].ncd_skey,COMMTYPE_SERVER);
|
---|
254 | }
|
---|
255 |
|
---|
256 | static int connect_newcamd_server()
|
---|
257 | {
|
---|
258 | int i;
|
---|
259 | uint8 buf[CWS_NETMSGSIZE];
|
---|
260 | uint8 keymod[14];
|
---|
261 | uint8 *key;
|
---|
262 | int handle=0;
|
---|
263 |
|
---|
264 | uint32 index;
|
---|
265 | uint8 *passwdcrypt;
|
---|
266 | uint8 login_answer;
|
---|
267 | int bytes_received;
|
---|
268 |
|
---|
269 | if(reader[ridx].device[0] == 0 || reader[ridx].r_pwd[0] == 0 ||
|
---|
270 | reader[ridx].r_usr[0] == 0 || reader[ridx].r_port == 0)
|
---|
271 | return -5;
|
---|
272 |
|
---|
273 | // 1. Connect
|
---|
274 | //
|
---|
275 | handle = network_tcp_connection_open();
|
---|
276 | if(handle < 0) return -1;
|
---|
277 |
|
---|
278 | // 2. Get init sequence
|
---|
279 | //
|
---|
280 | reader[ridx].ncd_msgid = 0;
|
---|
281 | if( read(handle, keymod, sizeof(keymod)) != sizeof(keymod)) {
|
---|
282 | cs_log("server does not return 14 bytes");
|
---|
283 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
284 | return -2;
|
---|
285 | }
|
---|
286 | cs_ddump(keymod, 14, "server init sequence:");
|
---|
287 | key = des_login_key_get(keymod, reader[ridx].ncd_key, 14);
|
---|
288 |
|
---|
289 | // 3. Send login info
|
---|
290 | //
|
---|
291 | index = 3;
|
---|
292 | buf[0] = MSG_CLIENT_2_SERVER_LOGIN;
|
---|
293 | buf[1] = 0;
|
---|
294 | strcpy((char *)buf+index, reader[ridx].r_usr);
|
---|
295 | passwdcrypt = (uint8*)__md5_crypt(reader[ridx].r_pwd, "$1$abcdefgh$");
|
---|
296 | index += strlen(reader[ridx].r_usr)+1;
|
---|
297 | strcpy((char *)buf+index, (const char *)passwdcrypt);
|
---|
298 |
|
---|
299 | //cs_debug("login to server %s:%d user=%s, pwd=%s, len=%d", reader[ridx].device,
|
---|
300 | // reader[ridx].r_port, reader[ridx].r_usr, reader[ridx].r_pwd,
|
---|
301 | // index+strlen(passwdcrypt)+1);
|
---|
302 | network_message_send(handle, 0, buf, index+strlen((char *)passwdcrypt)+1, key,
|
---|
303 | COMMTYPE_CLIENT, 0x8888, NULL);
|
---|
304 |
|
---|
305 | // 3.1 Get login answer
|
---|
306 | //
|
---|
307 | login_answer=network_cmd_no_data_receive(handle, &reader[ridx].ncd_msgid,
|
---|
308 | key, COMMTYPE_CLIENT);
|
---|
309 | if( login_answer == MSG_CLIENT_2_SERVER_LOGIN_NAK )
|
---|
310 | {
|
---|
311 | cs_log("login failed for user '%s'", reader[ridx].r_usr);
|
---|
312 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
313 | return -3;
|
---|
314 | }
|
---|
315 | if( login_answer != MSG_CLIENT_2_SERVER_LOGIN_ACK )
|
---|
316 | {
|
---|
317 | cs_log("expected MSG_CLIENT_2_SERVER_LOGIN_ACK (%02X), received %02X",
|
---|
318 | MSG_CLIENT_2_SERVER_LOGIN_ACK, login_answer);
|
---|
319 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
320 | return -3;
|
---|
321 | }
|
---|
322 |
|
---|
323 | // 4. Send MSG_CARD_DATE_REQ
|
---|
324 | //
|
---|
325 | key = des_login_key_get(reader[ridx].ncd_key, passwdcrypt, strlen((char *)passwdcrypt));
|
---|
326 |
|
---|
327 | network_cmd_no_data_send(handle, &reader[ridx].ncd_msgid, MSG_CARD_DATA_REQ,
|
---|
328 | key, COMMTYPE_CLIENT);
|
---|
329 | bytes_received = network_message_receive(handle, &reader[ridx].ncd_msgid, buf,
|
---|
330 | key, COMMTYPE_CLIENT);
|
---|
331 | if( bytes_received < 16 || buf[2] != MSG_CARD_DATA ) {
|
---|
332 | cs_log("expected MSG_CARD_DATA (%02X), received %02X",
|
---|
333 | MSG_CARD_DATA, buf[2]);
|
---|
334 | network_tcp_connection_close(&reader[ridx], handle);
|
---|
335 | return -4;
|
---|
336 | }
|
---|
337 |
|
---|
338 | // 5. Parse CAID and PROVID(s)
|
---|
339 | //
|
---|
340 | reader[ridx].caid[0] = (ushort)((buf[4+2]<<8) | buf[5+2]);
|
---|
341 | memcpy(&reader[ridx].hexserial, buf+6+2, 8);
|
---|
342 | cs_log("Newcamd Server: %s:%d - UserID: %i", reader[ridx].device, reader[ridx].r_port, buf[3+2]);
|
---|
343 | cs_log("CAID: %04X - UA: %02X%02X%02X%02X%02X%02X%02X%02X - Provider # %i", reader[ridx].caid[0], reader[ridx].hexserial[0], reader[ridx].hexserial[1], reader[ridx].hexserial[2], reader[ridx].hexserial[3], reader[ridx].hexserial[4], reader[ridx].hexserial[5], reader[ridx].hexserial[6], reader[ridx].hexserial[7], buf[14+2]);
|
---|
344 | reader[ridx].nprov = buf[14+2];
|
---|
345 | memset(reader[ridx].prid, 0xff, sizeof(reader[ridx].prid));
|
---|
346 | for (i=0; i < reader[ridx].nprov; i++) {
|
---|
347 | reader[ridx].availkeys[i][0] = 1;
|
---|
348 | reader[ridx].prid[i][0] = buf[15+2+11*i];
|
---|
349 | reader[ridx].prid[i][1] = buf[16+2+11*i];
|
---|
350 | reader[ridx].prid[i][2] = buf[17+2+11*i];
|
---|
351 | memcpy(&reader[ridx].sa[i], buf+22+2+11*i, 4); // the 4 first bytes are not read
|
---|
352 | cs_log("Provider ID: %02X%02X%02X - SA: %02X%02X%02X%02X", reader[ridx].prid[i][0], reader[ridx].prid[i][1], reader[ridx].prid[i][2], reader[ridx].sa[i][0], reader[ridx].sa[i][1], reader[ridx].sa[i][2], reader[ridx].sa[i][3]);
|
---|
353 | }
|
---|
354 | memcpy(reader[ridx].ncd_skey, key, 16);
|
---|
355 |
|
---|
356 | // 6. Set connected info
|
---|
357 | //
|
---|
358 | reader[ridx].tcp_connected=1;
|
---|
359 | reader[ridx].last_g = reader[ridx].last_s = time((time_t *)0);
|
---|
360 |
|
---|
361 | // cs_log("last_s=%d, last_g=%d", reader[ridx].last_s, reader[ridx].last_g);
|
---|
362 |
|
---|
363 | // !!! Only after connect() on client[cs_idx].udp_fd (Linux)
|
---|
364 | pfd=client[cs_idx].udp_fd;
|
---|
365 |
|
---|
366 | return 0;
|
---|
367 | }
|
---|
368 |
|
---|
369 | static int newcamd_connect()
|
---|
370 | {
|
---|
371 | if (!reader[ridx].tcp_connected && connect_newcamd_server() < 0 ) return 0;
|
---|
372 | if (!client[cs_idx].udp_fd) return 0;
|
---|
373 |
|
---|
374 | return 1;
|
---|
375 | }
|
---|
376 |
|
---|
377 |
|
---|
378 | static int newcamd_send(uchar *buf, int ml, ushort sid)
|
---|
379 | {
|
---|
380 | if( !newcamd_connect() ) return(-1);
|
---|
381 |
|
---|
382 | //cs_ddump(buf, ml, "send %d bytes to %s", ml, remote_txt());
|
---|
383 | return(network_message_send(client[cs_idx].udp_fd, &reader[ridx].ncd_msgid,
|
---|
384 | buf, ml, reader[ridx].ncd_skey, COMMTYPE_CLIENT, sid, NULL));
|
---|
385 | }
|
---|
386 |
|
---|
387 | static int newcamd_recv(uchar *buf)
|
---|
388 | {
|
---|
389 | int rc, rs;
|
---|
390 |
|
---|
391 | if (is_server)
|
---|
392 | {
|
---|
393 | rs=network_message_receive(client[cs_idx].udp_fd,
|
---|
394 | &client[cs_idx].ncd_msgid, buf,
|
---|
395 | client[cs_idx].ncd_skey, COMMTYPE_SERVER);
|
---|
396 | }
|
---|
397 | else
|
---|
398 | {
|
---|
399 | if (!client[cs_idx].udp_fd) return(-1);
|
---|
400 | rs=network_message_receive(client[cs_idx].udp_fd,
|
---|
401 | &reader[ridx].ncd_msgid,buf,
|
---|
402 | reader[ridx].ncd_skey, COMMTYPE_CLIENT);
|
---|
403 | }
|
---|
404 |
|
---|
405 | if (rs<5) rc=(-1);
|
---|
406 | else rc=rs;
|
---|
407 |
|
---|
408 | cs_ddump(buf, rs, "received %d bytes from %s", rs, remote_txt());
|
---|
409 | client[cs_idx].last = time((time_t *) 0);
|
---|
410 |
|
---|
411 | if( rc==-1 )
|
---|
412 | {
|
---|
413 | if (rs > 0)
|
---|
414 | cs_log("packet to small (%d bytes)", rs);
|
---|
415 | else
|
---|
416 | cs_log("Connection closed to %s", remote_txt());
|
---|
417 | }
|
---|
418 | return(rc);
|
---|
419 | }
|
---|
420 |
|
---|
421 | static unsigned int seed;
|
---|
422 | static uchar fast_rnd()
|
---|
423 | {
|
---|
424 | unsigned int offset = 12923;
|
---|
425 | unsigned int multiplier = 4079;
|
---|
426 |
|
---|
427 | seed = seed * multiplier + offset;
|
---|
428 | return (uchar)(seed % 0xFF);
|
---|
429 | }
|
---|
430 |
|
---|
431 | static FILTER mk_user_au_ftab(int au)
|
---|
432 | {
|
---|
433 | int i,j,found;
|
---|
434 | FILTER filt;
|
---|
435 | FILTER *pufilt;
|
---|
436 |
|
---|
437 | filt.caid = reader[au].caid[0];
|
---|
438 | if (filt.caid == 0) filt.caid = client[cs_idx].ftab.filts[0].caid;
|
---|
439 | filt.nprids = 0;
|
---|
440 | memset(&filt.prids, 0, sizeof(filt.prids));
|
---|
441 | pufilt = &client[cs_idx].ftab.filts[0];
|
---|
442 |
|
---|
443 | for( i=0; i<reader[au].nprov; i++ )
|
---|
444 | filt.prids[filt.nprids++] = b2i(3, &reader[au].prid[i][1]);
|
---|
445 |
|
---|
446 | for( i=0; i<pufilt->nprids; i++ )
|
---|
447 | {
|
---|
448 | for( j=found=0; (!found)&&(j<filt.nprids); j++ )
|
---|
449 | if (pufilt->prids[i] == filt.prids[j]) found=1;
|
---|
450 | if( !found )
|
---|
451 | filt.prids[filt.nprids++] = pufilt->prids[i];
|
---|
452 | }
|
---|
453 |
|
---|
454 | return filt;
|
---|
455 | }
|
---|
456 |
|
---|
457 | static FILTER mk_user_ftab()
|
---|
458 | {
|
---|
459 | FILTER *psfilt = 0;
|
---|
460 | FILTER filt;
|
---|
461 | int port_idx,i,j,k,c;
|
---|
462 |
|
---|
463 | filt.caid = 0;
|
---|
464 | filt.nprids = 0;
|
---|
465 | memset(&filt.prids, 0, sizeof(filt.prids));
|
---|
466 |
|
---|
467 | port_idx = client[cs_idx].port_idx;
|
---|
468 | psfilt = &cfg->ncd_ptab.ports[port_idx].ftab.filts[0];
|
---|
469 |
|
---|
470 | // 1. CAID
|
---|
471 | // search server CAID in client CAID
|
---|
472 | for( c=i=0; i<CS_MAXCAIDTAB; i++ )
|
---|
473 | {
|
---|
474 | int ctab_caid;
|
---|
475 | ctab_caid = client[cs_idx].ctab.caid[i]&client[cs_idx].ctab.mask[i];
|
---|
476 | if( ctab_caid ) c++;
|
---|
477 |
|
---|
478 | if( psfilt->caid==ctab_caid )
|
---|
479 | {
|
---|
480 | filt.caid=ctab_caid;
|
---|
481 | break;
|
---|
482 | }
|
---|
483 | }
|
---|
484 | if( c && !filt.caid )
|
---|
485 | {
|
---|
486 | cs_log("no valid CAID found in CAID for user '%s'", client[cs_idx].usr);
|
---|
487 | return filt;
|
---|
488 | }
|
---|
489 |
|
---|
490 | // search CAID in client IDENT
|
---|
491 | cs_debug("client[%d].%s nfilts=%d, filt.caid=%04X", cs_idx,
|
---|
492 | client[cs_idx].usr, client[cs_idx].ftab.nfilts, filt.caid);
|
---|
493 |
|
---|
494 | if( !filt.caid && client[cs_idx].ftab.nfilts )
|
---|
495 | {
|
---|
496 | int fcaids;
|
---|
497 | for( i=fcaids=0; i<client[cs_idx].ftab.nfilts; i++ )
|
---|
498 | {
|
---|
499 | ushort ucaid=client[cs_idx].ftab.filts[i].caid;
|
---|
500 | if( ucaid ) fcaids++;
|
---|
501 | if( ucaid && psfilt->caid==ucaid )
|
---|
502 | {
|
---|
503 | filt.caid = ucaid;
|
---|
504 | break;
|
---|
505 | }
|
---|
506 | }
|
---|
507 | if( fcaids==client[cs_idx].ftab.nfilts && !filt.caid )
|
---|
508 | {
|
---|
509 | cs_log("no valid CAID found in IDENT for user '%s'", client[cs_idx].usr);
|
---|
510 | //cs_disconnect_client();
|
---|
511 | return filt;
|
---|
512 | }
|
---|
513 | }
|
---|
514 | // empty client CAID - use server CAID
|
---|
515 | if( !filt.caid ) filt.caid=psfilt->caid;
|
---|
516 |
|
---|
517 | // 2. PROVID
|
---|
518 | if( !client[cs_idx].ftab.nfilts )
|
---|
519 | {
|
---|
520 | int r, add;
|
---|
521 | for (i=0; i<psfilt->nprids; i++) {
|
---|
522 | // use server PROVID(s) (and only those which are in user's groups)
|
---|
523 | add = 0;
|
---|
524 | for (r=0; !add && r<CS_MAXREADER; r++) {
|
---|
525 | if (reader[r].grp & client[cs_idx].grp) {
|
---|
526 | if (!reader[r].ftab.nfilts) {
|
---|
527 | if (reader[r].typ & R_IS_NETWORK) add = 1;
|
---|
528 | for (j=0; !add && j<reader[r].nprov; j++)
|
---|
529 | if (b2i(3, &reader[r].prid[j][1]) == psfilt->prids[i]) add = 1;
|
---|
530 | } else {
|
---|
531 | for (j=0; !add && j<reader[r].ftab.nfilts; j++) {
|
---|
532 | ulong rcaid = reader[r].ftab.filts[j].caid;
|
---|
533 | if (!rcaid || rcaid == filt.caid) {
|
---|
534 | for (k=0; !add && k<reader[r].ftab.filts[j].nprids; k++)
|
---|
535 | if (reader[r].ftab.filts[j].prids[k] == psfilt->prids[i]) add = 1;
|
---|
536 | }
|
---|
537 | }
|
---|
538 | }
|
---|
539 | }
|
---|
540 | }
|
---|
541 | if (add) filt.prids[filt.nprids++] = psfilt->prids[i];
|
---|
542 | }
|
---|
543 | return filt;
|
---|
544 | }
|
---|
545 |
|
---|
546 | // search in client IDENT
|
---|
547 | for( j=0; j<client[cs_idx].ftab.nfilts; j++ )
|
---|
548 | {
|
---|
549 | ulong ucaid = client[cs_idx].ftab.filts[j].caid;
|
---|
550 | cs_debug("client caid #%d: %04X", j, ucaid);
|
---|
551 | if( !ucaid || ucaid==filt.caid )
|
---|
552 | {
|
---|
553 | for (i=0; i<psfilt->nprids; i++)
|
---|
554 | {
|
---|
555 | cs_debug("search server provid #%d: %06X", i, psfilt->prids[i]);
|
---|
556 | if( client[cs_idx].ftab.filts[j].nprids )
|
---|
557 | {
|
---|
558 | for( k=0; k<client[cs_idx].ftab.filts[j].nprids; k++ )
|
---|
559 | if (client[cs_idx].ftab.filts[j].prids[k] == psfilt->prids[i])
|
---|
560 | filt.prids[filt.nprids++]=client[cs_idx].ftab.filts[j].prids[k];
|
---|
561 | } else {
|
---|
562 | filt.prids[filt.nprids++] = psfilt->prids[i];
|
---|
563 | // allow server PROVID(s) if no PROVID(s) specified in IDENT
|
---|
564 | }
|
---|
565 | }
|
---|
566 | }
|
---|
567 | }
|
---|
568 |
|
---|
569 | if( !filt.nprids )
|
---|
570 | {
|
---|
571 | cs_log("no valid PROVID(s) found in CAID for user '%s'", client[cs_idx].usr);
|
---|
572 | //cs_disconnect_client();
|
---|
573 | }
|
---|
574 |
|
---|
575 | return filt;
|
---|
576 | }
|
---|
577 |
|
---|
578 | static void newcamd_auth_client(in_addr_t ip)
|
---|
579 | {
|
---|
580 | int i, ok;
|
---|
581 | uchar *usr=NULL, *pwd=NULL;
|
---|
582 | struct s_auth *account;
|
---|
583 | uchar buf[14];
|
---|
584 | uchar *key=0;
|
---|
585 | uint8 *passwdcrypt = NULL;
|
---|
586 | int au=0;
|
---|
587 | struct s_ip *p_ip;
|
---|
588 |
|
---|
589 | ok = cfg->ncd_allowed ? 0 : 1;
|
---|
590 | for (p_ip=cfg->ncd_allowed; (p_ip) && (!ok); p_ip=p_ip->next)
|
---|
591 | ok=((ip>=p_ip->ip[0]) && (ip<=p_ip->ip[1]));
|
---|
592 |
|
---|
593 | if (!ok)
|
---|
594 | {
|
---|
595 | cs_auth_client((struct s_auth *)0, NULL);
|
---|
596 | cs_exit(0);
|
---|
597 | }
|
---|
598 |
|
---|
599 | // make random 14 bytes
|
---|
600 | seed = (unsigned int) time((time_t*)0);
|
---|
601 | for( i=0; i<14; i++ ) buf[i]=fast_rnd();
|
---|
602 |
|
---|
603 | // send init sequence
|
---|
604 | send(client[cs_idx].udp_fd, buf, 14, 0);
|
---|
605 | key = des_login_key_get(buf, cfg->ncd_key, 14);
|
---|
606 | memcpy(client[cs_idx].ncd_skey, key, 16);
|
---|
607 | client[cs_idx].ncd_msgid = 0;
|
---|
608 |
|
---|
609 | i=process_input(mbuf, sizeof(mbuf), cfg->cmaxidle);
|
---|
610 | if ( i>0 )
|
---|
611 | {
|
---|
612 | if( mbuf[2] != MSG_CLIENT_2_SERVER_LOGIN )
|
---|
613 | {
|
---|
614 | cs_debug("expected MSG_CLIENT_2_SERVER_LOGIN (%02X), received %02X",
|
---|
615 | MSG_CLIENT_2_SERVER_LOGIN, mbuf[2]);
|
---|
616 | if(req)
|
---|
617 | {
|
---|
618 | free(req);
|
---|
619 | req=0;
|
---|
620 | }
|
---|
621 | cs_exit(0);
|
---|
622 | }
|
---|
623 | usr=mbuf+5;
|
---|
624 | pwd=usr+strlen((char *)usr)+1;
|
---|
625 | //cs_debug("usr=%s,pwd=%s", usr, pwd);
|
---|
626 | }
|
---|
627 | else
|
---|
628 | {
|
---|
629 | cs_debug("bad client login request");
|
---|
630 | if(req)
|
---|
631 | {
|
---|
632 | free(req);
|
---|
633 | req=0;
|
---|
634 | }
|
---|
635 | cs_exit(0);
|
---|
636 | }
|
---|
637 |
|
---|
638 | for (ok=0, account=cfg->account; (usr) && (account) && (!ok); account=account->next)
|
---|
639 | {
|
---|
640 | cs_debug("account->usr=%s", account->usr);
|
---|
641 | if (strcmp((char *)usr, account->usr) == 0)
|
---|
642 | {
|
---|
643 | passwdcrypt = (uint8*)__md5_crypt(account->pwd, "$1$abcdefgh$");
|
---|
644 | cs_debug("account->pwd=%s", passwdcrypt);
|
---|
645 | if (strcmp((char *)pwd, (const char *)passwdcrypt) == 0)
|
---|
646 | {
|
---|
647 | client[cs_idx].crypted=1;
|
---|
648 | cs_auth_client(account, NULL);
|
---|
649 | cs_log("user %s authenticated successfully (using client %02X%02X)", usr, mbuf[0], mbuf[1]);
|
---|
650 | ok = 1;
|
---|
651 | break;
|
---|
652 | }
|
---|
653 | else
|
---|
654 | {
|
---|
655 | cs_log("user %s is providing a wrong password (using client %02X%02X)", usr, mbuf[0], mbuf[1]);
|
---|
656 | }
|
---|
657 | }
|
---|
658 | }
|
---|
659 |
|
---|
660 | if (!ok && !account)
|
---|
661 | {
|
---|
662 | cs_log("user %s is trying to connect but doesnt exist ! (using client %02X%02X)", usr, mbuf[0], mbuf[1]);
|
---|
663 | usr = 0;
|
---|
664 | }
|
---|
665 |
|
---|
666 | if (ok)
|
---|
667 | {
|
---|
668 | au = client[cs_idx].au;
|
---|
669 | if (au != -1)
|
---|
670 | {
|
---|
671 | if (cfg->ncd_ptab.ports[client[cs_idx].port_idx].ftab.filts[0].caid != reader[au].caid[0]
|
---|
672 | && cfg->ncd_ptab.ports[client[cs_idx].port_idx].ftab.filts[0].caid != reader[au].ftab.filts[0].caid)
|
---|
673 | {
|
---|
674 | cs_log("AU wont be used on this port -> disable AU");
|
---|
675 | au = -1;
|
---|
676 | }
|
---|
677 | else if (reader[au].card_system <= 0 && !(reader[au].typ & R_IS_CASCADING))
|
---|
678 | {
|
---|
679 | // Init for AU enabled card not finished, reject Client
|
---|
680 | ok=0;
|
---|
681 | au = -2; // Flag zur Logausgabe
|
---|
682 | }
|
---|
683 | else
|
---|
684 | {
|
---|
685 | cs_log("AU enabled for user %s on reader %s", usr, reader[au].label);
|
---|
686 | }
|
---|
687 | }
|
---|
688 | else
|
---|
689 | {
|
---|
690 | cs_log("AU disabled for user %s", usr);
|
---|
691 | }
|
---|
692 | }
|
---|
693 |
|
---|
694 | network_cmd_no_data_send(client[cs_idx].udp_fd, &client[cs_idx].ncd_msgid,
|
---|
695 | (ok)?MSG_CLIENT_2_SERVER_LOGIN_ACK:MSG_CLIENT_2_SERVER_LOGIN_NAK,
|
---|
696 | client[cs_idx].ncd_skey, COMMTYPE_SERVER);
|
---|
697 |
|
---|
698 | // we need to add a test to make sure all card reader are ready before allowing more interaction with the user.
|
---|
699 | // cfg->ncd_ptab.ports[client[cs_idx].port_idx].ftab.filts[0].caid old the CAID for this port
|
---|
700 | // we need to check all ready for a match and check if they are ready
|
---|
701 | // if they arent ready, disconnect the user.
|
---|
702 | // it will reconnect in a few second.
|
---|
703 |
|
---|
704 | if (ok)
|
---|
705 | {
|
---|
706 | FILTER pufilt_noau;
|
---|
707 | FILTER *pufilt = 0;
|
---|
708 |
|
---|
709 | key = des_login_key_get(cfg->ncd_key, passwdcrypt, strlen((char *)passwdcrypt));
|
---|
710 | memcpy(client[cs_idx].ncd_skey, key, 16);
|
---|
711 |
|
---|
712 | i=process_input(mbuf, sizeof(mbuf), cfg->cmaxidle);
|
---|
713 | if( i>0 )
|
---|
714 | {
|
---|
715 | int j,len=15;
|
---|
716 | if( mbuf[2] != MSG_CARD_DATA_REQ)
|
---|
717 | {
|
---|
718 | cs_debug("expected MSG_CARD_DATA_REQ (%02X), received %02X",
|
---|
719 | MSG_CARD_DATA_REQ, mbuf[2]);
|
---|
720 | if(req)
|
---|
721 | {
|
---|
722 | free(req); req=0;
|
---|
723 | }
|
---|
724 | cs_exit(0);
|
---|
725 | }
|
---|
726 |
|
---|
727 | client[cs_idx].ftab.filts[0] = mk_user_ftab();
|
---|
728 | pufilt = &client[cs_idx].ftab.filts[0];
|
---|
729 |
|
---|
730 | if (au != -1)
|
---|
731 | {
|
---|
732 | unsigned char equal = 1;
|
---|
733 |
|
---|
734 | // remember user filter
|
---|
735 | memcpy(&pufilt_noau, pufilt, sizeof(FILTER));
|
---|
736 |
|
---|
737 | client[cs_idx].ftab.filts[0] = mk_user_au_ftab(au);
|
---|
738 | pufilt = &client[cs_idx].ftab.filts[0];
|
---|
739 |
|
---|
740 | // check if user filter CAID and PROVID is the same as CAID and PROVID of the AU reader
|
---|
741 |
|
---|
742 | if ((pufilt->caid != pufilt_noau.caid))
|
---|
743 | {
|
---|
744 | // cs_log("CAID server: %04X, CAID card: %04X, not equal, AU disabled",pufilt_noau.caid,pufilt->caid);
|
---|
745 | // equal = 0;
|
---|
746 | }
|
---|
747 |
|
---|
748 | for( j=0; equal && j<pufilt_noau.nprids && j<pufilt->nprids; j++)
|
---|
749 | {
|
---|
750 | if (pufilt->prids[j] != pufilt_noau.prids[j])
|
---|
751 | {
|
---|
752 | // cs_log("PROVID%d server: %04X, PROVID%d card: %04X, not equal, AU disabled",j,pufilt_noau.prids[j],j,pufilt->prids[j]);
|
---|
753 | //weird// equal = 0;
|
---|
754 | }
|
---|
755 | }
|
---|
756 |
|
---|
757 | if (!equal)
|
---|
758 | {
|
---|
759 | // Not equal -> AU must set to disabled -> set back to user filter
|
---|
760 | memcpy(pufilt, &pufilt_noau, sizeof(FILTER));
|
---|
761 | au = -1;
|
---|
762 | }
|
---|
763 | }
|
---|
764 |
|
---|
765 | client[cs_idx].ftab.nfilts = 1;
|
---|
766 | mbuf[0] = MSG_CARD_DATA;
|
---|
767 | mbuf[1] = 0x00;
|
---|
768 | mbuf[2] = 0x00;
|
---|
769 |
|
---|
770 | // AU always set to true because some clients cannot handle "non-AU"
|
---|
771 | // For security reason don't send the real hexserial (see below)
|
---|
772 | // if a non-AU-client sends an EMM-request it will be thrown away
|
---|
773 | // (see function "newcamd_process_emm")
|
---|
774 | //mbuf[3] = 1;
|
---|
775 | if( au!=-1 )
|
---|
776 | mbuf[3] = 1;
|
---|
777 | else
|
---|
778 | mbuf[3] = cs_idx+10; // Unique user number
|
---|
779 |
|
---|
780 | mbuf[4] = (uchar)(pufilt->caid>>8);
|
---|
781 | mbuf[5] = (uchar)(pufilt->caid);
|
---|
782 | mbuf[6] = 0x00;
|
---|
783 | mbuf[7] = 0x00;
|
---|
784 |
|
---|
785 | if (au != -1)
|
---|
786 | {
|
---|
787 | if (((pufilt->caid >> 8) == 0x17) || ((pufilt->caid >> 8) == 0x06)) // Betacrypt or Irdeto
|
---|
788 | {
|
---|
789 | // only 4 Bytes Hexserial for newcamd clients (Hex Base + Hex Serial)
|
---|
790 | // first 2 Byte always 00
|
---|
791 | mbuf[8]=0x00; //serial only 4 bytes
|
---|
792 | mbuf[9]=0x00; //serial only 4 bytes
|
---|
793 | // 1 Byte Hex Base (see reader-irdeto.c how this is stored in "reader[au].hexserial")
|
---|
794 | mbuf[10]=reader[au].hexserial[3];
|
---|
795 | // 3 Bytes Hex Serial (see reader-irdeto.c how this is stored in "reader[au].hexserial")
|
---|
796 | mbuf[11]=reader[au].hexserial[0];
|
---|
797 | mbuf[12]=reader[au].hexserial[1];
|
---|
798 | mbuf[13]=reader[au].hexserial[2];
|
---|
799 | }
|
---|
800 | else if (((pufilt->caid >> 8) == 0x05) || ((pufilt->caid >> 8) == 0x0D))
|
---|
801 | {
|
---|
802 | mbuf[8] = 0x00;
|
---|
803 | mbuf[9] = reader[au].hexserial[0];
|
---|
804 | mbuf[10] = reader[au].hexserial[1];
|
---|
805 | mbuf[11] = reader[au].hexserial[2];
|
---|
806 | mbuf[12] = reader[au].hexserial[3];
|
---|
807 | mbuf[13] = reader[au].hexserial[4];
|
---|
808 | }
|
---|
809 | else
|
---|
810 | {
|
---|
811 | mbuf[8] = reader[au].hexserial[0];
|
---|
812 | mbuf[9] = reader[au].hexserial[1];
|
---|
813 | mbuf[10] = reader[au].hexserial[2];
|
---|
814 | mbuf[11] = reader[au].hexserial[3];
|
---|
815 | mbuf[12] = reader[au].hexserial[4];
|
---|
816 | mbuf[13] = reader[au].hexserial[5];
|
---|
817 | }
|
---|
818 | }
|
---|
819 | else
|
---|
820 | {
|
---|
821 | client[cs_idx].au = -1;
|
---|
822 | mbuf[8] = 0x00;
|
---|
823 | mbuf[9] = 0x00;
|
---|
824 | mbuf[10] = 0x00;
|
---|
825 | mbuf[11] = 0x00;
|
---|
826 | mbuf[12] = 0x00;
|
---|
827 | mbuf[13] = 0x00;
|
---|
828 | // send "faked" Hexserial to client
|
---|
829 | /*
|
---|
830 | if (((pufilt->caid >= 0x1700) && (pufilt->caid <= 0x1799)) || // Betacrypt
|
---|
831 | ((pufilt->caid >= 0x0600) && (pufilt->caid <= 0x0699))) // Irdeto
|
---|
832 | {
|
---|
833 | mbuf[6] = 0x00;
|
---|
834 | mbuf[7] = 0x00;
|
---|
835 | mbuf[8] = 0x00;
|
---|
836 | mbuf[9] = 0x00;
|
---|
837 | mbuf[10] = fast_rnd();
|
---|
838 | mbuf[11] = fast_rnd();
|
---|
839 | mbuf[12] = fast_rnd();
|
---|
840 | mbuf[13] = fast_rnd();
|
---|
841 | }
|
---|
842 | else
|
---|
843 | {
|
---|
844 | mbuf[6] = fast_rnd();
|
---|
845 | mbuf[7] = fast_rnd();
|
---|
846 | mbuf[8] = fast_rnd();
|
---|
847 | mbuf[9] = fast_rnd();
|
---|
848 | mbuf[10] = fast_rnd();
|
---|
849 | mbuf[11] = fast_rnd();
|
---|
850 | mbuf[12] = fast_rnd();
|
---|
851 | mbuf[13] = fast_rnd();
|
---|
852 | }
|
---|
853 | */
|
---|
854 | }
|
---|
855 |
|
---|
856 | mbuf[14] = pufilt->nprids;
|
---|
857 | for( j=0; j<pufilt->nprids; j++)
|
---|
858 | {
|
---|
859 | if ((pufilt->caid >= 0x0600) && (pufilt->caid <= 0x0699)) // Irdeto
|
---|
860 | {
|
---|
861 | mbuf[15+11*j] = 0;
|
---|
862 | mbuf[16+11*j] = 0;
|
---|
863 | mbuf[17+11*j] = j;
|
---|
864 | }
|
---|
865 | else
|
---|
866 | {
|
---|
867 | mbuf[15+11*j] = (uchar)(pufilt->prids[j]>>16);
|
---|
868 | mbuf[16+11*j] = (uchar)(pufilt->prids[j]>>8);
|
---|
869 | mbuf[17+11*j] = (uchar)(pufilt->prids[j]);
|
---|
870 | }
|
---|
871 | mbuf[18+11*j] = 0x00;
|
---|
872 | mbuf[19+11*j] = 0x00;
|
---|
873 | mbuf[20+11*j] = 0x00;
|
---|
874 | mbuf[21+11*j] = 0x00;
|
---|
875 | if( au!=-1 )
|
---|
876 | { // check if user provid from IDENT exists on card
|
---|
877 | int k, found;
|
---|
878 | ulong rprid;
|
---|
879 | found=0;
|
---|
880 | if( pufilt->caid==reader[au].caid[0] )
|
---|
881 | {
|
---|
882 | for( k=0; (k<reader[au].nprov); k++ )
|
---|
883 | {
|
---|
884 | rprid=b2i(3, &reader[au].prid[k][1]);
|
---|
885 | if( rprid==pufilt->prids[j] )
|
---|
886 | {
|
---|
887 | if ((pufilt->caid >= 0x0600) && (pufilt->caid <= 0x0699)) // Irdeto
|
---|
888 | {
|
---|
889 | mbuf[22+11*j] = reader[au].prid[k][0];
|
---|
890 | mbuf[23+11*j] = reader[au].prid[k][1];
|
---|
891 | mbuf[24+11*j] = reader[au].prid[k][2];
|
---|
892 | mbuf[25+11*j] = reader[au].prid[k][3];
|
---|
893 | }
|
---|
894 | else
|
---|
895 | {
|
---|
896 | mbuf[22+11*j] = reader[au].sa[k][0];
|
---|
897 | mbuf[23+11*j] = reader[au].sa[k][1];
|
---|
898 | mbuf[24+11*j] = reader[au].sa[k][2];
|
---|
899 | mbuf[25+11*j] = reader[au].sa[k][3];
|
---|
900 | }
|
---|
901 | found=1;
|
---|
902 | break;
|
---|
903 | }
|
---|
904 | }
|
---|
905 | }
|
---|
906 | if( !found )
|
---|
907 | {
|
---|
908 | mbuf[22+11*j] = 0x00;
|
---|
909 | mbuf[23+11*j] = 0x00;
|
---|
910 | mbuf[24+11*j] = 0x00;
|
---|
911 | mbuf[25+11*j] = 0x00;
|
---|
912 | }
|
---|
913 | }
|
---|
914 | else
|
---|
915 | {
|
---|
916 | if ((pufilt->caid >= 0x0600) && (pufilt->caid <= 0x0699)) // Irdeto
|
---|
917 | {
|
---|
918 | mbuf[22+11*j] = 0x00;
|
---|
919 | mbuf[23+11*j] = (uchar)(pufilt->prids[j]>>16);
|
---|
920 | mbuf[24+11*j] = (uchar)(pufilt->prids[j]>>8);
|
---|
921 | mbuf[25+11*j] = (uchar)(pufilt->prids[j]);
|
---|
922 | }
|
---|
923 | else
|
---|
924 | {
|
---|
925 | mbuf[22+11*j] = 0x00;
|
---|
926 | mbuf[23+11*j] = 0x00;
|
---|
927 | mbuf[24+11*j] = 0x00;
|
---|
928 | mbuf[25+11*j] = 0x00;
|
---|
929 | }
|
---|
930 | }
|
---|
931 | len+=11;
|
---|
932 | }
|
---|
933 |
|
---|
934 | if( network_message_send(client[cs_idx].udp_fd, &client[cs_idx].ncd_msgid, mbuf, len, key, COMMTYPE_SERVER, 0, NULL) <0 )
|
---|
935 | {
|
---|
936 | if(req)
|
---|
937 | {
|
---|
938 | free(req);
|
---|
939 | req=0;
|
---|
940 | }
|
---|
941 | cs_exit(0);
|
---|
942 | }
|
---|
943 | }
|
---|
944 | }
|
---|
945 | else
|
---|
946 | {
|
---|
947 | if (au == -2)
|
---|
948 | cs_auth_client(0, "Init for AU enabled card not finished");
|
---|
949 | else
|
---|
950 | cs_auth_client(0, usr ? "login failure" : "no such user");
|
---|
951 | if(req)
|
---|
952 | {
|
---|
953 | free(req);
|
---|
954 | req=0;
|
---|
955 | }
|
---|
956 | cs_exit(0);
|
---|
957 | }
|
---|
958 | }
|
---|
959 |
|
---|
960 | static void newcamd_send_dcw(ECM_REQUEST *er)
|
---|
961 | {
|
---|
962 | int len;
|
---|
963 | ushort cl_msgid;
|
---|
964 |
|
---|
965 | if (!client[cs_idx].udp_fd) {
|
---|
966 | cs_debug("ncd_send_dcw: error: client[cs_idx].udp_fd=%d", client[cs_idx].udp_fd);
|
---|
967 | return;
|
---|
968 | }
|
---|
969 | memcpy(&cl_msgid, req+(er->cpti*REQ_SIZE), 2); // get client ncd_msgid + 0x8x
|
---|
970 | mbuf[0] = er->ecm[0];
|
---|
971 | if( client[cs_idx].ftab.filts[0].nprids==0 || er->rc>3 /*not found*/)
|
---|
972 | {
|
---|
973 | len=3;
|
---|
974 | mbuf[1] = mbuf[2] = 0x00;
|
---|
975 | }
|
---|
976 | else
|
---|
977 | {
|
---|
978 | len = 19;
|
---|
979 | mbuf[1] = mbuf[2] = 0x10;
|
---|
980 | memcpy(mbuf+3, er->cw, 16);
|
---|
981 | }
|
---|
982 |
|
---|
983 | cs_debug("ncd_send_dcw: er->cpti=%d, cl_msgid=%d, %02X", er->cpti, cl_msgid, mbuf[0]);
|
---|
984 |
|
---|
985 | network_message_send(client[cs_idx].udp_fd, &cl_msgid, mbuf, len,
|
---|
986 | client[cs_idx].ncd_skey, COMMTYPE_SERVER, 0, NULL);
|
---|
987 | }
|
---|
988 |
|
---|
989 | static void newcamd_process_ecm(uchar *buf)
|
---|
990 | {
|
---|
991 | int pi;
|
---|
992 | ECM_REQUEST *er;
|
---|
993 | if (!(er=get_ecmtask())) {
|
---|
994 | return;
|
---|
995 | }
|
---|
996 | // save client ncd_msgid
|
---|
997 | memcpy(req+(er->cpti*REQ_SIZE), &client[cs_idx].ncd_msgid, 2);
|
---|
998 | cs_debug("ncd_process_ecm: er->cpti=%d, cl_msgid=%d, %02X", er->cpti,
|
---|
999 | client[cs_idx].ncd_msgid, buf[2]);
|
---|
1000 | er->l=buf[4]+3;
|
---|
1001 | er->srvid = (buf[0]<<8)|buf[1];
|
---|
1002 | er->caid = 0;
|
---|
1003 | pi = client[cs_idx].port_idx;
|
---|
1004 | if( cfg->ncd_ptab.nports && cfg->ncd_ptab.nports >= pi )
|
---|
1005 | er->caid=cfg->ncd_ptab.ports[pi].ftab.filts[0].caid;
|
---|
1006 | memcpy(er->ecm, buf+2, er->l);
|
---|
1007 | get_cw(er);
|
---|
1008 | }
|
---|
1009 |
|
---|
1010 | static void newcamd_process_emm(uchar *buf)
|
---|
1011 | {
|
---|
1012 | int au, ok=1;
|
---|
1013 | ushort caid;
|
---|
1014 |
|
---|
1015 | EMM_PACKET epg;
|
---|
1016 | memset(&epg, 0, sizeof(epg));
|
---|
1017 | au=client[cs_idx].au;
|
---|
1018 |
|
---|
1019 | // if client is not allowed to do AU just send back the OK-answer to
|
---|
1020 | // the client and do nothing else with the received data
|
---|
1021 | if ((au>=0) && (au<=CS_MAXREADER))
|
---|
1022 | {
|
---|
1023 | epg.l=buf[2]+3;
|
---|
1024 | caid = client[cs_idx].ftab.filts[0].caid;
|
---|
1025 | epg.caid[0] = (uchar)(caid>>8);
|
---|
1026 | epg.caid[1] = (uchar)(caid);
|
---|
1027 | /* if (caid == 0x0500)
|
---|
1028 | {
|
---|
1029 | ushort emm_head;
|
---|
1030 |
|
---|
1031 | emm_head = (buf[0]<<8) | buf[1];
|
---|
1032 | switch( emm_head )
|
---|
1033 | {
|
---|
1034 | case 0x8e70: // EMM-S
|
---|
1035 | memcpy(epg.hexserial+1, buf+3, 4);
|
---|
1036 | epg.hexserial[4]=reader[au].hexserial[4];
|
---|
1037 | break;
|
---|
1038 | case 0x8870: // EMM-U
|
---|
1039 | case 0x8c70: // confidential ?
|
---|
1040 | default:
|
---|
1041 | cs_log("unsupported emm type: %04X", emm_head);
|
---|
1042 | ok=0;
|
---|
1043 | }
|
---|
1044 | if( !ok ) cs_log("only EMM-S supported");
|
---|
1045 | }
|
---|
1046 | else*/
|
---|
1047 |
|
---|
1048 | memcpy(epg.emm, buf, epg.l);
|
---|
1049 | if( ok )
|
---|
1050 | do_emm(&epg);
|
---|
1051 | }
|
---|
1052 |
|
---|
1053 | // Should always send an answer to client (also if au is disabled),
|
---|
1054 | // some clients will disconnect if they get no answer
|
---|
1055 | buf[1] = 0x10;
|
---|
1056 | buf[2] = 0x00;
|
---|
1057 | network_message_send(client[cs_idx].udp_fd, &client[cs_idx].ncd_msgid, buf, 3,
|
---|
1058 | client[cs_idx].ncd_skey, COMMTYPE_SERVER, 0, NULL);
|
---|
1059 | }
|
---|
1060 |
|
---|
1061 | static void newcamd_server()
|
---|
1062 | {
|
---|
1063 | int rc;
|
---|
1064 |
|
---|
1065 | req=(uchar *)malloc(CS_MAXPENDING*REQ_SIZE);
|
---|
1066 | if (!req)
|
---|
1067 | {
|
---|
1068 | cs_log("Cannot allocate memory (errno=%d)", errno);
|
---|
1069 | cs_exit(1);
|
---|
1070 | }
|
---|
1071 |
|
---|
1072 | memset(req, 0, CS_MAXPENDING*REQ_SIZE);
|
---|
1073 | client[cs_idx].ncd_server = 1;
|
---|
1074 | cs_debug("client connected to %d port", cfg->ncd_ptab.ports[client[cs_idx].port_idx].s_port);
|
---|
1075 | newcamd_auth_client(client[cs_idx].ip);
|
---|
1076 |
|
---|
1077 | // report all cards if using extended mg proto
|
---|
1078 | if (cfg->ncd_mgclient) {
|
---|
1079 | cs_debug("newcamd: extended: report all available cards");
|
---|
1080 | int r, j, k;
|
---|
1081 | uint8 buf[512];
|
---|
1082 | custom_data_t *cd = malloc(sizeof(struct custom_data));
|
---|
1083 | memset(cd, 0, sizeof(struct custom_data));
|
---|
1084 | memset(buf, 0, sizeof(buf));
|
---|
1085 |
|
---|
1086 | buf[0] = MSG_SERVER_2_CLIENT_ADDCARD;
|
---|
1087 |
|
---|
1088 | for (r=0; r<CS_MAXREADER; r++) {
|
---|
1089 | int flt = 0;
|
---|
1090 | if (reader[r].ftab.filts) {
|
---|
1091 | for (j=0; j<CS_MAXFILTERS; j++) {
|
---|
1092 | if (reader[r].ftab.filts[j].caid) {
|
---|
1093 | cd->caid = reader[r].ftab.filts[j].caid;
|
---|
1094 | for (k=0; k<reader[r].ftab.filts[j].nprids; k++) {
|
---|
1095 | cd->provid = reader[r].ftab.filts[j].prids[k];
|
---|
1096 | cs_debug("newcamd: extended: report card");
|
---|
1097 |
|
---|
1098 | network_message_send(client[cs_idx].udp_fd,
|
---|
1099 | &client[cs_idx].ncd_msgid, buf, 3,
|
---|
1100 | client[cs_idx].ncd_skey, COMMTYPE_SERVER, 0, cd);
|
---|
1101 |
|
---|
1102 | flt = 1;
|
---|
1103 | }
|
---|
1104 | }
|
---|
1105 | }
|
---|
1106 | }
|
---|
1107 |
|
---|
1108 | if (reader[r].caid[0] && !flt) {
|
---|
1109 | if ((reader[r].tcp_connected || reader[r].card_status == CARD_INSERTED)) {
|
---|
1110 | cd->caid = reader[r].caid[0];
|
---|
1111 | for (j=0; j<reader[r].nprov; j++) {
|
---|
1112 | if (reader[r].card_status == CARD_INSERTED)
|
---|
1113 | cd->provid = (reader[r].prid[j][1]) << 16
|
---|
1114 | | (reader[r].prid[j][2] << 8) || reader[r].prid[j][3];
|
---|
1115 | else
|
---|
1116 | cd->provid = (reader[r].prid[j][0]) << 16
|
---|
1117 | | (reader[r].prid[j][1] << 8) || reader[r].prid[j][2];
|
---|
1118 |
|
---|
1119 | cs_debug("newcamd: extended: report card");
|
---|
1120 | network_message_send(client[cs_idx].udp_fd,
|
---|
1121 | &client[cs_idx].ncd_msgid, buf, 3,
|
---|
1122 | client[cs_idx].ncd_skey, COMMTYPE_SERVER, 0, cd);
|
---|
1123 | }
|
---|
1124 | }
|
---|
1125 | }
|
---|
1126 | }
|
---|
1127 | free(cd);
|
---|
1128 | }
|
---|
1129 |
|
---|
1130 | // check for clienttimeout, if timeout occurs try to send keepalive / wait for answer
|
---|
1131 | // befor client was disconnected. If keepalive was disabled, exit after clienttimeout
|
---|
1132 | rc=-9;
|
---|
1133 | while(rc==-9)
|
---|
1134 | {
|
---|
1135 | // process_input returns -9 on clienttimeout
|
---|
1136 | while ((rc=process_input(mbuf, sizeof(mbuf), cfg->cmaxidle))>0)
|
---|
1137 | {
|
---|
1138 | switch(mbuf[2])
|
---|
1139 | {
|
---|
1140 | case 0x80:
|
---|
1141 | case 0x81:
|
---|
1142 | newcamd_process_ecm(mbuf);
|
---|
1143 | break;
|
---|
1144 |
|
---|
1145 | case MSG_KEEPALIVE:
|
---|
1146 | newcamd_reply_ka();
|
---|
1147 | break;
|
---|
1148 |
|
---|
1149 | default:
|
---|
1150 | if(mbuf[2]>0x81 && mbuf[2]<0x90)
|
---|
1151 | newcamd_process_emm(mbuf+2);
|
---|
1152 | else
|
---|
1153 | cs_debug("unknown newcamd command! (%d)", mbuf[2]);
|
---|
1154 | }
|
---|
1155 | }
|
---|
1156 |
|
---|
1157 | if(rc==-9)
|
---|
1158 | {
|
---|
1159 | if (client[cs_idx].ncd_keepalive)
|
---|
1160 | newcamd_reply_ka();
|
---|
1161 | else
|
---|
1162 | rc=0;
|
---|
1163 | }
|
---|
1164 | }
|
---|
1165 |
|
---|
1166 | if(req)
|
---|
1167 | {
|
---|
1168 | free(req);
|
---|
1169 | req=0;
|
---|
1170 | }
|
---|
1171 |
|
---|
1172 | cs_disconnect_client();
|
---|
1173 | }
|
---|
1174 |
|
---|
1175 | /*
|
---|
1176 | * client functions
|
---|
1177 | */
|
---|
1178 |
|
---|
1179 | int newcamd_client_init()
|
---|
1180 | {
|
---|
1181 | static struct sockaddr_in loc_sa;
|
---|
1182 | struct protoent *ptrp;
|
---|
1183 | int p_proto;
|
---|
1184 | char ptxt[16];
|
---|
1185 |
|
---|
1186 | pfd=0;
|
---|
1187 | if (reader[ridx].r_port<=0)
|
---|
1188 | {
|
---|
1189 | cs_log("invalid port %d for server %s", reader[ridx].r_port, reader[ridx].device);
|
---|
1190 | return(1);
|
---|
1191 | }
|
---|
1192 | if( (ptrp=getprotobyname("tcp")) )
|
---|
1193 | p_proto=ptrp->p_proto;
|
---|
1194 | else
|
---|
1195 | p_proto=6;
|
---|
1196 |
|
---|
1197 | client[cs_idx].ip=0;
|
---|
1198 | memset((char *)&loc_sa,0,sizeof(loc_sa));
|
---|
1199 | loc_sa.sin_family = AF_INET;
|
---|
1200 | #ifdef LALL
|
---|
1201 | if (cfg->serverip[0])
|
---|
1202 | loc_sa.sin_addr.s_addr = inet_addr(cfg->serverip);
|
---|
1203 | else
|
---|
1204 | #endif
|
---|
1205 | loc_sa.sin_addr.s_addr = INADDR_ANY;
|
---|
1206 | loc_sa.sin_port = htons(reader[ridx].l_port);
|
---|
1207 |
|
---|
1208 | if ((client[cs_idx].udp_fd=socket(PF_INET, SOCK_STREAM, p_proto))<0)
|
---|
1209 | {
|
---|
1210 | cs_log("Socket creation failed (errno=%d)", errno);
|
---|
1211 | cs_exit(1);
|
---|
1212 | }
|
---|
1213 |
|
---|
1214 | #ifdef SO_PRIORITY
|
---|
1215 | if (cfg->netprio)
|
---|
1216 | setsockopt(client[cs_idx].udp_fd, SOL_SOCKET, SO_PRIORITY,
|
---|
1217 | (void *)&cfg->netprio, sizeof(ulong));
|
---|
1218 | #endif
|
---|
1219 | if (!reader[ridx].tcp_ito) {
|
---|
1220 | ulong keep_alive = reader[ridx].tcp_ito?1:0;
|
---|
1221 | setsockopt(client[cs_idx].udp_fd, SOL_SOCKET, SO_KEEPALIVE,
|
---|
1222 | (void *)&keep_alive, sizeof(ulong));
|
---|
1223 | }
|
---|
1224 |
|
---|
1225 | if (reader[ridx].l_port>0)
|
---|
1226 | {
|
---|
1227 | if (bind(client[cs_idx].udp_fd, (struct sockaddr *)&loc_sa, sizeof (loc_sa))<0)
|
---|
1228 | {
|
---|
1229 | cs_log("bind failed (errno=%d)", errno);
|
---|
1230 | close(client[cs_idx].udp_fd);
|
---|
1231 | return(1);
|
---|
1232 | }
|
---|
1233 | sprintf(ptxt, ", port=%d", reader[ridx].l_port);
|
---|
1234 | }
|
---|
1235 | else
|
---|
1236 | ptxt[0]='\0';
|
---|
1237 |
|
---|
1238 | memset((char *)&client[cs_idx].udp_sa,0,sizeof(client[cs_idx].udp_sa));
|
---|
1239 | client[cs_idx].udp_sa.sin_family = AF_INET;
|
---|
1240 | client[cs_idx].udp_sa.sin_port = htons((u_short)reader[ridx].r_port);
|
---|
1241 |
|
---|
1242 | ncd_proto = reader[ridx].ncd_proto;
|
---|
1243 |
|
---|
1244 | cs_log("proxy %s:%d newcamd52%d (fd=%d%s)",
|
---|
1245 | reader[ridx].device, reader[ridx].r_port,
|
---|
1246 | (ncd_proto==NCD_525)?5:4, client[cs_idx].udp_fd, ptxt);
|
---|
1247 | //pfd=client[cs_idx].udp_fd; // !!! we set it after connect() (linux)
|
---|
1248 | return(0);
|
---|
1249 | }
|
---|
1250 |
|
---|
1251 | static int newcamd_send_ecm(ECM_REQUEST *er, uchar *buf)
|
---|
1252 | {
|
---|
1253 | //int rc=(-1);
|
---|
1254 | if (!client[cs_idx].udp_sa.sin_addr.s_addr) // once resolved at least
|
---|
1255 | return(-1);
|
---|
1256 |
|
---|
1257 | // check server filters
|
---|
1258 | if( !newcamd_connect() ) return (-1);
|
---|
1259 |
|
---|
1260 | if( !chk_rsfilter(reader, er, reader[ridx].ncd_disable_server_filt) ) return(-1);
|
---|
1261 |
|
---|
1262 | memcpy(buf, er->ecm, er->l);
|
---|
1263 |
|
---|
1264 | return((newcamd_send(buf, er->l, er->srvid)<1) ? (-1) : 0);
|
---|
1265 | }
|
---|
1266 |
|
---|
1267 |
|
---|
1268 | static int newcamd_send_emm(EMM_PACKET *ep)
|
---|
1269 | {
|
---|
1270 | uchar buf[200];
|
---|
1271 | if (!client[cs_idx].udp_sa.sin_addr.s_addr) // once resolved at least
|
---|
1272 | return(-1);
|
---|
1273 |
|
---|
1274 | // check server filters
|
---|
1275 | if( !newcamd_connect() ) return (-1);
|
---|
1276 |
|
---|
1277 | //if( !chk_rsfilter(er, reader[ridx].ncd_disable_server_filt) ) return(-1);
|
---|
1278 |
|
---|
1279 | memcpy(buf, ep->emm, ep->l);
|
---|
1280 |
|
---|
1281 | return((newcamd_send(buf, ep->l, 0)<1) ? (-1) : 0);
|
---|
1282 | }
|
---|
1283 |
|
---|
1284 | static int newcamd_recv_chk(uchar *dcw, int *rc, uchar *buf, int n)
|
---|
1285 | {
|
---|
1286 | ushort idx;
|
---|
1287 |
|
---|
1288 | if( n<21 ) // no cw, ignore others
|
---|
1289 | return(-1);
|
---|
1290 | *rc = 1;
|
---|
1291 | idx = (buf[0] << 8) | buf[1];
|
---|
1292 | memcpy(dcw, buf+5, 16);
|
---|
1293 | return(idx);
|
---|
1294 | }
|
---|
1295 |
|
---|
1296 | void module_newcamd(struct s_module *ph)
|
---|
1297 | {
|
---|
1298 | strcpy(ph->desc, "newcamd");
|
---|
1299 | ph->type=MOD_CONN_TCP;
|
---|
1300 | ph->logtxt = ", crypted";
|
---|
1301 | ph->multi=1;
|
---|
1302 | ph->watchdog=1;
|
---|
1303 | ph->s_ip=cfg->ncd_srvip;
|
---|
1304 | ph->s_handler=newcamd_server;
|
---|
1305 | ph->recv=newcamd_recv;
|
---|
1306 | ph->send_dcw=newcamd_send_dcw;
|
---|
1307 | ph->ptab=&cfg->ncd_ptab;
|
---|
1308 | if( ph->ptab->nports==0 )
|
---|
1309 | ph->ptab->nports=1; // show disabled in log
|
---|
1310 | ph->c_multi=1;
|
---|
1311 | ph->c_init=newcamd_client_init;
|
---|
1312 | ph->c_recv_chk=newcamd_recv_chk;
|
---|
1313 | ph->c_send_ecm=newcamd_send_ecm;
|
---|
1314 | ph->c_send_emm=newcamd_send_emm;
|
---|
1315 | }
|
---|