Blame view

kernel/linux-rt-4.4.41/drivers/usb/gadget/u_os_desc.h 3.17 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
  /*
   * 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__ */