u_os_desc.h 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123
  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. #ifndef __U_OS_DESC_H__
  16. #define __U_OS_DESC_H__
  17. #include <linux/utf.h>
  18. #define USB_EXT_PROP_DW_SIZE 0
  19. #define USB_EXT_PROP_DW_PROPERTY_DATA_TYPE 4
  20. #define USB_EXT_PROP_W_PROPERTY_NAME_LENGTH 8
  21. #define USB_EXT_PROP_B_PROPERTY_NAME 10
  22. #define USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH 10
  23. #define USB_EXT_PROP_B_PROPERTY_DATA 14
  24. #define USB_EXT_PROP_RESERVED 0
  25. #define USB_EXT_PROP_UNICODE 1
  26. #define USB_EXT_PROP_UNICODE_ENV 2
  27. #define USB_EXT_PROP_BINARY 3
  28. #define USB_EXT_PROP_LE32 4
  29. #define USB_EXT_PROP_BE32 5
  30. #define USB_EXT_PROP_UNICODE_LINK 6
  31. #define USB_EXT_PROP_UNICODE_MULTI 7
  32. static inline u8 *__usb_ext_prop_ptr(u8 *buf, size_t offset)
  33. {
  34. return buf + offset;
  35. }
  36. static inline u8 *usb_ext_prop_size_ptr(u8 *buf)
  37. {
  38. return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_SIZE);
  39. }
  40. static inline u8 *usb_ext_prop_type_ptr(u8 *buf)
  41. {
  42. return __usb_ext_prop_ptr(buf, USB_EXT_PROP_DW_PROPERTY_DATA_TYPE);
  43. }
  44. static inline u8 *usb_ext_prop_name_len_ptr(u8 *buf)
  45. {
  46. return __usb_ext_prop_ptr(buf, USB_EXT_PROP_W_PROPERTY_NAME_LENGTH);
  47. }
  48. static inline u8 *usb_ext_prop_name_ptr(u8 *buf)
  49. {
  50. return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_NAME);
  51. }
  52. static inline u8 *usb_ext_prop_data_len_ptr(u8 *buf, size_t off)
  53. {
  54. return __usb_ext_prop_ptr(buf,
  55. USB_EXT_PROP_DW_PROPERTY_DATA_LENGTH + off);
  56. }
  57. static inline u8 *usb_ext_prop_data_ptr(u8 *buf, size_t off)
  58. {
  59. return __usb_ext_prop_ptr(buf, USB_EXT_PROP_B_PROPERTY_DATA + off);
  60. }
  61. static inline void usb_ext_prop_put_size(u8 *buf, int dw_size)
  62. {
  63. put_unaligned_le32(dw_size, usb_ext_prop_size_ptr(buf));
  64. }
  65. static inline void usb_ext_prop_put_type(u8 *buf, int type)
  66. {
  67. put_unaligned_le32(type, usb_ext_prop_type_ptr(buf));
  68. }
  69. static inline int usb_ext_prop_put_name(u8 *buf, const char *name, int pnl)
  70. {
  71. int result;
  72. put_unaligned_le16(pnl, usb_ext_prop_name_len_ptr(buf));
  73. memset(usb_ext_prop_name_ptr(buf), 0, 2 * strlen(name));
  74. result = utf8_to_utf16le(name, (__le16 *)usb_ext_prop_name_ptr(buf),
  75. strlen(name));
  76. if (result < 0)
  77. return result;
  78. put_unaligned_le16(0, &buf[USB_EXT_PROP_B_PROPERTY_NAME + pnl - 2]);
  79. return pnl;
  80. }
  81. static inline void usb_ext_prop_put_binary(u8 *buf, int pnl, const char *data,
  82. int data_len)
  83. {
  84. put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
  85. memcpy(usb_ext_prop_data_ptr(buf, pnl), data, data_len);
  86. }
  87. static inline int usb_ext_prop_put_unicode(u8 *buf, int pnl, const char *string,
  88. int data_len)
  89. {
  90. int result;
  91. put_unaligned_le32(data_len, usb_ext_prop_data_len_ptr(buf, pnl));
  92. memset(usb_ext_prop_data_ptr(buf, pnl), 0, 2 * (data_len >> 1));
  93. result = utf8_to_utf16le(string, (__le16 *) usb_ext_prop_data_ptr(buf, pnl),
  94. data_len >> 1);
  95. if (result < 0)
  96. return result;
  97. put_unaligned_le16(0,
  98. &buf[USB_EXT_PROP_B_PROPERTY_DATA + pnl + data_len - 2]);
  99. return data_len;
  100. }
  101. #endif /* __U_OS_DESC_H__ */