drivers/usb/gadget/u_os_desc.h

   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
  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
  74 static 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
  79 static 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
  84 static 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
  99 static 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
 106 static 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__ */