a whole bunch of internal cleanups
[gnupg.git] / g10 / build-packet.c
1 /* build-packet.c - assemble packets and write them
2  *      Copyright (C) 1998 Free Software Foundation, Inc.
3  *
4  * This file is part of GNUPG.
5  *
6  * GNUPG is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * GNUPG is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA
19  */
20
21 #include <config.h>
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include <string.h>
25 #include <assert.h>
26
27 #include "packet.h"
28 #include "errors.h"
29 #include "iobuf.h"
30 #include "mpi.h"
31 #include "util.h"
32 #include "cipher.h"
33 #include "memory.h"
34 #include "options.h"
35
36
37 static int do_comment( IOBUF out, int ctb, PKT_comment *rem );
38 static int do_user_id( IOBUF out, int ctb, PKT_user_id *uid );
39 static int do_public_cert( IOBUF out, int ctb, PKT_public_cert *pk );
40 static int do_secret_cert( IOBUF out, int ctb, PKT_secret_cert *pk );
41 static int do_symkey_enc( IOBUF out, int ctb, PKT_symkey_enc *enc );
42 static int do_pubkey_enc( IOBUF out, int ctb, PKT_pubkey_enc *enc );
43 static u32 calc_plaintext( PKT_plaintext *pt );
44 static int do_plaintext( IOBUF out, int ctb, PKT_plaintext *pt );
45 static int do_encrypted( IOBUF out, int ctb, PKT_encrypted *ed );
46 static int do_compressed( IOBUF out, int ctb, PKT_compressed *cd );
47 static int do_signature( IOBUF out, int ctb, PKT_signature *sig );
48 static int do_onepass_sig( IOBUF out, int ctb, PKT_onepass_sig *ops );
49
50 static int calc_header_length( u32 len );
51 static int write_16(IOBUF inp, u16 a);
52 static int write_32(IOBUF inp, u32 a);
53 static int write_header( IOBUF out, int ctb, u32 len );
54 static int write_header2( IOBUF out, int ctb, u32 len, int hdrlen, int blkmode );
55 static int write_new_header( IOBUF out, int ctb, u32 len, int hdrlen );
56 static int write_version( IOBUF out, int ctb );
57
58 /****************
59  * Build a packet and write it to INP
60  * Returns: 0 := okay
61  *         >0 := error
62  * Note: Caller must free the packet
63  */
64 int
65 build_packet( IOBUF out, PACKET *pkt )
66 {
67     int rc=0, ctb;
68
69     if( DBG_PACKET )
70         log_debug("build_packet() type=%d\n", pkt->pkttype );
71     if( pkt->pkttype == PKT_OLD_COMMENT )
72         pkt->pkttype = PKT_COMMENT;
73     assert( pkt->pkt.generic );
74     if( pkt->pkttype > 15 ) /* new format */
75         ctb = 0xc0 | (pkt->pkttype & 0x3f);
76     else
77         ctb = 0x80 | ((pkt->pkttype & 15)<<2);
78     switch( pkt->pkttype ) {
79       case PKT_USER_ID:
80         rc = do_user_id( out, ctb, pkt->pkt.user_id );
81         break;
82       case PKT_COMMENT:
83         rc = do_comment( out, ctb, pkt->pkt.comment );
84         break;
85       case PKT_PUBKEY_SUBCERT:
86       case PKT_PUBLIC_CERT:
87         rc = do_public_cert( out, ctb, pkt->pkt.public_cert );
88         break;
89       case PKT_SECKEY_SUBCERT:
90       case PKT_SECRET_CERT:
91         rc = do_secret_cert( out, ctb, pkt->pkt.secret_cert );
92         break;
93       case PKT_SYMKEY_ENC:
94         rc = do_symkey_enc( out, ctb, pkt->pkt.symkey_enc );
95         break;
96       case PKT_PUBKEY_ENC:
97         rc = do_pubkey_enc( out, ctb, pkt->pkt.pubkey_enc );
98         break;
99       case PKT_PLAINTEXT:
100         rc = do_plaintext( out, ctb, pkt->pkt.plaintext );
101         break;
102       case PKT_ENCRYPTED:
103         rc = do_encrypted( out, ctb, pkt->pkt.encrypted );
104         break;
105       case PKT_COMPRESSED:
106         rc = do_compressed( out, ctb, pkt->pkt.compressed );
107         break;
108       case PKT_SIGNATURE:
109         rc = do_signature( out, ctb, pkt->pkt.signature );
110         break;
111       case PKT_ONEPASS_SIG:
112         rc = do_onepass_sig( out, ctb, pkt->pkt.onepass_sig );
113         break;
114       case PKT_RING_TRUST:
115       default:
116         log_bug("invalid packet type in build_packet()\n");
117         break;
118     }
119
120     return rc;
121 }
122
123 /****************
124  * calculate the length of a packet described by PKT
125  */
126 u32
127 calc_packet_length( PACKET *pkt )
128 {
129     u32 n=0;
130
131     assert( pkt->pkt.generic );
132     switch( pkt->pkttype ) {
133       case PKT_PLAINTEXT:
134         n = calc_plaintext( pkt->pkt.plaintext );
135         break;
136       case PKT_USER_ID:
137       case PKT_COMMENT:
138       case PKT_PUBLIC_CERT:
139       case PKT_SECRET_CERT:
140       case PKT_SYMKEY_ENC:
141       case PKT_PUBKEY_ENC:
142       case PKT_ENCRYPTED:
143       case PKT_SIGNATURE:
144       case PKT_ONEPASS_SIG:
145       case PKT_RING_TRUST:
146       case PKT_COMPRESSED:
147       default:
148         log_bug("invalid packet type in calc_packet_length()");
149         break;
150     }
151     n += calc_header_length(n);
152     return n;
153 }
154
155
156 static int
157 do_comment( IOBUF out, int ctb, PKT_comment *rem )
158 {
159     if( !opt.no_comment ) {
160         write_header(out, ctb, rem->len);
161         if( iobuf_write( out, rem->data, rem->len ) )
162             return G10ERR_WRITE_FILE;
163     }
164     return 0;
165 }
166
167 static int
168 do_user_id( IOBUF out, int ctb, PKT_user_id *uid )
169 {
170     write_header(out, ctb, uid->len);
171     if( iobuf_write( out, uid->name, uid->len ) )
172         return G10ERR_WRITE_FILE;
173     return 0;
174 }
175
176 static int
177 do_public_cert( IOBUF out, int ctb, PKT_public_cert *pkc )
178 {
179     int rc = 0;
180     int n, i;
181     IOBUF a = iobuf_temp();
182
183     if( !pkc->version )
184         iobuf_put( a, 3 );
185     else
186         iobuf_put( a, pkc->version );
187     write_32(a, pkc->timestamp );
188     if( pkc->version < 4 )
189         write_16(a, pkc->valid_days );
190     iobuf_put(a, pkc->pubkey_algo );
191     n = pubkey_get_npkey( pkc->pubkey_algo );
192     for(i=0; i < n; i++ )
193         mpi_write(a, pkc->pkey[i] );
194
195     write_header2(out, ctb, iobuf_get_temp_length(a), pkc->hdrbytes, 1 );
196     if( iobuf_write_temp( out, a ) )
197         rc = G10ERR_WRITE_FILE;
198
199     iobuf_close(a);
200     return rc;
201 }
202
203
204 /****************
205  * Make a hash value from the public key certificate
206  */
207 void
208 hash_public_cert( MD_HANDLE md, PKT_public_cert *pkc )
209 {
210     PACKET pkt;
211     int rc = 0;
212     int c;
213     IOBUF a = iobuf_temp();
214   #if 0
215     FILE *fp = fopen("dump.pkc", "a");
216     int i=0;
217
218     fprintf(fp, "\nHashing PKC (v%d):\n", pkc->version);
219   #endif
220
221     /* build the packet */
222     init_packet(&pkt);
223     pkt.pkttype = PKT_PUBLIC_CERT;
224     pkt.pkt.public_cert = pkc;
225     if( (rc = build_packet( a, &pkt )) )
226         log_fatal("build public_cert for hashing failed: %s\n", g10_errstr(rc));
227     while( (c=iobuf_get(a)) != -1 ) {
228       #if 0
229         fprintf( fp," %02x", c );
230         if( (++i == 24) ) {
231             putc('\n', fp);
232             i=0;
233         }
234       #endif
235         md_putc( md, c );
236     }
237   #if 0
238     putc('\n', fp);
239     fclose(fp);
240   #endif
241     iobuf_cancel(a);
242 }
243
244
245 static int
246 do_secret_cert( IOBUF out, int ctb, PKT_secret_cert *skc )
247 {
248     int rc = 0;
249     int i, nskey, npkey;
250     IOBUF a = iobuf_temp();
251
252     if( !skc->version )
253         iobuf_put( a, 3 );
254     else
255         iobuf_put( a, skc->version );
256     write_32(a, skc->timestamp );
257     if( skc->version < 4 )
258         write_16(a, skc->valid_days );
259     iobuf_put(a, skc->pubkey_algo );
260     nskey = pubkey_get_nskey( skc->pubkey_algo );
261     npkey = pubkey_get_npkey( skc->pubkey_algo );
262     assert( npkey < nskey );
263
264     for(i=0; i < npkey; i++ )
265         mpi_write(a, skc->skey[i] );
266     if( skc->is_protected ) {
267         if( is_RSA(skc->pubkey_algo) && skc->version < 4 ) {
268             iobuf_put(a, skc->protect.algo );
269             iobuf_write(a, skc->protect.iv, 8 );
270         }
271         else {
272             iobuf_put(a, 0xff );
273             iobuf_put(a, skc->protect.algo );
274             iobuf_put(a, skc->protect.s2k.mode );
275             iobuf_put(a, skc->protect.s2k.hash_algo );
276             if( skc->protect.s2k.mode == 1
277                 || skc->protect.s2k.mode == 4 )
278                 iobuf_write(a, skc->protect.s2k.salt, 8 );
279             if( skc->protect.s2k.mode == 4 )
280                 write_32(a, skc->protect.s2k.count );
281             iobuf_write(a, skc->protect.iv, 8 );
282         }
283     }
284     else
285         iobuf_put(a, 0 );
286     for(   ; i < nskey; i++ )
287         mpi_write(a, skc->skey[i] );
288     write_16(a, skc->csum );
289
290     write_header2(out, ctb, iobuf_get_temp_length(a), skc->hdrbytes, 1 );
291     if( iobuf_write_temp( out, a ) )
292         rc = G10ERR_WRITE_FILE;
293
294     iobuf_close(a);
295     return rc;
296 }
297
298 static int
299 do_symkey_enc( IOBUF out, int ctb, PKT_symkey_enc *enc )
300 {
301     int rc = 0;
302     IOBUF a = iobuf_temp();
303
304     assert( enc->version == 4 );
305     switch( enc->s2k.mode ) {
306       case 0: case 1: case 4: break;
307       default: log_bug("do_symkey_enc: s2k=%d\n", enc->s2k.mode );
308     }
309     iobuf_put( a, enc->version );
310     iobuf_put( a, enc->cipher_algo );
311     iobuf_put( a, enc->s2k.mode );
312     iobuf_put( a, enc->s2k.hash_algo );
313     if( enc->s2k.mode == 1 || enc->s2k.mode == 4 ) {
314         iobuf_write(a, enc->s2k.salt, 8 );
315         if( enc->s2k.mode == 4 )
316             write_32(a, enc->s2k.count);
317     }
318     if( enc->seskeylen )
319         iobuf_write(a, enc->seskey, enc->seskeylen );
320
321     write_header(out, ctb, iobuf_get_temp_length(a) );
322     if( iobuf_write_temp( out, a ) )
323         rc = G10ERR_WRITE_FILE;
324
325     iobuf_close(a);
326     return rc;
327 }
328
329 static int
330 do_pubkey_enc( IOBUF out, int ctb, PKT_pubkey_enc *enc )
331 {
332     int rc = 0;
333     int n, i;
334     IOBUF a = iobuf_temp();
335
336     write_version( a, ctb );
337     write_32(a, enc->keyid[0] );
338     write_32(a, enc->keyid[1] );
339     iobuf_put(a,enc->pubkey_algo );
340     n = pubkey_get_nenc( enc->pubkey_algo );
341     for(i=0; i < n; i++ )
342         mpi_write(a, enc->data[i] );
343
344     write_header(out, ctb, iobuf_get_temp_length(a) );
345     if( iobuf_write_temp( out, a ) )
346         rc = G10ERR_WRITE_FILE;
347
348     iobuf_close(a);
349     return rc;
350 }
351
352
353
354
355 static u32
356 calc_plaintext( PKT_plaintext *pt )
357 {
358     return pt->len? (1 + 1 + pt->namelen + 4 + pt->len) : 0;
359 }
360
361 static int
362 do_plaintext( IOBUF out, int ctb, PKT_plaintext *pt )
363 {
364     int i, rc = 0;
365     u32 n;
366     byte buf[1000]; /* FIXME: this buffer has the plaintext! */
367     int nbytes;
368
369     write_header(out, ctb, calc_plaintext( pt ) );
370     iobuf_put(out, pt->mode );
371     iobuf_put(out, pt->namelen );
372     for(i=0; i < pt->namelen; i++ )
373         iobuf_put(out, pt->name[i] );
374     if( write_32(out, pt->timestamp ) )
375         rc = G10ERR_WRITE_FILE;
376
377     n = 0;
378     while( (nbytes=iobuf_read(pt->buf, buf, 1000)) != -1 ) {
379         if( iobuf_write(out, buf, nbytes) == -1 ) {
380             rc = G10ERR_WRITE_FILE;
381             break;
382         }
383         n += nbytes;
384     }
385     memset(buf,0,1000); /* at least burn the buffer */
386     if( !pt->len )
387         iobuf_set_block_mode(out, 0 ); /* write end marker */
388     else if( n != pt->len )
389         log_error("do_plaintext(): wrote %lu bytes but expected %lu bytes\n",
390                         (ulong)n, (ulong)pt->len );
391
392     return rc;
393 }
394
395
396
397 static int
398 do_encrypted( IOBUF out, int ctb, PKT_encrypted *ed )
399 {
400     int rc = 0;
401     u32 n;
402
403     n = ed->len ? (ed->len + 10) : 0;
404     write_header(out, ctb, n );
405
406     /* This is all. The caller has to write the real data */
407
408     return rc;
409 }
410
411 static int
412 do_compressed( IOBUF out, int ctb, PKT_compressed *cd )
413 {
414     int rc = 0;
415
416     /* we must use the old convention and don't use blockmode */
417     write_header2(out, ctb, 0, 0, 0 );
418     iobuf_put(out, cd->algorithm );
419
420     /* This is all. The caller has to write the real data */
421
422     return rc;
423 }
424
425
426
427 /****************
428  * Find a subpacket of type REQTYPE in BUFFER and a return a pointer
429  * to the first byte of that subpacket data.
430  * And return the length of the packet in RET_N and the number of
431  * header bytes in RET_HLEN (length header and type byte).
432  */
433 byte *
434 find_subpkt( byte *buffer, sigsubpkttype_t reqtype,
435              size_t *ret_hlen, size_t *ret_n )
436 {
437     int buflen;
438     sigsubpkttype_t type;
439     byte *bufstart;
440     size_t n;
441
442     if( !buffer )
443         return NULL;
444     buflen = (*buffer << 8) | buffer[1];
445     buffer += 2;
446     for(;;) {
447         if( !buflen )
448             return NULL; /* end of packets; not found */
449         bufstart = buffer;
450         n = *buffer++; buflen--;
451         if( n == 255 ) {
452             if( buflen < 4 )
453                 break;
454             n = (buffer[0] << 24) | (buffer[1] << 16)
455                                   | (buffer[2] << 8) | buffer[3];
456             buffer += 4;
457             buflen -= 4;
458         }
459         else if( n >= 192 ) {
460             if( buflen < 2 )
461                 break;
462             n = (( n - 192 ) << 8) + *buffer + 192;
463             buflen--;
464         }
465         if( buflen < n )
466             break;
467         type = *buffer & 0x7f;
468         if( type == reqtype ) {
469             buffer++;
470             n--;
471             if( n > buflen )
472                 break;
473             if( ret_hlen )
474                 *ret_hlen = buffer - bufstart;
475             if( ret_n )
476                 *ret_n = n;
477             return buffer;
478         }
479         buffer += n; buflen -=n;
480     }
481
482     log_error("find_subpkt: buffer shorter than subpacket\n");
483     return NULL;
484 }
485
486
487 /****************
488  * Create or update a signature subpacket for SIG of TYPE.
489  * This functions know, where to put the data (hashed or unhashed).
490  * The function may move data from the unhased part to the hashed one.
491  * Note: All pointers into sig->[un]hashed are not valid after a call
492  * to this function.  The data to but into the subpaket should be
493  * in buffer with a length of buflen.
494  */
495 void
496 build_sig_subpkt( PKT_signature *sig, sigsubpkttype_t type,
497                   const byte *buffer, size_t buflen )
498 {
499
500     byte *data;
501     size_t hlen, dlen;
502     int found, hashed, realloced;
503     size_t n, n0;
504
505     if( (data = find_subpkt( sig->hashed_data, type, &hlen, &dlen )) )
506         found = 1;
507     else if( (data = find_subpkt( sig->unhashed_data, type, &hlen, &dlen )))
508         found = 2;
509     else
510         found = 0;
511
512     if( found )
513         log_bug("build_sig_packet: update nyi\n");
514     if( buflen+1 >= 192 )
515         log_bug("build_sig_packet: long subpackets are nyi\n");
516
517     switch( type ) {
518       case SIGSUBPKT_SIG_CREATED:
519       case SIGSUBPKT_PRIV_ADD_SIG:
520                hashed = 1; break;
521       default: hashed = 0; break;
522     }
523
524     if( hashed ) {
525         n0 = sig->hashed_data ? ((*sig->hashed_data << 8)
526                                     | sig->hashed_data[1]) : 0;
527         n = n0 + 1 + 1 + buflen; /* length, type, buffer */
528         realloced = !!sig->hashed_data;
529         data = sig->hashed_data ? m_realloc( sig->hashed_data, n+2 )
530                                 : m_alloc( n+2 );
531     }
532     else {
533         n0 = sig->unhashed_data ? ((*sig->unhashed_data << 8)
534                                       | sig->unhashed_data[1]) : 0;
535         n = n0 + 1 + 1 + buflen; /* length, type, buffer */
536         realloced = !!sig->unhashed_data;
537         data = sig->unhashed_data ? m_realloc( sig->unhashed_data, n+2 )
538                                   : m_alloc( n+2 );
539     }
540
541     data[n0+0] = (n >> 8) & 0xff;
542     data[n0+1] = n & 0xff;
543     data[n0+2] = buflen+1;
544     data[n0+3] = type;
545     memcpy(data+n0+4, buffer, buflen );
546
547     if( hashed ) {
548         if( !realloced )
549             m_free(sig->hashed_data);
550         sig->hashed_data = data;
551     }
552     else {
553         if( !realloced )
554             m_free(sig->unhashed_data);
555         sig->unhashed_data = data;
556     }
557 }
558
559
560 /****************
561  * Put all the required stuff from SIG into subpackets of sig.
562  */
563 void
564 build_sig_subpkt_from_sig( PKT_signature *sig )
565 {
566     u32  u;
567     byte buf[8];
568
569     u = sig->keyid[0];
570     buf[0] = (u >> 24) & 0xff;
571     buf[1] = (u >> 16) & 0xff;
572     buf[2] = (u >>  8) & 0xff;
573     buf[3] = u & 0xff;
574     u = sig->keyid[1];
575     buf[4] = (u >> 24) & 0xff;
576     buf[5] = (u >> 16) & 0xff;
577     buf[6] = (u >>  8) & 0xff;
578     buf[7] = u & 0xff;
579     build_sig_subpkt( sig, SIGSUBPKT_ISSUER, buf, 8 );
580
581     u = sig->timestamp;
582     buf[0] = (u >> 24) & 0xff;
583     buf[1] = (u >> 16) & 0xff;
584     buf[2] = (u >>  8) & 0xff;
585     buf[3] = u & 0xff;
586     build_sig_subpkt( sig, SIGSUBPKT_SIG_CREATED, buf, 4 );
587 }
588
589
590 static int
591 do_signature( IOBUF out, int ctb, PKT_signature *sig )
592 {
593     int rc = 0;
594     int n, i;
595     IOBUF a = iobuf_temp();
596
597     if( !sig->version )
598         iobuf_put( a, 3 );
599     else
600         iobuf_put( a, sig->version );
601     if( sig->version < 4 )
602         iobuf_put(a, 5 ); /* constant */
603     iobuf_put(a, sig->sig_class );
604     if( sig->version < 4 ) {
605         write_32(a, sig->timestamp );
606         write_32(a, sig->keyid[0] );
607         write_32(a, sig->keyid[1] );
608     }
609     iobuf_put(a, sig->pubkey_algo );
610     iobuf_put(a, sig->digest_algo );
611     if( sig->version >= 4 ) {
612         size_t n;
613         /* timestamp and keyid must have been packed into the
614          * subpackets prior to the call of this function, because
615          * these subpackets are hashed */
616         n = sig->hashed_data?((sig->hashed_data[0]<<8)
617                               |sig->hashed_data[1])   :0;
618         write_16(a, n);
619         if( n )
620             iobuf_write( a, sig->hashed_data+2, n );
621         n = sig->unhashed_data?((sig->unhashed_data[0]<<8)
622                                 |sig->unhashed_data[1])   :0;
623         write_16(a, n);
624         if( n )
625             iobuf_write( a, sig->unhashed_data+2, n );
626     }
627     iobuf_put(a, sig->digest_start[0] );
628     iobuf_put(a, sig->digest_start[1] );
629     n = pubkey_get_nsig( sig->pubkey_algo );
630     for(i=0; i < n; i++ )
631         mpi_write(a, sig->data[i] );
632
633     write_header(out, ctb, iobuf_get_temp_length(a) );
634     if( iobuf_write_temp( out, a ) )
635         rc = G10ERR_WRITE_FILE;
636
637     iobuf_close(a);
638     return rc;
639 }
640
641
642 static int
643 do_onepass_sig( IOBUF out, int ctb, PKT_onepass_sig *ops )
644 {
645     int rc = 0;
646     IOBUF a = iobuf_temp();
647
648     write_version( a, ctb );
649     iobuf_put(a, ops->sig_class );
650     iobuf_put(a, ops->digest_algo );
651     iobuf_put(a, ops->pubkey_algo );
652     write_32(a, ops->keyid[0] );
653     write_32(a, ops->keyid[1] );
654     iobuf_put(a, ops->last );
655
656     write_header(out, ctb, iobuf_get_temp_length(a) );
657     if( iobuf_write_temp( out, a ) )
658         rc = G10ERR_WRITE_FILE;
659
660     iobuf_close(a);
661     return rc;
662 }
663
664
665 static int
666 write_16(IOBUF out, u16 a)
667 {
668     iobuf_put(out, a>>8);
669     if( iobuf_put(out,a) )
670         return -1;
671     return 0;
672 }
673
674 static int
675 write_32(IOBUF out, u32 a)
676 {
677     iobuf_put(out, a>> 24);
678     iobuf_put(out, a>> 16);
679     iobuf_put(out, a>> 8);
680     if( iobuf_put(out, a) )
681         return -1;
682     return 0;
683 }
684
685
686 /****************
687  * calculate the length of a header
688  */
689 static int
690 calc_header_length( u32 len )
691 {
692     if( !len )
693         return 1; /* only the ctb */
694     else if( len < 256 )
695         return 2;
696     else if( len < 65536 )
697         return 3;
698     else
699         return 5;
700 }
701
702 /****************
703  * Write the CTB and the packet length
704  */
705 static int
706 write_header( IOBUF out, int ctb, u32 len )
707 {
708     return write_header2( out, ctb, len, 0, 1 );
709 }
710
711 /****************
712  * if HDRLEN is > 0, try to build a header of this length.
713  * we need this, so that we can hash packets without reading them again.
714  */
715 static int
716 write_header2( IOBUF out, int ctb, u32 len, int hdrlen, int blkmode )
717 {
718     if( ctb & 0x40 )
719         return write_new_header( out, ctb, len, hdrlen );
720
721     if( hdrlen ) {
722         if( !len )
723             ctb |= 3;
724         else if( hdrlen == 2 && len < 256 )
725             ;
726         else if( hdrlen == 3 && len < 65536 )
727             ctb |= 1;
728         else
729             ctb |= 2;
730     }
731     else {
732         if( !len )
733             ctb |= 3;
734         else if( len < 256 )
735             ;
736         else if( len < 65536 )
737             ctb |= 1;
738         else
739             ctb |= 2;
740     }
741     if( iobuf_put(out, ctb ) )
742         return -1;
743     if( !len ) {
744         if( blkmode )
745             iobuf_set_block_mode(out, 8196 );
746     }
747     else {
748         if( ctb & 2 ) {
749             iobuf_put(out, len >> 24 );
750             iobuf_put(out, len >> 16 );
751         }
752         if( ctb & 3 )
753             iobuf_put(out, len >> 8 );
754         if( iobuf_put(out, len ) )
755             return -1;
756     }
757     return 0;
758 }
759
760
761 static int
762 write_new_header( IOBUF out, int ctb, u32 len, int hdrlen )
763 {
764     if( hdrlen )
765         log_bug("can't cope with hdrlen yet\n");
766
767     if( iobuf_put(out, ctb ) )
768         return -1;
769     if( !len ) {
770         log_bug("can't write partial headers yet\n");
771     }
772     else {
773         if( len < 192 ) {
774             if( iobuf_put(out, len ) )
775                 return -1;
776         }
777         else if( len < 8384 ) {
778             len -= 192;
779             if( iobuf_put( out, (len / 256) + 192) )
780                 return -1;
781             if( iobuf_put( out, (len % 256) )  )
782                 return -1;
783         }
784         else {
785             if( iobuf_put( out, 0xff ) )
786                 return -1;
787             if( iobuf_put( out, (len >> 24)&0xff ) )
788                 return -1;
789             if( iobuf_put( out, (len >> 16)&0xff ) )
790                 return -1;
791             if( iobuf_put( out, (len >> 8)&0xff )  )
792                 return -1;
793             if( iobuf_put( out, len & 0xff ) )
794                 return -1;
795         }
796     }
797     return 0;
798 }
799
800 static int
801 write_version( IOBUF out, int ctb )
802 {
803     if( iobuf_put( out, 3 ) )
804         return -1;
805     return 0;
806 }
807