2011-07-05 01:05:58 +04:00
|
|
|
/**
|
2012-02-21 09:56:55 +04:00
|
|
|
* FreeRDP: A Remote Desktop Protocol Implementation
|
2011-07-05 01:05:58 +04:00
|
|
|
* ASN.1 Packed Encoding Rules (BER)
|
|
|
|
*
|
2012-02-21 09:56:55 +04:00
|
|
|
* Copyright 2011-2012 Marc-Andre Moreau <marcandre.moreau@gmail.com>
|
2011-07-05 01:05:58 +04:00
|
|
|
*
|
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
* You may obtain a copy of the License at
|
|
|
|
*
|
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
* limitations under the License.
|
|
|
|
*/
|
|
|
|
|
2012-08-15 01:09:01 +04:00
|
|
|
#ifdef HAVE_CONFIG_H
|
|
|
|
#include "config.h"
|
|
|
|
#endif
|
|
|
|
|
2012-02-17 09:58:30 +04:00
|
|
|
#include <freerdp/crypto/per.h>
|
2011-07-05 01:05:58 +04:00
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER length.
|
|
|
|
* @param s stream
|
|
|
|
* @param length length
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-27 10:37:52 +04:00
|
|
|
boolean per_read_length(STREAM* s, uint16* length)
|
2011-07-10 01:28:30 +04:00
|
|
|
{
|
|
|
|
uint8 byte;
|
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, byte);
|
|
|
|
|
|
|
|
if (byte & 0x80)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
byte &= ~(0x80);
|
2011-07-10 01:28:30 +04:00
|
|
|
*length = (byte << 8);
|
|
|
|
stream_read_uint8(s, byte);
|
|
|
|
*length += byte;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
*length = byte;
|
|
|
|
}
|
|
|
|
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER length.
|
|
|
|
* @param s stream
|
|
|
|
* @param length length
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_length(STREAM* s, int length)
|
2011-07-05 01:05:58 +04:00
|
|
|
{
|
|
|
|
if (length > 0x7F)
|
|
|
|
stream_write_uint16_be(s, (length | 0x8000));
|
|
|
|
else
|
|
|
|
stream_write_uint8(s, length);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER choice.
|
|
|
|
* @param s stream
|
|
|
|
* @param choice choice
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_choice(STREAM* s, uint8* choice)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, *choice);
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER CHOICE.
|
|
|
|
* @param s stream
|
|
|
|
* @param choice index of chosen field
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_choice(STREAM* s, uint8 choice)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
stream_write_uint8(s, choice);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER selection.
|
|
|
|
* @param s stream
|
|
|
|
* @param selection selection
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_selection(STREAM* s, uint8* selection)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, *selection);
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER selection for OPTIONAL fields.
|
|
|
|
* @param s stream
|
|
|
|
* @param selection bit map of selected fields
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_selection(STREAM* s, uint8 selection)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
stream_write_uint8(s, selection);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER number of sets.
|
|
|
|
* @param s stream
|
|
|
|
* @param number number of sets
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_number_of_sets(STREAM* s, uint8* number)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, *number);
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER number of sets for SET OF.
|
|
|
|
* @param s stream
|
|
|
|
* @param number number of sets
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_number_of_sets(STREAM* s, uint8 number)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
stream_write_uint8(s, number);
|
|
|
|
}
|
|
|
|
|
2011-08-19 13:39:37 +04:00
|
|
|
/**
|
|
|
|
* Read PER padding with zeros.
|
|
|
|
* @param s stream
|
|
|
|
* @param length
|
|
|
|
*/
|
|
|
|
|
|
|
|
boolean per_read_padding(STREAM* s, int length)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-08-19 13:39:37 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
stream_seek(s, length);
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-08-19 13:39:37 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER padding with zeros.
|
|
|
|
* @param s stream
|
|
|
|
* @param length
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_padding(STREAM* s, int length)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++)
|
|
|
|
stream_write_uint8(s, 0);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER INTEGER.
|
|
|
|
* @param s stream
|
|
|
|
* @param integer integer
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_integer(STREAM* s, uint32* integer)
|
|
|
|
{
|
2011-07-27 10:37:52 +04:00
|
|
|
uint16 length;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (!per_read_length(s, &length))
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
|
|
|
if (stream_get_left(s) < length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
|
|
|
if (length == 1)
|
|
|
|
stream_read_uint8(s, *integer);
|
|
|
|
else if (length == 2)
|
|
|
|
stream_read_uint16_be(s, *integer);
|
|
|
|
else
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Write PER INTEGER.
|
|
|
|
* @param s stream
|
|
|
|
* @param integer integer
|
|
|
|
*/
|
2011-07-10 01:28:30 +04:00
|
|
|
|
2011-07-10 07:54:23 +04:00
|
|
|
void per_write_integer(STREAM* s, uint32 integer)
|
|
|
|
{
|
|
|
|
if (integer <= 0xFF)
|
|
|
|
{
|
|
|
|
per_write_length(s, 1);
|
|
|
|
stream_write_uint8(s, integer);
|
|
|
|
}
|
|
|
|
else if (integer <= 0xFFFF)
|
|
|
|
{
|
|
|
|
per_write_length(s, 2);
|
|
|
|
stream_write_uint16_be(s, integer);
|
|
|
|
}
|
|
|
|
else if (integer <= 0xFFFFFFFF)
|
|
|
|
{
|
|
|
|
per_write_length(s, 4);
|
|
|
|
stream_write_uint32_be(s, integer);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER INTEGER (uint16).
|
|
|
|
* @param s stream
|
|
|
|
* @param integer integer
|
|
|
|
* @param min minimum value
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
|
|
|
boolean per_read_integer16(STREAM* s, uint16* integer, uint16 min)
|
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 2)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
stream_read_uint16_be(s, *integer);
|
|
|
|
|
|
|
|
if (*integer + min > 0xFFFF)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-11 23:58:39 +04:00
|
|
|
|
|
|
|
*integer += min;
|
|
|
|
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-11 23:58:39 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Write PER INTEGER (uint16).
|
|
|
|
* @param s stream
|
|
|
|
* @param integer integer
|
|
|
|
* @param min minimum value
|
|
|
|
*/
|
|
|
|
|
2011-07-10 07:54:23 +04:00
|
|
|
void per_write_integer16(STREAM* s, uint16 integer, uint16 min)
|
|
|
|
{
|
|
|
|
stream_write_uint16_be(s, integer - min);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER ENUMERATED.
|
|
|
|
* @param s stream
|
|
|
|
* @param enumerated enumerated
|
|
|
|
* @param count enumeration count
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 07:54:23 +04:00
|
|
|
boolean per_read_enumerated(STREAM* s, uint8* enumerated, uint8 count)
|
2011-07-10 01:28:30 +04:00
|
|
|
{
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < 1)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, *enumerated);
|
2011-07-10 07:54:23 +04:00
|
|
|
|
|
|
|
/* check that enumerated value falls within expected range */
|
|
|
|
if (*enumerated + 1 > count)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 07:54:23 +04:00
|
|
|
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-08-19 19:56:47 +04:00
|
|
|
/**
|
|
|
|
* Write PER ENUMERATED.
|
|
|
|
* @param s stream
|
|
|
|
* @param enumerated enumerated
|
|
|
|
* @param count enumeration count
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
|
|
|
void per_write_enumerated(STREAM* s, uint8 enumerated, uint8 count)
|
|
|
|
{
|
|
|
|
stream_write_uint8(s, enumerated);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER OBJECT_IDENTIFIER (OID).
|
|
|
|
* @param s stream
|
|
|
|
* @param oid object identifier (OID)
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_object_identifier(STREAM* s, uint8 oid[6])
|
|
|
|
{
|
|
|
|
uint8 t12;
|
2011-07-27 10:37:52 +04:00
|
|
|
uint16 length;
|
2011-07-10 01:28:30 +04:00
|
|
|
uint8 a_oid[6];
|
2011-07-27 03:14:11 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (!per_read_length(s, &length))
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
|
|
|
if (length != 5)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
stream_read_uint8(s, t12); /* first two tuples */
|
|
|
|
a_oid[0] = (t12 >> 4);
|
|
|
|
a_oid[1] = (t12 & 0x0F);
|
|
|
|
|
|
|
|
stream_read_uint8(s, a_oid[2]); /* tuple 3 */
|
|
|
|
stream_read_uint8(s, a_oid[3]); /* tuple 4 */
|
|
|
|
stream_read_uint8(s, a_oid[4]); /* tuple 5 */
|
|
|
|
stream_read_uint8(s, a_oid[5]); /* tuple 6 */
|
|
|
|
|
|
|
|
if ((a_oid[0] == oid[0]) && (a_oid[1] == oid[1]) &&
|
|
|
|
(a_oid[2] == oid[2]) && (a_oid[3] == oid[3]) &&
|
|
|
|
(a_oid[4] == oid[4]) && (a_oid[5] == oid[5]))
|
|
|
|
{
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER OBJECT_IDENTIFIER (OID)
|
|
|
|
* @param s stream
|
|
|
|
* @param oid object identifier (oid)
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_object_identifier(STREAM* s, uint8 oid[6])
|
2011-07-05 01:05:58 +04:00
|
|
|
{
|
|
|
|
uint8 t12 = (oid[0] << 4) & (oid[1] & 0x0F);
|
|
|
|
stream_write_uint8(s, 5); /* length */
|
|
|
|
stream_write_uint8(s, t12); /* first two tuples */
|
|
|
|
stream_write_uint8(s, oid[2]); /* tuple 3 */
|
|
|
|
stream_write_uint8(s, oid[3]); /* tuple 4 */
|
|
|
|
stream_write_uint8(s, oid[4]); /* tuple 5 */
|
|
|
|
stream_write_uint8(s, oid[5]); /* tuple 6 */
|
|
|
|
}
|
2011-07-05 03:13:01 +04:00
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER string.
|
|
|
|
* @param s stream
|
|
|
|
* @param str string
|
|
|
|
* @param length string length
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_string(STREAM* s, uint8* str, int length)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++)
|
|
|
|
stream_write_uint8(s, str[i]);
|
|
|
|
}
|
|
|
|
|
2011-07-11 23:58:39 +04:00
|
|
|
/**
|
|
|
|
* Read PER OCTET_STRING.
|
|
|
|
* @param s stream
|
|
|
|
* @param oct_str octet string
|
|
|
|
* @param length string length
|
|
|
|
* @param min minimum length
|
|
|
|
* @return
|
|
|
|
*/
|
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
boolean per_read_octet_string(STREAM* s, uint8* oct_str, int length, int min)
|
|
|
|
{
|
|
|
|
int i;
|
2011-07-27 10:37:52 +04:00
|
|
|
uint16 mlength;
|
2011-07-10 01:28:30 +04:00
|
|
|
uint8* a_oct_str;
|
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (!per_read_length(s, &mlength))
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
|
|
|
if (mlength + min != length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2012-02-29 01:46:13 +04:00
|
|
|
|
2011-07-10 01:28:30 +04:00
|
|
|
a_oct_str = s->p;
|
|
|
|
stream_seek(s, length);
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++)
|
|
|
|
{
|
|
|
|
if (a_oct_str[i] != oct_str[i])
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-07-10 01:28:30 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER OCTET_STRING
|
|
|
|
* @param s stream
|
|
|
|
* @param oct_str octet string
|
|
|
|
* @param length string length
|
|
|
|
* @param min minimum string length
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_octet_string(STREAM* s, uint8* oct_str, int length, int min)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
int mlength;
|
|
|
|
|
|
|
|
mlength = (length - min >= 0) ? length - min : min;
|
|
|
|
|
|
|
|
per_write_length(s, mlength);
|
|
|
|
|
|
|
|
for (i = 0; i < length; i++)
|
|
|
|
stream_write_uint8(s, oct_str[i]);
|
|
|
|
}
|
|
|
|
|
2011-08-19 13:39:37 +04:00
|
|
|
/**
|
|
|
|
* Read PER NumericString.
|
|
|
|
* @param s stream
|
|
|
|
* @param num_str numeric string
|
|
|
|
* @param length string length
|
|
|
|
* @param min minimum string length
|
|
|
|
*/
|
|
|
|
|
|
|
|
boolean per_read_numeric_string(STREAM* s, int min)
|
|
|
|
{
|
|
|
|
int length;
|
|
|
|
uint16 mlength;
|
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (!per_read_length(s, &mlength))
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-08-19 13:39:37 +04:00
|
|
|
|
2012-02-29 01:36:54 +04:00
|
|
|
length = (mlength + min + 1) / 2;
|
2011-08-19 13:39:37 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
if (stream_get_left(s) < length)
|
2012-10-09 10:31:28 +04:00
|
|
|
return FALSE;
|
2011-08-19 13:39:37 +04:00
|
|
|
|
2012-02-29 01:46:13 +04:00
|
|
|
stream_seek(s, length);
|
2012-10-09 10:31:28 +04:00
|
|
|
return TRUE;
|
2011-08-19 13:39:37 +04:00
|
|
|
}
|
|
|
|
|
2011-07-05 05:35:32 +04:00
|
|
|
/**
|
|
|
|
* Write PER NumericString.
|
|
|
|
* @param s stream
|
|
|
|
* @param num_str numeric string
|
|
|
|
* @param length string length
|
|
|
|
* @param min minimum string length
|
|
|
|
*/
|
|
|
|
|
2011-07-07 23:35:09 +04:00
|
|
|
void per_write_numeric_string(STREAM* s, uint8* num_str, int length, int min)
|
2011-07-05 03:13:01 +04:00
|
|
|
{
|
|
|
|
int i;
|
|
|
|
int mlength;
|
|
|
|
uint8 num, c1, c2;
|
|
|
|
|
|
|
|
mlength = (length - min >= 0) ? length - min : min;
|
|
|
|
|
|
|
|
per_write_length(s, mlength);
|
|
|
|
|
|
|
|
for (i = 0; i < length; i += 2)
|
|
|
|
{
|
|
|
|
c1 = num_str[i];
|
|
|
|
c2 = ((i + 1) < length) ? num_str[i + 1] : 0x30;
|
|
|
|
|
|
|
|
c1 = (c1 - 0x30) % 10;
|
|
|
|
c2 = (c2 - 0x30) % 10;
|
|
|
|
num = (c1 << 4) | c2;
|
|
|
|
|
|
|
|
stream_write_uint8(s, num); /* string */
|
|
|
|
}
|
|
|
|
}
|