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

/*
 * 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>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

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