9f5d0d4c4d
"(oid[0] << 4) & (oid[1] & 0x0F)" statement is always 0. It is not problem currently because the only OID which is written by this function should have 0 there. The function to read/write are pretty limited anyway and can't work properly with all kind of OIDs. Maybe it would be better to hardcode the OID there without decoding and encoding. But those functions are already there so let's improve them a bit according the spec and warn about limited set of supported OIDs. See: https://msdn.microsoft.com/en-us/library/windows/desktop/bb540809
497 lines
8.9 KiB
C
497 lines
8.9 KiB
C
/**
|
|
* FreeRDP: A Remote Desktop Protocol Implementation
|
|
* ASN.1 Packed Encoding Rules (BER)
|
|
*
|
|
* Copyright 2011-2012 Marc-Andre Moreau <marcandre.moreau@gmail.com>
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <freerdp/crypto/per.h>
|
|
|
|
/**
|
|
* Read PER length.
|
|
* @param s stream
|
|
* @param length length
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_length(wStream* s, UINT16* length)
|
|
{
|
|
BYTE byte;
|
|
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, byte);
|
|
|
|
if (byte & 0x80)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
byte &= ~(0x80);
|
|
*length = (byte << 8);
|
|
Stream_Read_UINT8(s, byte);
|
|
*length += byte;
|
|
}
|
|
else
|
|
{
|
|
*length = byte;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER length.
|
|
* @param s stream
|
|
* @param length length
|
|
*/
|
|
|
|
void per_write_length(wStream* s, int length)
|
|
{
|
|
if (length > 0x7F)
|
|
Stream_Write_UINT16_BE(s, (length | 0x8000));
|
|
else
|
|
Stream_Write_UINT8(s, length);
|
|
}
|
|
|
|
/**
|
|
* Read PER choice.
|
|
* @param s stream
|
|
* @param choice choice
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_choice(wStream* s, BYTE* choice)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, *choice);
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER CHOICE.
|
|
* @param s stream
|
|
* @param choice index of chosen field
|
|
*/
|
|
|
|
void per_write_choice(wStream* s, BYTE choice)
|
|
{
|
|
Stream_Write_UINT8(s, choice);
|
|
}
|
|
|
|
/**
|
|
* Read PER selection.
|
|
* @param s stream
|
|
* @param selection selection
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_selection(wStream* s, BYTE* selection)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, *selection);
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER selection for OPTIONAL fields.
|
|
* @param s stream
|
|
* @param selection bit map of selected fields
|
|
*/
|
|
|
|
void per_write_selection(wStream* s, BYTE selection)
|
|
{
|
|
Stream_Write_UINT8(s, selection);
|
|
}
|
|
|
|
/**
|
|
* Read PER number of sets.
|
|
* @param s stream
|
|
* @param number number of sets
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_number_of_sets(wStream* s, BYTE* number)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, *number);
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER number of sets for SET OF.
|
|
* @param s stream
|
|
* @param number number of sets
|
|
*/
|
|
|
|
void per_write_number_of_sets(wStream* s, BYTE number)
|
|
{
|
|
Stream_Write_UINT8(s, number);
|
|
}
|
|
|
|
/**
|
|
* Read PER padding with zeros.
|
|
* @param s stream
|
|
* @param length
|
|
*/
|
|
|
|
BOOL per_read_padding(wStream* s, int length)
|
|
{
|
|
if (((int) Stream_GetRemainingLength(s)) < length)
|
|
return FALSE;
|
|
|
|
Stream_Seek(s, length);
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER padding with zeros.
|
|
* @param s stream
|
|
* @param length
|
|
*/
|
|
|
|
void per_write_padding(wStream* s, int length)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < length; i++)
|
|
Stream_Write_UINT8(s, 0);
|
|
}
|
|
|
|
/**
|
|
* Read PER INTEGER.
|
|
* @param s stream
|
|
* @param integer integer
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_integer(wStream* s, UINT32* integer)
|
|
{
|
|
UINT16 length;
|
|
|
|
if (!per_read_length(s, &length))
|
|
return FALSE;
|
|
|
|
if (Stream_GetRemainingLength(s) < length)
|
|
return FALSE;
|
|
|
|
if (length == 0)
|
|
*integer = 0;
|
|
else if (length == 1)
|
|
Stream_Read_UINT8(s, *integer);
|
|
else if (length == 2)
|
|
Stream_Read_UINT16_BE(s, *integer);
|
|
else
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER INTEGER.
|
|
* @param s stream
|
|
* @param integer integer
|
|
*/
|
|
|
|
void per_write_integer(wStream* 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);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Read PER INTEGER (UINT16).
|
|
* @param s stream
|
|
* @param integer integer
|
|
* @param min minimum value
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_integer16(wStream* s, UINT16* integer, UINT16 min)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 2)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT16_BE(s, *integer);
|
|
|
|
if (*integer + min > 0xFFFF)
|
|
return FALSE;
|
|
|
|
*integer += min;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER INTEGER (UINT16).
|
|
* @param s stream
|
|
* @param integer integer
|
|
* @param min minimum value
|
|
*/
|
|
|
|
void per_write_integer16(wStream* s, UINT16 integer, UINT16 min)
|
|
{
|
|
Stream_Write_UINT16_BE(s, integer - min);
|
|
}
|
|
|
|
/**
|
|
* Read PER ENUMERATED.
|
|
* @param s stream
|
|
* @param enumerated enumerated
|
|
* @param count enumeration count
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_enumerated(wStream* s, BYTE* enumerated, BYTE count)
|
|
{
|
|
if (Stream_GetRemainingLength(s) < 1)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, *enumerated);
|
|
|
|
/* check that enumerated value falls within expected range */
|
|
if (*enumerated + 1 > count)
|
|
return FALSE;
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER ENUMERATED.
|
|
* @param s stream
|
|
* @param enumerated enumerated
|
|
* @param count enumeration count
|
|
* @return
|
|
*/
|
|
|
|
void per_write_enumerated(wStream* s, BYTE enumerated, BYTE count)
|
|
{
|
|
Stream_Write_UINT8(s, enumerated);
|
|
}
|
|
|
|
/**
|
|
* Read PER OBJECT_IDENTIFIER (OID).
|
|
* @param s stream
|
|
* @param oid object identifier (OID)
|
|
* @warning It works correctly only for limited set of OIDs.
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_object_identifier(wStream* s, BYTE oid[6])
|
|
{
|
|
BYTE t12;
|
|
UINT16 length;
|
|
BYTE a_oid[6];
|
|
|
|
if (!per_read_length(s, &length))
|
|
return FALSE;
|
|
|
|
if (length != 5)
|
|
return FALSE;
|
|
|
|
if (Stream_GetRemainingLength(s) < length)
|
|
return FALSE;
|
|
|
|
Stream_Read_UINT8(s, t12); /* first two tuples */
|
|
a_oid[0] = t12 / 40;
|
|
a_oid[1] = t12 % 40;
|
|
|
|
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]))
|
|
{
|
|
return TRUE;
|
|
}
|
|
else
|
|
{
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Write PER OBJECT_IDENTIFIER (OID)
|
|
* @param s stream
|
|
* @param oid object identifier (oid)
|
|
* @warning It works correctly only for limited set of OIDs.
|
|
*/
|
|
|
|
void per_write_object_identifier(wStream* s, BYTE oid[6])
|
|
{
|
|
BYTE t12 = oid[0] * 40 + oid[1];
|
|
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 */
|
|
}
|
|
|
|
/**
|
|
* Write PER string.
|
|
* @param s stream
|
|
* @param str string
|
|
* @param length string length
|
|
*/
|
|
|
|
void per_write_string(wStream* s, BYTE* str, int length)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < length; i++)
|
|
Stream_Write_UINT8(s, str[i]);
|
|
}
|
|
|
|
/**
|
|
* Read PER OCTET_STRING.
|
|
* @param s stream
|
|
* @param oct_str octet string
|
|
* @param length string length
|
|
* @param min minimum length
|
|
* @return
|
|
*/
|
|
|
|
BOOL per_read_octet_string(wStream* s, BYTE* oct_str, int length, int min)
|
|
{
|
|
int i;
|
|
UINT16 mlength;
|
|
BYTE* a_oct_str;
|
|
|
|
if (!per_read_length(s, &mlength))
|
|
return FALSE;
|
|
|
|
if (mlength + min != length)
|
|
return FALSE;
|
|
|
|
if (((int) Stream_GetRemainingLength(s)) < length)
|
|
return FALSE;
|
|
|
|
a_oct_str = Stream_Pointer(s);
|
|
Stream_Seek(s, length);
|
|
|
|
for (i = 0; i < length; i++)
|
|
{
|
|
if (a_oct_str[i] != oct_str[i])
|
|
return FALSE;
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER OCTET_STRING
|
|
* @param s stream
|
|
* @param oct_str octet string
|
|
* @param length string length
|
|
* @param min minimum string length
|
|
*/
|
|
|
|
void per_write_octet_string(wStream* s, BYTE* oct_str, int length, int min)
|
|
{
|
|
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]);
|
|
}
|
|
|
|
/**
|
|
* Read PER NumericString.
|
|
* @param s stream
|
|
* @param num_str numeric string
|
|
* @param length string length
|
|
* @param min minimum string length
|
|
*/
|
|
|
|
BOOL per_read_numeric_string(wStream* s, int min)
|
|
{
|
|
int length;
|
|
UINT16 mlength;
|
|
|
|
if (!per_read_length(s, &mlength))
|
|
return FALSE;
|
|
|
|
length = (mlength + min + 1) / 2;
|
|
|
|
if (((int) Stream_GetRemainingLength(s)) < length)
|
|
return FALSE;
|
|
|
|
Stream_Seek(s, length);
|
|
return TRUE;
|
|
}
|
|
|
|
/**
|
|
* Write PER NumericString.
|
|
* @param s stream
|
|
* @param num_str numeric string
|
|
* @param length string length
|
|
* @param min minimum string length
|
|
*/
|
|
|
|
void per_write_numeric_string(wStream* s, BYTE* num_str, int length, int min)
|
|
{
|
|
int i;
|
|
int mlength;
|
|
BYTE 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 */
|
|
}
|
|
}
|