1 // SPDX-License-Identifier: GPL-2.0
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>
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 #include "securec.h"
19 #include "hdf_log.h"
20
21 #define USB_EXT_PROP_DW_SIZE 0
22 #define USB_EXT_PROP_DW_PROPERTY_DATA_TYPE 4
23 #define USB_EXT_PROP_W_PROPERTY_NAME_LENGTH 8
24 #define USB_EXT_PROP_B_PROPERTY_NAME 10
25 #define USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH 10
26 #define USB_EXT_PROP_B_PROPERTY_DATA 14
27
28 #define USB_EXT_PROP_RESERVED 0
29 #define USB_EXT_PROP_UNICODE 1
30 #define USB_EXT_PROP_UNICODE_ENV 2
31 #define USB_EXT_PROP_BINARY 3
32 #define USB_EXT_PROP_LE32 4
33 #define USB_EXT_PROP_BE32 5
34 #define USB_EXT_PROP_UNICODE_LINK 6
35 #define USB_EXT_PROP_UNICODE_MULTI 7
36
__usb_ext_prop_ptr(u8 * buf,size_t offset)37 static inline u8 *__usb_ext_prop_ptr(u8 *buf, size_t offset)
38 {
39 return buf + offset;
40 }
41
usb_ext_prop_size_ptr(u8 * buf)42 static inline u8 *usb_ext_prop_size_ptr(u8 *buf)
43 {
44 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_SIZE);
45 }
46
usb_ext_prop_type_ptr(u8 * buf)47 static inline u8 *usb_ext_prop_type_ptr(u8 *buf)
48 {
49 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_PROPERTY_DATA_TYPE);
50 }
51
usb_ext_prop_name_len_ptr(u8 * buf)52 static inline u8 *usb_ext_prop_name_len_ptr(u8 *buf)
53 {
54 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_W_PROPERTY_NAME_LENGTH);
55 }
56
usb_ext_prop_name_ptr(u8 * buf)57 static inline u8 *usb_ext_prop_name_ptr(u8 *buf)
58 {
59 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_NAME);
60 }
61
usb_ext_prop_data_len_ptr(u8 * buf,size_t off)62 static inline u8 *usb_ext_prop_data_len_ptr(u8 *buf, size_t off)
63 {
64 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH + off);
65 }
66
usb_ext_prop_data_ptr(u8 * buf,size_t off)67 static inline u8 *usb_ext_prop_data_ptr(u8 *buf, size_t off)
68 {
69 return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_DATA + off);
70 }
71
usb_ext_prop_put_size(u8 * buf,int dw_size)72 static inline void usb_ext_prop_put_size(u8 *buf, int dw_size)
73 {
74 put_unaligned_le32(dw_size, usb_ext_prop_size_ptr(buf));
75 }
76
usb_ext_prop_put_type(u8 * buf,int type)77 static inline void usb_ext_prop_put_type(u8 *buf, int type)
78 {
79 put_unaligned_le32(type, usb_ext_prop_type_ptr(buf));
80 }
81
usb_ext_prop_put_name(u8 * buf,const char * name,int pnl)82 static inline int usb_ext_prop_put_name(u8 *buf, const char *name, int pnl)
83 {
84 int result;
85
86 put_unaligned_le16(pnl, usb_ext_prop_name_len_ptr(buf));
87 result = utf8s_to_utf16s(name, strlen(name), UTF16_LITTLE_ENDIAN,
88 (wchar_t *) usb_ext_prop_name_ptr(buf), pnl - 2);
89 if (result < 0)
90 return result;
91
92 put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_NAME + pnl - 2]);
93
94 return pnl;
95 }
96
usb_ext_prop_put_binary(u8 * buf,int pnl,const u8 * data,int data_len)97 static inline void usb_ext_prop_put_binary(u8 *buf, int pnl, const u8 *data, int data_len)
98 {
99 int32_t ret;
100 put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
101 ret = memcpy_s(usb_ext_prop_data_ptr(buf, pnl), data_len, data, data_len);
102 if (ret != EOK) {
103 HDF_LOGE("%{public}s: %{public}d memset_s failed", __func__, __LINE__);
104 }
105 }
106
usb_ext_prop_put_unicode(u8 * buf,int pnl,const char * string,int data_len)107 static inline int usb_ext_prop_put_unicode(u8 *buf, int pnl, const char *string, 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), data_len - 2);
113 if (result < 0)
114 return result;
115
116 put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_DATA + pnl + data_len - 2]);
117
118 return data_len;
119 }
120
121 #endif /* __U_OS_DESC_H__ */
122