[mirror_ubuntu-bionic-kernel.git] / drivers / usb / gadget / u_os_desc.h

// SPDX-License-Identifier: GPL-2.0
/*
 * u_os_desc.h
 *
 * Utility definitions for "OS Descriptors" support
 *
 * Copyright (c) 2014 Samsung Electronics Co., Ltd.
 *		http://www.samsung.com
 *
 * Author: Andrzej Pietrasiewicz <andrzej.p@samsung.com>
 */

#ifndef __U_OS_DESC_H__
#define __U_OS_DESC_H__

#include <asm/unaligned.h>
#include <linux/nls.h>

#define USB_EXT_PROP_DW_SIZE			0
#define USB_EXT_PROP_DW_PROPERTY_DATA_TYPE	4
#define USB_EXT_PROP_W_PROPERTY_NAME_LENGTH	8
#define USB_EXT_PROP_B_PROPERTY_NAME		10
#define USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH	10
#define USB_EXT_PROP_B_PROPERTY_DATA		14

#define USB_EXT_PROP_RESERVED			0
#define USB_EXT_PROP_UNICODE			1
#define USB_EXT_PROP_UNICODE_ENV		2
#define USB_EXT_PROP_BINARY			3
#define USB_EXT_PROP_LE32			4
#define USB_EXT_PROP_BE32			5
#define USB_EXT_PROP_UNICODE_LINK		6
#define USB_EXT_PROP_UNICODE_MULTI		7

static inline u8 *__usb_ext_prop_ptr(u8 *buf, size_t offset)
{
	return buf + offset;
}

static inline u8 *usb_ext_prop_size_ptr(u8 *buf)
{
	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_SIZE);
}

static inline u8 *usb_ext_prop_type_ptr(u8 *buf)
{
	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_PROPERTY_DATA_TYPE);
}

static inline u8 *usb_ext_prop_name_len_ptr(u8 *buf)
{
	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_W_PROPERTY_NAME_LENGTH);
}

static inline u8 *usb_ext_prop_name_ptr(u8 *buf)
{
	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_NAME);
}

static inline u8 *usb_ext_prop_data_len_ptr(u8 *buf, size_t off)
{
	return __usb_ext_prop_ptr(buf,
				  USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH + off);
}

static inline u8 *usb_ext_prop_data_ptr(u8 *buf, size_t off)
{
	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_DATA + off);
}

static inline void usb_ext_prop_put_size(u8 *buf, int dw_size)
{
	put_unaligned_le32(dw_size, usb_ext_prop_size_ptr(buf));
}

static inline void usb_ext_prop_put_type(u8 *buf, int type)
{
	put_unaligned_le32(type, usb_ext_prop_type_ptr(buf));
}

static inline int usb_ext_prop_put_name(u8 *buf, const char *name, int pnl)
{
	int result;

	put_unaligned_le16(pnl, usb_ext_prop_name_len_ptr(buf));
	result = utf8s_to_utf16s(name, strlen(name), UTF16_LITTLE_ENDIAN,
		(wchar_t *) usb_ext_prop_name_ptr(buf), pnl - 2);
	if (result < 0)
		return result;

	put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_NAME + pnl - 2]);

	return pnl;
}

static inline void usb_ext_prop_put_binary(u8 *buf, int pnl, const u8 *data,
					   int data_len)
{
	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
	memcpy(usb_ext_prop_data_ptr(buf, pnl), data, data_len);
}

static inline int usb_ext_prop_put_unicode(u8 *buf, int pnl, const char *string,
					   int data_len)
{
	int result;
	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
	result = utf8s_to_utf16s(string, data_len >> 1, UTF16_LITTLE_ENDIAN,
			(wchar_t *) usb_ext_prop_data_ptr(buf, pnl),
			data_len - 2);
	if (result < 0)
		return result;

	put_unaligned_le16(0,
		&buf[USB_EXT_PROP_B_PROPERTY_DATA + pnl + data_len - 2]);

	return data_len;
}

