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
 38static inline u8 *__usb_ext_prop_ptr(u8 *buf, size_t offset)
 39{
 40	return buf + offset;
 41}
 42
 43static inline u8 *usb_ext_prop_size_ptr(u8 *buf)
 44{
 45	return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_SIZE);
 46}
 47
 48static 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
 53static 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
 58static 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
 63static 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
 69static 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
 74static inline void usb_ext_prop_put_size(u8 *buf, int dw_size)
 75{
 76	put_unaligned_le32(dw_size, usb_ext_prop_size_ptr(buf));
 77}
 78
 79static inline void usb_ext_prop_put_type(u8 *buf, int type)
 80{
 81	put_unaligned_le32(type, usb_ext_prop_type_ptr(buf));
 82}
 83
 84static inline int usb_ext_prop_put_name(u8 *buf, const char *name, int pnl)
 85{
 86	int result;
 87
 88	put_unaligned_le16(pnl, usb_ext_prop_name_len_ptr(buf));
 89	result = utf8s_to_utf16s(name, strlen(name), UTF16_LITTLE_ENDIAN,
 90		(wchar_t *) usb_ext_prop_name_ptr(buf), pnl - 2);
 91	if (result < 0)
 92		return result;
 93
 94	put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_NAME + pnl - 2]);
 95
 96	return pnl;
 97}
 98
 99static inline void usb_ext_prop_put_binary(u8 *buf, int pnl, const u8 *data,
100					   int data_len)
101{
102	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
103	memcpy(usb_ext_prop_data_ptr(buf, pnl), data, data_len);
104}
105
106static inline int usb_ext_prop_put_unicode(u8 *buf, int pnl, const char *string,
107					   int data_len)
108{
109	int result;
110	put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
111	result = utf8s_to_utf16s(string, data_len >> 1, UTF16_LITTLE_ENDIAN,
112			(wchar_t *) usb_ext_prop_data_ptr(buf, pnl),
113			data_len - 2);
114	if (result < 0)
115		return result;
116
117	put_unaligned_le16(0,
118		&buf[USB_EXT_PROP_B_PROPERTY_DATA + pnl + data_len - 2]);
119
120	return data_len;
121}
122
123#endif /* __U_OS_DESC_H__ */