1 /*****************************************************************************
2 * remoteosd.c: remote osd over vnc filter module
3 *****************************************************************************
4 * Copyright (C) 2007-2008 Matthias Bauer
7 * Authors: Matthias Bauer <matthias dot bauer #_at_# gmx dot ch>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implid warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
22 *****************************************************************************/
24 /*****************************************************************************
25 * RemoteOSD uses the RFB-Protocol of VNC to display an On-Screen-Display
26 * menu generated by a streaming server as overlay for the streamed video.
28 * The streaming server that implements this is the ffnetdev plugin for VDR.
29 * VDR (VideoDiskRecorder) is an Linux based OpenSource harddisk recorder
31 * The VDR ffnetdev plugin emulates the hardware MPEG decoder and streams the
32 * video over the network instead of hardware video outputs.
33 * The OSD menu of VDR is offered with the RFB protocol to a VNC client.
35 * In fact this video-filter is a simple VNC client that could be also used to
36 * connect to a real VNC host.
37 * Only 8-bit color is supported at the moment.
38 * Using password protected VNC hosts is supported but not recommended, because
39 * you need to insert the used password in the plugin configuration page of
40 * VLC configuration in plain text and it's saved in plain text.
41 *****************************************************************************/
45 /*****************************************************************************
47 *****************************************************************************/
53 #include <vlc_common.h>
54 #include <vlc_plugin.h>
57 #include "vlc_filter.h"
58 #include "filter_common.h"
59 #include "vlc_image.h"
63 #include <vlc_network.h>
64 #include <gcrypt.h> /* to encrypt password */
65 #include <vlc_gcrypt.h>
67 #include "remoteosd_rfbproto.h" /* type definitions of the RFB protocol for VNC */
69 /*****************************************************************************
71 *****************************************************************************/
72 #define READ_BUFFER_SIZE 1000000
74 #define RMTOSD_HOST_TEXT N_("VNC Host")
75 #define RMTOSD_HOST_LONGTEXT N_( \
76 "VNC hostname or IP address." )
78 #define RMTOSD_PORT_TEXT N_("VNC Port")
79 #define RMTOSD_PORT_LONGTEXT N_( \
82 #define RMTOSD_PASSWORD_TEXT N_("VNC Password")
83 #define RMTOSD_PASSWORD_LONGTEXT N_( \
86 #define RMTOSD_UPDATE_TEXT N_("VNC poll interval" )
87 #define RMTOSD_UPDATE_LONGTEXT N_( \
88 "In this interval an update from VNC is requested, default every 300 ms. ")
90 #define RMTOSD_POLL_TEXT N_("VNC polling")
91 #define RMTOSD_POLL_LONGTEXT N_( \
92 "Activate VNC polling. Do NOT activate for use as VDR ffnetdev client." )
94 #define RMTOSD_MOUSE_TEXT N_("Mouse events")
95 #define RMTOSD_MOUSE_LONGTEXT N_( \
96 "Send mouse events to VNC host. Not needed for use as VDR ffnetdev client." )
98 #define RMTOSD_KEYS_TEXT N_("Key events")
99 #define RMTOSD_KEYS_LONGTEXT N_( \
100 "Send key events to VNC host." )
102 #define RMTOSD_ALPHA_TEXT N_("Alpha transparency value (default 255)")
103 #define RMTOSD_ALPHA_LONGTEXT N_( \
104 "The transparency of the OSD VNC can be changed by giving a value " \
105 "between 0 and 255. A lower value specifies more transparency a higher " \
106 "means less transparency. The default is being not transparent " \
107 "(value 255) the minimum is fully transparent (value 0)." )
109 #define RMTOSD_CFG "rmtosd-"
111 #define RMTOSD_UPDATE_MIN 200
112 #define RMTOSD_UPDATE_DEFAULT 1000
113 #define RMTOSD_UPDATE_MAX 300
115 static int CreateFilter ( vlc_object_t * );
116 static void DestroyFilter( vlc_object_t * );
119 set_description( N_("Remote-OSD over VNC") );
120 set_capability( "sub filter", 100 );
121 set_shortname( N_("Remote-OSD") );
122 set_category( CAT_VIDEO );
123 set_subcategory( SUBCAT_VIDEO_SUBPIC );
124 add_shortcut( "rmtosd" );
125 set_callbacks( CreateFilter, DestroyFilter );
127 add_string( RMTOSD_CFG "host", "myvdr", NULL, RMTOSD_HOST_TEXT,
128 RMTOSD_HOST_LONGTEXT, false );
129 add_integer_with_range( RMTOSD_CFG "port", 20001, 1, 0xFFFF, NULL,
130 RMTOSD_PORT_TEXT, RMTOSD_PORT_LONGTEXT, false );
131 add_password( RMTOSD_CFG "password", "", NULL, RMTOSD_PASSWORD_TEXT,
132 RMTOSD_PASSWORD_LONGTEXT, false );
133 add_integer_with_range( RMTOSD_CFG "update", RMTOSD_UPDATE_DEFAULT,
134 RMTOSD_UPDATE_MIN, RMTOSD_UPDATE_MAX, NULL, RMTOSD_UPDATE_TEXT,
135 RMTOSD_UPDATE_LONGTEXT, true );
136 add_bool( RMTOSD_CFG "vnc-polling", 0, NULL,
137 RMTOSD_POLL_TEXT , RMTOSD_POLL_LONGTEXT, false );
138 add_bool( RMTOSD_CFG "mouse-events", 0, NULL,
139 RMTOSD_MOUSE_TEXT , RMTOSD_MOUSE_LONGTEXT, false );
140 add_bool( RMTOSD_CFG "key-events", 0, NULL,
141 RMTOSD_KEYS_TEXT , RMTOSD_KEYS_LONGTEXT, false );
142 add_integer_with_range( RMTOSD_CFG "alpha", 255, 0, 255, NULL,
143 RMTOSD_ALPHA_TEXT, RMTOSD_ALPHA_LONGTEXT, true );
148 /*****************************************************************************
150 *****************************************************************************/
151 #define CHALLENGESIZE 16
152 #define MAX_VNC_SERVER_NAME_LENGTH 255
154 /* subfilter functions */
155 static subpicture_t *Filter( filter_t *, mtime_t );
157 static int MouseEvent ( vlc_object_t *p_this, char const *psz_var,
158 vlc_value_t oldval, vlc_value_t newval, void *p_data );
160 static int KeyEvent( vlc_object_t *p_this, char const *psz_var,
161 vlc_value_t oldval, vlc_value_t newval, void *p_data );
163 static void stop_osdvnc ( filter_t *p_filter );
165 static void* vnc_worker_thread ( vlc_object_t *p_thread_obj );
167 static void* update_request_thread( vlc_object_t *p_thread_obj );
169 static bool open_vnc_connection ( filter_t *p_filter );
171 static bool handshaking ( filter_t *p_filter );
173 static bool process_server_message ( filter_t *p_filter,
174 rfbServerToClientMsg *msg );
176 static inline void rgb_to_yuv( uint8_t *y, uint8_t *u, uint8_t *v,
177 int r, int g, int b );
179 static inline bool fill_rect( filter_sys_t* p_sys,
180 uint16_t i_x, uint16_t i_y,
181 uint16_t i_w, uint16_t i_h,
183 static inline bool copy_rect( filter_sys_t* p_sys,
184 uint16_t i_x, uint16_t i_y,
185 uint16_t i_w, uint16_t i_h,
186 uint16_t i_sx, uint16_t i_sy );
189 static inline bool raw_line( filter_sys_t* p_sys,
190 uint16_t i_x, uint16_t i_y,
193 static void vnc_encrypt_bytes( unsigned char *bytes, char *passwd );
196 /*****************************************************************************
198 *****************************************************************************/
200 /*****************************************************************************
202 *****************************************************************************/
207 bool b_need_update; /* VNC picture is updated, do update the OSD*/
208 mtime_t i_vnc_poll_interval; /* Update the OSD menu every n ms */
210 uint8_t i_alpha; /* alpha transparency value */
212 char *psz_host; /* VNC host */
215 char *psz_passwd; /* VNC password */
217 bool b_vnc_poll; /* Activate VNC polling ? */
218 bool b_vnc_mouse_events; /* Send MouseEvents ? */
219 bool b_vnc_key_events; /* Send KeyEvents ? */
221 bool b_connection_active; /* Handshaking finished ? */
223 vlc_mutex_t lock; /* To lock for read/write on picture */
225 picture_t *p_pic; /* The picture with OSD data from VNC */
227 vout_thread_t *p_vout; /* Pointer to video-out thread */
229 int i_socket; /* Socket used for VNC */
231 uint16_t i_vnc_width; /* The with of the VNC screen */
232 uint16_t i_vnc_height; /* The height of the VNC screen */
233 uint32_t i_vnc_pixels; /* The pixels of the VNC screen */
235 bool b_alpha_from_vnc; /* Special ffnetdev alpha feature enabled ? */
237 char read_buffer[READ_BUFFER_SIZE];
241 vlc_object_t* p_worker_thread;
243 uint8_t ar_color_table_yuv[256][4];
246 /*****************************************************************************
247 * CreateFilter: Create the filter and open the definition file
248 *****************************************************************************/
249 static int CreateFilter ( vlc_object_t *p_this )
251 filter_t *p_filter = (filter_t *)p_this;
252 filter_sys_t *p_sys = NULL;
254 msg_Dbg( p_filter, "Creating vnc osd filter..." );
256 p_filter->p_sys = p_sys = malloc( sizeof(*p_sys) );
257 if( !p_filter->p_sys )
259 memset( p_sys, 0, sizeof(*p_sys) );
261 /* Populating struct */
262 vlc_mutex_init( &p_sys->lock );
263 p_sys->b_continue = true;
264 p_sys->i_socket = -1;
267 p_sys->psz_host = var_CreateGetString( p_this, RMTOSD_CFG "host" );
268 if( EMPTY_STR(p_sys->psz_host) )
270 msg_Err( p_filter, "unable to get vnc host" );
274 p_sys->psz_passwd = var_CreateGetString( p_this, RMTOSD_CFG "password" );
275 if( !p_sys->psz_passwd )
277 msg_Err( p_filter, "unable to get vnc password" );
281 p_sys->i_port = var_CreateGetIntegerCommand( p_this, RMTOSD_CFG "port" );
283 p_sys->i_alpha = var_CreateGetIntegerCommand( p_this, RMTOSD_CFG "alpha" );
285 /* in miliseconds, 0 disables polling, should not be lower than 100 */
286 p_sys->i_vnc_poll_interval = var_CreateGetIntegerCommand( p_this,
287 RMTOSD_CFG "update" );
288 if ( p_sys->i_vnc_poll_interval < 100)
290 p_sys->i_vnc_poll_interval = 100;
293 for ( int i = 0; i < 256; i++ )
295 p_sys->ar_color_table_yuv[i][0] = 255;
296 p_sys->ar_color_table_yuv[i][1] = 255;
297 p_sys->ar_color_table_yuv[i][2] = 255;
298 p_sys->ar_color_table_yuv[i][3] = 255;
301 p_sys->b_vnc_poll = var_CreateGetBoolCommand( p_this,
302 RMTOSD_CFG "vnc-polling" );
303 p_sys->b_vnc_mouse_events = var_CreateGetBoolCommand( p_this,
304 RMTOSD_CFG "mouse-events" );
305 p_sys->b_vnc_key_events = var_CreateGetBoolCommand( p_this,
306 RMTOSD_CFG "key-events" );
308 /* Keep track of OSD Events */
309 p_sys->b_need_update = false;
311 /* Attach subpicture filter callback */
312 p_filter->pf_sub_filter = Filter;
314 p_sys->p_vout = vlc_object_find( p_this, VLC_OBJECT_VOUT, FIND_PARENT );
318 var_AddCallback( p_sys->p_vout, "mouse-moved",
319 MouseEvent, p_this );
320 var_AddCallback( p_sys->p_vout, "mouse-button-down",
321 MouseEvent, p_this );
322 var_AddCallback( p_sys->p_vout->p_libvlc, "key-pressed",
326 es_format_Init( &p_filter->fmt_out, SPU_ES, VLC_FOURCC( 's','p','u',' ' ) );
327 p_filter->fmt_out.i_priority = 0;
331 /* create the vnc worker thread */
332 p_sys->p_worker_thread = vlc_object_create( p_this,
333 sizeof( vlc_object_t ) );
334 vlc_object_attach( p_sys->p_worker_thread, p_this );
335 if( vlc_thread_create( p_sys->p_worker_thread, "vnc worker thread",
337 VLC_THREAD_PRIORITY_LOW, false ) )
339 vlc_object_detach( p_sys->p_worker_thread );
340 vlc_object_release( p_sys->p_worker_thread );
341 msg_Err( p_filter, "cannot spawn vnc message reader thread" );
345 msg_Dbg( p_filter, "osdvnc filter started" );
350 msg_Err( p_filter, "osdvnc filter discarded" );
352 stop_osdvnc( p_filter );
354 vlc_mutex_destroy( &p_sys->lock );
355 free( p_sys->psz_host );
356 free( p_sys->psz_passwd );
362 /*****************************************************************************
363 * DestroyFilter: Make a clean exit of this plugin
364 *****************************************************************************/
365 static void DestroyFilter( vlc_object_t *p_this )
367 filter_t *p_filter = (filter_t*)p_this;
368 filter_sys_t *p_sys = p_filter->p_sys;
370 msg_Dbg( p_filter, "DestroyFilter called." );
372 stop_osdvnc( p_filter );
376 var_DelCallback( p_sys->p_vout, "mouse-moved",
377 MouseEvent, p_this );
378 var_DelCallback( p_sys->p_vout, "mouse-button-down",
379 MouseEvent, p_this );
380 var_DelCallback( p_sys->p_vout->p_libvlc, "key-pressed",
383 vlc_object_release( p_sys->p_vout );
386 var_Destroy( p_this, RMTOSD_CFG "host" );
387 var_Destroy( p_this, RMTOSD_CFG "port" );
388 var_Destroy( p_this, RMTOSD_CFG "password" );
389 var_Destroy( p_this, RMTOSD_CFG "update" );
390 var_Destroy( p_this, RMTOSD_CFG "vnc-polling" );
391 var_Destroy( p_this, RMTOSD_CFG "mouse-events" );
392 var_Destroy( p_this, RMTOSD_CFG "key-events" );
393 var_Destroy( p_this, RMTOSD_CFG "alpha" );
395 vlc_mutex_destroy( &p_sys->lock );
396 free( p_sys->psz_host );
397 free( p_sys->psz_passwd );
401 static void stop_osdvnc ( filter_t *p_filter )
403 filter_sys_t *p_sys = p_filter->p_sys;
405 /* It will unlock socket reading */
406 vlc_object_kill( p_filter );
409 if( p_sys->p_worker_thread )
411 msg_Dbg( p_filter, "joining worker_thread" );
412 vlc_object_kill( p_sys->p_worker_thread );
413 vlc_thread_join( p_sys->p_worker_thread );
414 vlc_object_detach( p_sys->p_worker_thread );
415 vlc_object_release( p_sys->p_worker_thread );
416 msg_Dbg( p_filter, "released worker_thread" );
419 msg_Dbg( p_filter, "osdvnc stopped" );
422 static bool read_exact( filter_t *p_filter,
427 return i_bytes == net_Read( p_filter, i_socket, NULL,
428 (unsigned char*)p_readbuf,
433 static bool write_exact( filter_t *p_filter,
438 return i_bytes == net_Write( p_filter, i_socket, NULL,
439 (unsigned char*)p_writebuf, i_bytes );
442 static bool open_vnc_connection ( filter_t *p_filter )
444 filter_sys_t *p_sys = p_filter->p_sys;
446 msg_Dbg( p_filter, "Open socket to vnc server on %s:%u.",
447 p_sys->psz_host, p_sys->i_port );
449 p_sys->i_socket = net_ConnectTCP( p_filter, p_sys->psz_host, p_sys->i_port );
451 if( p_sys->i_socket < 0 )
453 msg_Err( p_filter, "Could not open socket" );
457 msg_Dbg( p_filter, "socket is open." );
462 static bool handshaking ( filter_t *p_filter )
464 filter_sys_t *p_sys = p_filter->p_sys;
466 msg_Dbg( p_filter, "Reading protocol version" );
468 rfbProtocolVersionMsg pv;
469 if ( !read_exact( p_filter, p_sys->i_socket, pv,
470 sz_rfbProtocolVersionMsg ) )
472 msg_Err( p_filter, "Could not read version message" );
475 pv[sz_rfbProtocolVersionMsg] = '\0'; /* pv size is sz_rfbProtocolVersionMsg+1 */
477 msg_Dbg( p_filter, "Server version is %s", pv );
479 strncpy(pv, "RFB 003.003\n", sz_rfbProtocolVersionMsg);
481 if( !write_exact(p_filter, p_sys->i_socket, pv,
482 sz_rfbProtocolVersionMsg) )
484 msg_Err( p_filter, "Could not write version message" );
488 msg_Dbg( p_filter, "Reading authentication scheme" );
489 uint32_t i_authScheme;
490 if( !read_exact( p_filter, p_sys->i_socket, (char*)&i_authScheme, 4 ) )
492 msg_Err( p_filter, "Could not read authentication scheme" );
495 i_authScheme = htonl(i_authScheme);
497 msg_Dbg( p_filter, "Authentication scheme = %x", i_authScheme );
498 if ( i_authScheme == rfbConnFailed )
500 msg_Err( p_filter, "Connection rejected by server" );
503 if (i_authScheme == rfbVncAuth)
505 unsigned char challenge[CHALLENGESIZE];
506 if ( !read_exact( p_filter, p_sys->i_socket,
507 (char*)challenge, CHALLENGESIZE ) )
509 msg_Err( p_filter, "Could not read password challenge" );
513 vnc_encrypt_bytes( challenge, p_sys->psz_passwd );
515 if( !write_exact(p_filter, p_sys->i_socket,
516 (char*)challenge, CHALLENGESIZE ) )
518 msg_Err( p_filter, "Could not write password" );
521 uint32_t i_authResult;
522 if( !read_exact( p_filter, p_sys->i_socket, (char*)&i_authResult, 4 ) )
524 msg_Err( p_filter, "Could not read authentication result" );
527 i_authResult = htonl(i_authResult);
528 if (i_authResult != rfbVncAuthOK)
530 msg_Err( p_filter, "VNC authentication failed" );
535 msg_Dbg( p_filter, "Writing client init message" );
538 if( !write_exact( p_filter, p_sys->i_socket,
539 (char*)&ci, sz_rfbClientInitMsg ) )
541 msg_Err( p_filter, "Could not write client init message" );
545 msg_Dbg( p_filter, "Reading server init message" );
547 if( !read_exact( p_filter, p_sys->i_socket,
548 (char*)&si, sz_rfbServerInitMsg ) )
550 msg_Err( p_filter, "Could not read server init message" );
553 si.framebufferWidth = htons(si.framebufferWidth);
554 si.framebufferHeight = htons(si.framebufferHeight);
555 si.format.redMax = htons(si.format.redMax);
556 si.format.greenMax = htons(si.format.greenMax);
557 si.format.blueMax = htons(si.format.blueMax);
559 p_sys->i_vnc_width = si.framebufferWidth;
560 p_sys->i_vnc_height = si.framebufferHeight;
562 msg_Dbg( p_filter, "Servers preferred pixelformat: "
563 "%ux%u, R(%u),G(%u),B(%u), %u bit, depht=%u, %s",
565 si.framebufferHeight,
569 si.format.bitsPerPixel,
571 si.format.trueColour ? "TrueColor" : "Not-TrueColor");
573 uint32_t i_nameLength = htonl(si.nameLength);
574 if( i_nameLength > MAX_VNC_SERVER_NAME_LENGTH )
576 msg_Err( p_filter, "Server name too long" );
579 char s_ServerName[MAX_VNC_SERVER_NAME_LENGTH+1];
581 msg_Dbg( p_filter, "Reading server name with size = %u", i_nameLength );
582 if( !read_exact( p_filter, p_sys->i_socket, s_ServerName, i_nameLength ) )
584 msg_Err( p_filter, "Could not read server name" );
587 s_ServerName[i_nameLength] = '\0';
589 if( strcmp( s_ServerName, "VDR-OSD") == 0 )
591 msg_Dbg( p_filter, "Server is a VDR" );
592 p_sys->b_alpha_from_vnc = true;
596 msg_Dbg( p_filter, "Server is a normal VNC" );
597 p_sys->b_alpha_from_vnc = false;
601 msg_Dbg( p_filter, "Server init message read properly" );
602 msg_Dbg( p_filter, "Server name is %s", s_ServerName );
604 msg_Dbg( p_filter, "Writing SetPixelFormat message" );
606 rfbSetPixelFormatMsg sp;
607 sp.type = rfbSetPixelFormat;
608 sp.pad1 = sp.pad2 = 0;
609 sp.format.bitsPerPixel = 8;
610 sp.format.depth = 8 ;
611 sp.format.bigEndian = 1;
612 sp.format.trueColour = 0;
613 sp.format.redMax = htons(31);
614 sp.format.greenMax = htons(31);
615 sp.format.blueMax = htons(31);
616 sp.format.redShift = 10;
617 sp.format.greenShift = 5;
618 sp.format.blueShift = 0;
619 sp.format.pad1 = sp.format.pad2 = 0;
621 if( !write_exact( p_filter, p_sys->i_socket,
622 (char*)&sp, sz_rfbSetPixelFormatMsg) )
624 msg_Err( p_filter, "Could not write SetPixelFormat message" );
628 msg_Dbg( p_filter, "Writing SetEncodings message" );
630 rfbSetEncodingsMsg se;
631 se.type = rfbSetEncodings;
633 se.nEncodings = htons( p_sys->b_alpha_from_vnc ? 3 : 2 );
635 if( !write_exact( p_filter, p_sys->i_socket,
636 (char*)&se, sz_rfbSetEncodingsMsg) )
638 msg_Err( p_filter, "Could not write SetEncodings message begin" );
644 msg_Dbg( p_filter, "Writing SetEncodings rfbEncodingCopyRect" );
645 i_encoding = htonl(rfbEncodingCopyRect);
646 if( !write_exact( p_filter, p_sys->i_socket, (char*)&i_encoding, 4) )
648 msg_Err( p_filter, "Could not write encoding type rfbEncodingCopyRect." );
652 msg_Dbg( p_filter, "Writing SetEncodings rfbEncodingRRE" );
653 i_encoding = htonl(rfbEncodingRRE);
654 if( !write_exact(p_filter, p_sys->i_socket, (char*)&i_encoding, 4) )
656 msg_Err( p_filter, "Could not write encoding type rfbEncodingRRE." );
660 if( p_sys->b_alpha_from_vnc )
662 msg_Dbg( p_filter, "Writing SetEncodings rfbEncSpecialUseAlpha" );
663 i_encoding = 0x00F0FFFF; /* rfbEncSpecialUseAlpha is 0xFFFFF000
664 * before we swap it */
665 if( !write_exact(p_filter, p_sys->i_socket, (char*)&i_encoding, 4) )
667 msg_Err( p_filter, "Could not write encoding type rfbEncSpecialUseAlpha." );
675 static void* vnc_worker_thread( vlc_object_t *p_thread_obj )
677 filter_t* p_filter = (filter_t*)(p_thread_obj->p_parent);
678 filter_sys_t *p_sys = p_filter->p_sys;
679 vlc_object_t *p_update_request_thread;
681 msg_Dbg( p_filter, "VNC worker thread started" );
683 if( !open_vnc_connection ( p_filter ) )
685 msg_Err( p_filter, "Could not connect to vnc host" );
689 if( !handshaking ( p_filter ) )
691 msg_Err( p_filter, "Error occured while handshaking vnc host" );
695 p_sys->b_connection_active = true; /* to enable sending key
696 * and mouse events to host */
698 /* Create an empty picture for VNC the data */
699 vlc_mutex_lock( &p_sys->lock );
700 p_sys->p_pic = picture_New( VLC_FOURCC('Y','U','V','A'),
701 p_sys->i_vnc_width, p_sys->i_vnc_height, VOUT_ASPECT_FACTOR );
704 vlc_mutex_unlock( &p_sys->lock );
707 p_sys->i_vnc_pixels = p_sys->i_vnc_width * p_sys->i_vnc_height;
709 vlc_mutex_unlock( &p_sys->lock );
711 /* create the update request thread */
712 p_update_request_thread = vlc_object_create( p_filter,
713 sizeof( vlc_object_t ) );
714 vlc_object_attach( p_update_request_thread, p_filter );
715 if( vlc_thread_create( p_update_request_thread,
716 "vnc update request thread",
717 update_request_thread,
718 VLC_THREAD_PRIORITY_LOW, false ) )
720 vlc_object_detach( p_update_request_thread );
721 vlc_object_release( p_update_request_thread );
722 msg_Err( p_filter, "cannot spawn vnc update request thread" );
726 /* connection is initialized, now read and handle server messages */
727 while( vlc_object_alive( p_thread_obj ) )
729 rfbServerToClientMsg msg;
732 memset( &msg, 0, sizeof(msg) );
734 if( !read_exact(p_filter, p_sys->i_socket, (char*)&msg, 1 ) )
736 msg_Err( p_filter, "Error while waiting for next server message");
741 case rfbFramebufferUpdate:
742 i_msgSize = sz_rfbFramebufferUpdateMsg;
744 case rfbSetColourMapEntries:
745 i_msgSize = sz_rfbSetColourMapEntriesMsg;
748 i_msgSize = sz_rfbBellMsg;
750 case rfbServerCutText:
751 i_msgSize = sz_rfbServerCutTextMsg;
753 case rfbReSizeFrameBuffer:
754 i_msgSize = sz_rfbReSizeFrameBufferMsg;
758 msg_Err( p_filter, "Invalid message %u received", msg.type );
765 if( --i_msgSize > 0 )
767 if ( !read_exact( p_filter, p_sys->i_socket,
768 ((char*)&msg)+1, i_msgSize ) )
770 msg_Err( p_filter, "Error while reading message of type %u",
775 process_server_message( p_filter, &msg);
778 msg_Dbg( p_filter, "joining update_request_thread" );
779 vlc_object_kill( p_update_request_thread );
780 vlc_thread_join( p_update_request_thread );
781 vlc_object_detach( p_update_request_thread );
782 vlc_object_release( p_update_request_thread );
783 msg_Dbg( p_filter, "released update_request_thread" );
787 vlc_mutex_lock( &p_sys->lock );
788 p_sys->b_connection_active = false;
790 if (p_sys->i_socket >= 0)
791 net_Close(p_sys->i_socket);
794 picture_Release( p_sys->p_pic );
796 /* It will hide the subtitle */
797 p_sys->b_continue = false;
798 p_sys->b_need_update = true;
799 vlc_mutex_unlock( &p_sys->lock );
801 msg_Dbg( p_filter, "VNC message reader thread ended" );
805 static void* update_request_thread( vlc_object_t *p_thread_obj )
807 filter_t* p_filter = (filter_t*)(p_thread_obj->p_parent);
808 filter_sys_t *p_sys = p_filter->p_sys;
810 msg_Dbg( p_filter, "VNC update request thread started" );
812 rfbFramebufferUpdateRequestMsg udr;
813 udr.type = rfbFramebufferUpdateRequest;
817 udr.w = htons(p_sys->i_vnc_width);
818 udr.h = htons(p_sys->i_vnc_height);
820 if( write_exact(p_filter, p_sys->i_socket, (char*)&udr,
821 sz_rfbFramebufferUpdateRequestMsg) == false)
823 msg_Err( p_filter, "Could not write rfbFramebufferUpdateRequestMsg." );
824 p_sys->b_continue = false;
829 mtime_t i_poll_interval_microsec = p_sys->i_vnc_poll_interval * 1000;
831 if( p_sys->b_vnc_poll)
833 while( vlc_object_alive( p_thread_obj ) )
835 msleep( i_poll_interval_microsec );
836 if( write_exact(p_filter, p_sys->i_socket, (char*)&udr,
837 sz_rfbFramebufferUpdateRequestMsg) == false)
839 msg_Err( p_filter, "Could not write rfbFramebufferUpdateRequestMsg." );
843 p_sys->b_continue = false;
847 msg_Dbg( p_filter, "VNC polling disabled." );
850 msg_Dbg( p_filter, "VNC update request thread ended" );
854 static bool process_server_message ( filter_t *p_filter,
855 rfbServerToClientMsg *msg )
857 filter_sys_t *p_sys = p_filter->p_sys;
861 case rfbFramebufferUpdate:
863 msg->fu.nRects = htons(msg->fu.nRects);
864 rfbFramebufferUpdateRectHeader hdr;
866 for (int i_rect = 0; i_rect < msg->fu.nRects; i_rect++)
868 if (!read_exact(p_filter, p_sys->i_socket, (char*)&hdr,
869 sz_rfbFramebufferUpdateRectHeader ) )
871 msg_Err( p_filter, "Could not read FrameBufferUpdate header" );
874 hdr.r.x = htons(hdr.r.x);
875 hdr.r.y = htons(hdr.r.y);
876 hdr.r.w = htons(hdr.r.w);
877 hdr.r.h = htons(hdr.r.h);
878 hdr.encoding = htonl(hdr.encoding);
880 switch (hdr.encoding)
885 for (i_line = 0; i_line < hdr.r.h; i_line++)
887 if ( !read_exact( p_filter, p_sys->i_socket,
888 p_sys->read_buffer, hdr.r.w ) )
891 "Could not read FrameBufferUpdate line data" );
894 vlc_mutex_lock( &p_sys->lock );
895 if ( !raw_line( p_sys, hdr.r.x,
899 msg_Err( p_filter, "raw_line failed." );
900 vlc_mutex_unlock( &p_sys->lock );
903 vlc_mutex_unlock( &p_sys->lock );
908 case rfbEncodingCopyRect:
912 if ( !read_exact( p_filter, p_sys->i_socket,
916 msg_Err( p_filter, "Could not read rfbCopyRect" );
919 rect.srcX = htons( rect.srcX );
920 rect.srcY = htons( rect.srcY );
922 vlc_mutex_lock( &p_sys->lock );
923 if ( !copy_rect( p_sys,
926 rect.srcX, rect.srcY ) )
928 msg_Err( p_filter, "copy_rect failed." );
929 vlc_mutex_unlock( &p_sys->lock );
932 vlc_mutex_unlock( &p_sys->lock );
939 if ( !read_exact( p_filter, p_sys->i_socket,
943 msg_Err( p_filter, "Could not read rfbRREHeader" );
947 if ( !read_exact(p_filter, p_sys->i_socket,
948 (char*)&i_pixcolor, 1 ) )
950 msg_Err( p_filter, "Could not read RRE pixcolor" );
954 vlc_mutex_lock( &p_sys->lock );
955 if ( !fill_rect( p_sys,
960 msg_Err( p_filter, "main fill_rect failed." );
961 vlc_mutex_unlock( &p_sys->lock );
964 vlc_mutex_unlock( &p_sys->lock );
966 rrehdr.nSubrects = htonl(rrehdr.nSubrects);
968 int i_datasize = rrehdr.nSubrects *
969 ( sizeof(i_pixcolor) + sz_rfbRectangle ) ;
970 if ( i_datasize > READ_BUFFER_SIZE )
972 msg_Err( p_filter, "Buffer too small, "
973 "need %u bytes", i_datasize );
976 if ( !read_exact( p_filter, p_sys->i_socket,
977 p_sys->read_buffer, i_datasize ) )
980 "Could not read RRE subrect data" );
985 rfbRectangle* p_subrect;
987 vlc_mutex_lock( &p_sys->lock );
989 i_subrect < rrehdr.nSubrects; i_subrect++)
991 i_pixcolor = p_sys->read_buffer[i_offset];
992 i_offset += sizeof(i_pixcolor);
994 (rfbRectangle*)(p_sys->read_buffer + i_offset);
995 i_offset += sz_rfbRectangle;
997 if (!fill_rect( p_sys,
998 htons(p_subrect->x) + hdr.r.x,
999 htons(p_subrect->y) + hdr.r.y,
1000 htons(p_subrect->w),
1001 htons(p_subrect->h),
1005 "subrect %u fill_rect failed.", i_subrect );
1006 vlc_mutex_unlock( &p_sys->lock );
1010 vlc_mutex_unlock( &p_sys->lock );
1017 vlc_mutex_lock( &p_sys->lock );
1018 p_sys->b_need_update = true;
1019 vlc_mutex_unlock( &p_sys->lock );
1023 case rfbSetColourMapEntries:
1025 msg->scme.nColours = htons(msg->scme.nColours);
1026 msg->scme.firstColour = htons(msg->scme.firstColour);
1028 if ( p_sys->b_alpha_from_vnc == true )
1030 i_datasize = 2 * msg->scme.nColours * 4;
1034 i_datasize = 2 * msg->scme.nColours * 3;
1036 if ( i_datasize > READ_BUFFER_SIZE )
1038 msg_Err( p_filter, "Buffer too small, need %u bytes",
1043 if ( !read_exact( p_filter, p_sys->i_socket,
1044 p_sys->read_buffer, i_datasize ) )
1046 msg_Err( p_filter, "Could not read color map data" );
1050 uint8_t i_red, i_green, i_blue, i_alpha, i_color_index;
1051 uint16_t i_offset = 0;
1054 for (int i = 0; i < msg->scme.nColours; i++)
1056 i_color_index = i+msg->scme.firstColour;
1057 if ( p_sys->b_alpha_from_vnc == true )
1059 i_alpha = p_sys->read_buffer[i_offset];
1062 i_red = p_sys->read_buffer[i_offset];
1064 i_green = p_sys->read_buffer[i_offset];
1066 i_blue = p_sys->read_buffer[i_offset];
1068 rgb_to_yuv( &p_sys->ar_color_table_yuv[i_color_index][0],
1069 &p_sys->ar_color_table_yuv[i_color_index][1],
1070 &p_sys->ar_color_table_yuv[i_color_index][2],
1074 p_sys->ar_color_table_yuv[i][3] = i_alpha;
1080 msg_Err( p_filter, "rfbBell received" );
1083 case rfbServerCutText:
1084 msg->sct.length = htons(msg->sct.length);
1085 if ( msg->sct.length > READ_BUFFER_SIZE )
1087 msg_Err( p_filter, "Buffer too small, need %u bytes", msg->sct.length );
1090 if ( !read_exact(p_filter, p_sys->i_socket,
1091 p_sys->read_buffer, msg->sct.length ) )
1093 msg_Err( p_filter, "Could not read Reading rfbServerCutText data" );
1098 case rfbReSizeFrameBuffer:
1099 msg_Err( p_filter, "Reading rfbReSizeFrameBuffer not implemented" );
1103 msg_Err( p_filter, "Invalid message %u received", msg->type );
1109 /****************************************************************************
1110 * Filter: the whole thing
1111 ****************************************************************************
1112 * This function outputs subpictures at regular time intervals.
1113 ****************************************************************************/
1114 static subpicture_t *Filter( filter_t *p_filter, mtime_t date )
1116 filter_sys_t *p_sys = p_filter->p_sys;
1117 subpicture_t *p_spu;
1118 subpicture_region_t *p_region;
1122 if( !p_sys->b_need_update )
1127 vlc_mutex_lock( &p_sys->lock );
1129 p_pic = p_sys->p_pic;
1133 vlc_mutex_unlock( &p_sys->lock );
1137 /* Allocate the subpicture internal data. */
1138 p_spu = filter_NewSubpicture( p_filter );
1141 vlc_mutex_unlock( &p_sys->lock );
1145 p_spu->b_absolute = false;
1146 p_spu->i_start = date;
1148 p_spu->b_ephemer = true;
1150 if( !p_sys->b_continue )
1151 p_spu->i_stop = p_spu->i_start + 1;
1153 /* Create new SPU region */
1154 memset( &fmt, 0, sizeof(video_format_t) );
1155 fmt.i_chroma = VLC_FOURCC('Y','U','V','A');
1156 fmt.i_aspect = VOUT_ASPECT_FACTOR;
1157 fmt.i_sar_num = fmt.i_sar_den = 1;
1158 fmt.i_width = fmt.i_visible_width = p_pic->p[Y_PLANE].i_visible_pitch;
1159 fmt.i_height = fmt.i_visible_height = p_pic->p[Y_PLANE].i_visible_lines;
1160 fmt.i_x_offset = fmt.i_y_offset = 0;
1161 p_region = p_spu->pf_create_region( VLC_OBJECT(p_filter), &fmt );
1164 msg_Err( p_filter, "cannot allocate SPU region" );
1165 p_filter->pf_sub_buffer_del( p_filter, p_spu );
1166 vlc_mutex_unlock( &p_sys->lock );
1170 vout_CopyPicture( p_filter, &p_region->picture, p_pic );
1172 p_sys->b_need_update = false;
1174 vlc_mutex_unlock( &p_sys->lock );
1176 /* set to one of the 9 relative locations */
1177 p_region->i_align = 0; /* Center */
1178 p_spu->b_absolute = false;
1183 p_spu->i_original_picture_width = 0; /*Let vout core do the horizontal scaling */
1184 p_spu->i_original_picture_height = fmt.i_height;
1186 p_spu->p_region = p_region;
1188 p_spu->i_alpha = ( p_sys->i_alpha );
1194 static inline void rgb_to_yuv( uint8_t *y, uint8_t *u, uint8_t *v,
1195 int r, int g, int b )
1197 *y = ( ( ( 66 * r + 129 * g + 25 * b + 128 ) >> 8 ) + 16 );
1198 *u = ( ( -38 * r - 74 * g + 112 * b + 128 ) >> 8 ) + 128 ;
1199 *v = ( ( 112 * r - 94 * g - 18 * b + 128 ) >> 8 ) + 128 ;
1202 static inline bool fill_rect( filter_sys_t* p_sys,
1203 uint16_t i_x, uint16_t i_y,
1204 uint16_t i_w, uint16_t i_h,
1207 plane_t *p_outY = p_sys->p_pic->p+Y_PLANE;
1208 plane_t *p_outU = p_sys->p_pic->p+U_PLANE;
1209 plane_t *p_outV = p_sys->p_pic->p+V_PLANE;
1210 plane_t *p_outA = p_sys->p_pic->p+A_PLANE;
1211 int i_pitch = p_outY->i_pitch;
1212 int i_lines = p_outY->i_lines;
1213 if ( i_x + i_w > i_pitch)
1215 if ( i_y + i_h > i_lines)
1217 int i_line_offset = i_y * i_pitch;
1218 uint8_t i_yuv_y = p_sys->ar_color_table_yuv[i_color][0];
1219 uint8_t i_yuv_u = p_sys->ar_color_table_yuv[i_color][1];
1220 uint8_t i_yuv_v = p_sys->ar_color_table_yuv[i_color][2];
1221 uint8_t i_alpha = p_sys->ar_color_table_yuv[i_color][3];
1222 for( int i_line = 0; i_line < i_h; i_line++ )
1224 for( int i_column = 0; i_column < i_w; i_column++ )
1226 int i_total_offset = i_line_offset + i_x + i_column;
1227 p_outY->p_pixels[ i_total_offset ] = i_yuv_y;
1228 p_outU->p_pixels[ i_total_offset ] = i_yuv_u;
1229 p_outV->p_pixels[ i_total_offset ] = i_yuv_v;
1230 p_outA->p_pixels[ i_total_offset ] = i_alpha;
1232 i_line_offset += i_pitch;
1237 static inline bool copy_rect( filter_sys_t* p_sys,
1238 uint16_t i_x, uint16_t i_y,
1239 uint16_t i_w, uint16_t i_h,
1240 uint16_t i_sx, uint16_t i_sy )
1242 plane_t *p_Y = p_sys->p_pic->p+Y_PLANE;
1243 plane_t *p_U = p_sys->p_pic->p+U_PLANE;
1244 plane_t *p_V = p_sys->p_pic->p+V_PLANE;
1245 plane_t *p_A = p_sys->p_pic->p+A_PLANE;
1247 int i_pitch = p_Y->i_pitch;
1248 int i_lines = p_Y->i_lines;
1250 fprintf( stderr, "copy_rect: (%d,%d)+(%d,%d) -> (%d,%d)\n", i_x, i_y, i_w, i_h, i_sx, i_sy );
1252 if( i_x + i_w > i_pitch || i_sx + i_w > i_pitch )
1254 if( i_y + i_h > i_lines || i_sy + i_h > i_lines)
1257 if( i_w <= 0 || i_h <= 0 )
1260 uint8_t *pb_buffer = calloc( i_w * i_h, 4 );
1264 for( int i_line = 0; i_line < i_h; i_line++ )
1266 for( int i_column = 0; i_column < i_w; i_column++ )
1268 const int i_src_offset = ( i_sy + i_line ) * i_pitch + i_sx + i_column;
1269 const int i_tmp_offset = ( 0 + i_line ) * i_w + 0 + i_column;
1271 pb_buffer[4*i_tmp_offset + 0] = p_Y->p_pixels[i_src_offset];
1272 pb_buffer[4*i_tmp_offset + 1] = p_U->p_pixels[i_src_offset];
1273 pb_buffer[4*i_tmp_offset + 2] = p_V->p_pixels[i_src_offset];
1274 pb_buffer[4*i_tmp_offset + 3] = p_A->p_pixels[i_src_offset];
1278 for( int i_line = 0; i_line < i_h; i_line++ )
1280 for( int i_column = 0; i_column < i_w; i_column++ )
1282 const int i_tmp_offset = ( 0 + i_line ) * i_w + 0 + i_column;
1283 const int i_dst_offset = ( i_y + i_line ) * i_pitch + i_x + i_column;
1285 p_Y->p_pixels[i_dst_offset] = pb_buffer[4*i_tmp_offset + 0];
1286 p_U->p_pixels[i_dst_offset] = pb_buffer[4*i_tmp_offset + 1];
1287 p_V->p_pixels[i_dst_offset] = pb_buffer[4*i_tmp_offset + 2];
1288 p_A->p_pixels[i_dst_offset] = pb_buffer[4*i_tmp_offset + 3];
1296 static inline bool raw_line( filter_sys_t* p_sys,
1297 uint16_t i_x, uint16_t i_y,
1300 plane_t *p_outY = p_sys->p_pic->p+Y_PLANE;
1301 plane_t *p_outU = p_sys->p_pic->p+U_PLANE;
1302 plane_t *p_outV = p_sys->p_pic->p+V_PLANE;
1303 plane_t *p_outA = p_sys->p_pic->p+A_PLANE;
1304 int i_pitch = p_outY->i_pitch;
1305 int i_lines = p_outY->i_lines;
1306 if ( i_x + i_w > i_pitch)
1311 int i_line_offset = i_y * i_pitch + i_x;
1313 for( int i_column = 0; i_column < i_w; i_column++ )
1315 int i_offset = i_line_offset + i_column;
1316 uint8_t i_color = p_sys->read_buffer[i_column];
1317 p_outY->p_pixels[ i_offset ] = p_sys->ar_color_table_yuv[i_color][0];
1318 p_outU->p_pixels[ i_offset ] = p_sys->ar_color_table_yuv[i_color][1];
1319 p_outV->p_pixels[ i_offset ] = p_sys->ar_color_table_yuv[i_color][2];
1320 p_outA->p_pixels[ i_offset ] = p_sys->ar_color_table_yuv[i_color][3];
1327 /*****************************************************************************
1328 * MouseEvent: callback for mouse events
1329 *****************************************************************************/
1330 static int MouseEvent( vlc_object_t *p_this, char const *psz_var,
1331 vlc_value_t oldval, vlc_value_t newval, void *p_data )
1333 VLC_UNUSED(oldval); VLC_UNUSED(newval); VLC_UNUSED(psz_var);
1335 filter_t *p_filter = (filter_t *)p_data;
1336 filter_sys_t *p_sys = p_filter->p_sys;
1338 if( !p_sys->b_vnc_mouse_events )
1341 vout_thread_t *p_vout = (vout_thread_t*)p_sys->p_vout;
1346 i_v = var_GetInteger( p_sys->p_vout, "mouse-button-down" );
1347 i_y = var_GetInteger( p_sys->p_vout, "mouse-y" );
1348 i_x = var_GetInteger( p_sys->p_vout, "mouse-x" );
1350 vlc_mutex_lock( &p_sys->lock );
1352 const int v_h = p_vout->fmt_in.i_visible_height;
1353 const int v_w = p_sys->i_vnc_width * v_h / p_sys->i_vnc_height;
1354 const int v_x = (p_vout->fmt_in.i_visible_width-v_w)/2;
1358 if( i_y < 0 || i_x < 0 || i_y >= v_h || i_x >= v_w )
1360 vlc_mutex_unlock( &p_sys->lock );
1361 msg_Dbg( p_this, "invalid mouse event? x=%d y=%d btn=%x", i_x, i_y, i_v );
1364 if( !p_sys->b_connection_active )
1366 vlc_mutex_unlock( &p_sys->lock );
1371 msg_Dbg( p_this, "mouse event x=%d y=%d btn=%x", i_x, i_y, i_v );
1375 i_x = i_x * p_sys->i_vnc_width / v_w;
1376 i_y = i_y * p_sys->i_vnc_height / v_h;
1378 /* buttonMask bits 0-7 are buttons 1-8, 0=up, 1=down */
1379 rfbPointerEventMsg ev;
1380 ev.type = rfbPointerEvent;
1381 ev.buttonMask = i_v;
1385 write_exact( p_filter, p_sys->i_socket,
1386 (char*)&ev, sz_rfbPointerEventMsg);
1388 vlc_mutex_unlock( &p_sys->lock );
1393 /*****************************************************************************
1394 * KeyEvent: callback for keyboard events
1395 *****************************************************************************/
1396 static int KeyEvent( vlc_object_t *p_this, char const *psz_var,
1397 vlc_value_t oldval, vlc_value_t newval, void *p_data )
1399 VLC_UNUSED(psz_var); VLC_UNUSED(oldval);
1401 filter_t *p_filter = (filter_t *)p_data;
1402 filter_sys_t *p_sys = p_filter->p_sys;
1404 if( !p_sys->b_vnc_key_events )
1407 msg_Dbg( p_this, "key pressed (%d) ", newval.i_int );
1409 if ( !newval.i_int )
1411 msg_Err( p_this, "Received invalid key event %d", newval.i_int );
1412 return VLC_EGENERIC;
1415 vlc_mutex_lock( &p_sys->lock );
1416 if( !p_sys->b_connection_active )
1418 vlc_mutex_unlock( &p_sys->lock );
1422 uint32_t i_key32 = newval.i_int;
1423 i_key32 = htonl(i_key32);
1426 ev.type = rfbKeyEvent;
1430 /* first key-down for modifier-keys */
1431 if (newval.i_int & KEY_MODIFIER_CTRL)
1434 write_exact( p_filter, p_sys->i_socket,
1435 (char*)&ev, sz_rfbKeyEventMsg);
1437 if (newval.i_int & KEY_MODIFIER_SHIFT)
1440 write_exact( p_filter, p_sys->i_socket,
1441 (char*)&ev, sz_rfbKeyEventMsg);
1443 if (newval.i_int & KEY_MODIFIER_ALT)
1446 write_exact( p_filter, p_sys->i_socket,
1447 (char*)&ev, sz_rfbKeyEventMsg);
1450 /* then key-down for the pressed key */
1452 write_exact( p_filter, p_sys->i_socket,
1453 (char*)&ev, sz_rfbKeyEventMsg);
1457 /* then key-up for the pressed key */
1458 write_exact( p_filter, p_sys->i_socket,
1459 (char*)&ev, sz_rfbKeyEventMsg);
1461 /* last key-down for modifier-keys */
1462 if (newval.i_int & KEY_MODIFIER_CTRL)
1465 write_exact( p_filter, p_sys->i_socket,
1466 (char*)&ev, sz_rfbKeyEventMsg);
1468 if (newval.i_int & KEY_MODIFIER_SHIFT)
1471 write_exact( p_filter, p_sys->i_socket,
1472 (char*)&ev, sz_rfbKeyEventMsg);
1474 if (newval.i_int & KEY_MODIFIER_ALT)
1477 write_exact( p_filter, p_sys->i_socket,
1478 (char*)&ev, sz_rfbKeyEventMsg);
1480 vlc_mutex_unlock( &p_sys->lock );
1485 static void vnc_encrypt_bytes( unsigned char *bytes, char *passwd )
1487 unsigned char key[8];
1490 for (i = 0; i < 8; i++)
1491 key[i] = i < strlen( passwd ) ? passwd[i] : '\0';
1493 gcry_cipher_hd_t ctx;
1494 gcry_cipher_open( &ctx, GCRY_CIPHER_DES, GCRY_CIPHER_MODE_ECB,0);
1496 /* reverse bits of the key */
1497 for( i = 0 ; i < 8 ; i ++ )
1500 (((key[i] >> 6) & 0x01 ) << 1 ) +
1501 (((key[i] >> 5) & 0x01 ) << 2 ) +
1502 (((key[i] >> 4) & 0x01 ) << 3 ) +
1503 (((key[i] >> 3) & 0x01 ) << 4 ) +
1504 (((key[i] >> 2) & 0x01 ) << 5 ) +
1505 (((key[i] >> 1) & 0x01 ) << 6 ) +
1506 ((key[i] & 0x01) << 7 );
1508 gcry_cipher_setkey( ctx, key, 8 );
1509 gcry_cipher_encrypt( ctx, bytes, CHALLENGESIZE, bytes, CHALLENGESIZE );
1510 gcry_cipher_close( ctx );