#endif /* __U_OS_DESC_H__ */
Commit	Line	Data
5fd54ace	1	// SPDX-License-Identifier: GPL-2.0
37a3a533 AP	2	/*
	3	* u_os_desc.h
	4	*
	5	* Utility definitions for "OS Descriptors" support
	6	*
	7	* Copyright (c) 2014 Samsung Electronics Co., Ltd.
	8	* http://www.samsung.com
	9	*
	10	* Author: Andrzej Pietrasiewicz <andrzej.p@samsung.com>
37a3a533 AP	11	*/
	12
	13	#ifndef __U_OS_DESC_H__
	14	#define __U_OS_DESC_H__
	15
	16	#include <asm/unaligned.h>
	17	#include <linux/nls.h>
	18
	19	#define USB_EXT_PROP_DW_SIZE 0
	20	#define USB_EXT_PROP_DW_PROPERTY_DATA_TYPE 4
	21	#define USB_EXT_PROP_W_PROPERTY_NAME_LENGTH 8
	22	#define USB_EXT_PROP_B_PROPERTY_NAME 10
	23	#define USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH 10
	24	#define USB_EXT_PROP_B_PROPERTY_DATA 14
	25
	26	#define USB_EXT_PROP_RESERVED 0
	27	#define USB_EXT_PROP_UNICODE 1
	28	#define USB_EXT_PROP_UNICODE_ENV 2
	29	#define USB_EXT_PROP_BINARY 3
	30	#define USB_EXT_PROP_LE32 4
	31	#define USB_EXT_PROP_BE32 5
	32	#define USB_EXT_PROP_UNICODE_LINK 6
	33	#define USB_EXT_PROP_UNICODE_MULTI 7
	34
7ea4f088 AP	35	static inline u8 __usb_ext_prop_ptr(u8 buf, size_t offset)
	36	{
	37	return buf + offset;
	38	}
	39
	40	static inline u8 usb_ext_prop_size_ptr(u8 buf)
	41	{
	42	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_SIZE);
	43	}
	44
	45	static inline u8 usb_ext_prop_type_ptr(u8 buf)
	46	{
	47	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_PROPERTY_DATA_TYPE);
	48	}
	49
	50	static inline u8 usb_ext_prop_name_len_ptr(u8 buf)
	51	{
	52	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_W_PROPERTY_NAME_LENGTH);
	53	}
	54
	55	static inline u8 usb_ext_prop_name_ptr(u8 buf)
	56	{
	57	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_NAME);
	58	}
	59
	60	static inline u8 usb_ext_prop_data_len_ptr(u8 buf, size_t off)
	61	{
	62	return __usb_ext_prop_ptr(buf,
	63	USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH + off);
	64	}
	65
	66	static inline u8 usb_ext_prop_data_ptr(u8 buf, size_t off)
	67	{
	68	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_DATA + off);
	69	}
	70
37a3a533 AP	71	static inline void usb_ext_prop_put_size(u8 *buf, int dw_size)
37a3a533 AP	72	{
7ea4f088	73	put_unaligned_le32(dw_size, usb_ext_prop_size_ptr(buf));
37a3a533 AP	74	}
	75
	76	static inline void usb_ext_prop_put_type(u8 *buf, int type)
	77	{
7ea4f088	78	put_unaligned_le32(type, usb_ext_prop_type_ptr(buf));
37a3a533 AP	79	}
	80
	81	static inline int usb_ext_prop_put_name(u8 buf, const char name, int pnl)
	82	{
	83	int result;
	84
7ea4f088	85	put_unaligned_le16(pnl, usb_ext_prop_name_len_ptr(buf));
37a3a533	86	result = utf8s_to_utf16s(name, strlen(name), UTF16_LITTLE_ENDIAN,
7ea4f088	87	(wchar_t *) usb_ext_prop_name_ptr(buf), pnl - 2);
37a3a533 AP	88	if (result < 0)
	89	return result;
	90
7ea4f088	91	put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_NAME + pnl - 2]);
37a3a533 AP	92
	93	return pnl;
	94	}
	95
	96	static inline void usb_ext_prop_put_binary(u8 buf, int pnl, const u8 data,
	97	int data_len)
	98	{
7ea4f088 AP	99	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
7ea4f088 AP	100	memcpy(usb_ext_prop_data_ptr(buf, pnl), data, data_len);
37a3a533 AP	101	}
	102
	103	static inline int usb_ext_prop_put_unicode(u8 buf, int pnl, const char string,
	104	int data_len)
	105	{
	106	int result;
7ea4f088	107	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
37a3a533	108	result = utf8s_to_utf16s(string, data_len >> 1, UTF16_LITTLE_ENDIAN,
7ea4f088	109	(wchar_t *) usb_ext_prop_data_ptr(buf, pnl),
37a3a533 AP	110	data_len - 2);
	111	if (result < 0)
	112	return result;
	113
	114	put_unaligned_le16(0,
7ea4f088	115	&buf[USB_EXT_PROP_B_PROPERTY_DATA + pnl + data_len - 2]);
37a3a533 AP	116
	117	return data_len;
	118	}
	119
	120	#endif /* __U_OS_DESC_H__ */