decode.h 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207
  1. #ifndef __CEPH_DECODE_H
  2. #define __CEPH_DECODE_H
  3. #include <linux/bug.h>
  4. #include <linux/time.h>
  5. #include <asm/unaligned.h>
  6. #include "types.h"
  7. /*
  8. * in all cases,
  9. * void **p pointer to position pointer
  10. * void *end pointer to end of buffer (last byte + 1)
  11. */
  12. static inline u64 ceph_decode_64(void **p)
  13. {
  14. u64 v = get_unaligned_le64(*p);
  15. *p += sizeof(u64);
  16. return v;
  17. }
  18. static inline u32 ceph_decode_32(void **p)
  19. {
  20. u32 v = get_unaligned_le32(*p);
  21. *p += sizeof(u32);
  22. return v;
  23. }
  24. static inline u16 ceph_decode_16(void **p)
  25. {
  26. u16 v = get_unaligned_le16(*p);
  27. *p += sizeof(u16);
  28. return v;
  29. }
  30. static inline u8 ceph_decode_8(void **p)
  31. {
  32. u8 v = *(u8 *)*p;
  33. (*p)++;
  34. return v;
  35. }
  36. static inline void ceph_decode_copy(void **p, void *pv, size_t n)
  37. {
  38. memcpy(pv, *p, n);
  39. *p += n;
  40. }
  41. /*
  42. * bounds check input.
  43. */
  44. static inline int ceph_has_room(void **p, void *end, size_t n)
  45. {
  46. return end >= *p && n <= end - *p;
  47. }
  48. #define ceph_decode_need(p, end, n, bad) \
  49. do { \
  50. if (!likely(ceph_has_room(p, end, n))) \
  51. goto bad; \
  52. } while (0)
  53. #define ceph_decode_64_safe(p, end, v, bad) \
  54. do { \
  55. ceph_decode_need(p, end, sizeof(u64), bad); \
  56. v = ceph_decode_64(p); \
  57. } while (0)
  58. #define ceph_decode_32_safe(p, end, v, bad) \
  59. do { \
  60. ceph_decode_need(p, end, sizeof(u32), bad); \
  61. v = ceph_decode_32(p); \
  62. } while (0)
  63. #define ceph_decode_16_safe(p, end, v, bad) \
  64. do { \
  65. ceph_decode_need(p, end, sizeof(u16), bad); \
  66. v = ceph_decode_16(p); \
  67. } while (0)
  68. #define ceph_decode_8_safe(p, end, v, bad) \
  69. do { \
  70. ceph_decode_need(p, end, sizeof(u8), bad); \
  71. v = ceph_decode_8(p); \
  72. } while (0)
  73. #define ceph_decode_copy_safe(p, end, pv, n, bad) \
  74. do { \
  75. ceph_decode_need(p, end, n, bad); \
  76. ceph_decode_copy(p, pv, n); \
  77. } while (0)
  78. /*
  79. * struct ceph_timespec <-> struct timespec
  80. */
  81. static inline void ceph_decode_timespec(struct timespec *ts,
  82. const struct ceph_timespec *tv)
  83. {
  84. ts->tv_sec = le32_to_cpu(tv->tv_sec);
  85. ts->tv_nsec = le32_to_cpu(tv->tv_nsec);
  86. }
  87. static inline void ceph_encode_timespec(struct ceph_timespec *tv,
  88. const struct timespec *ts)
  89. {
  90. tv->tv_sec = cpu_to_le32(ts->tv_sec);
  91. tv->tv_nsec = cpu_to_le32(ts->tv_nsec);
  92. }
  93. /*
  94. * sockaddr_storage <-> ceph_sockaddr
  95. */
  96. static inline void ceph_encode_addr(struct ceph_entity_addr *a)
  97. {
  98. __be16 ss_family = htons(a->in_addr.ss_family);
  99. a->in_addr.ss_family = *(__u16 *)&ss_family;
  100. }
  101. static inline void ceph_decode_addr(struct ceph_entity_addr *a)
  102. {
  103. __be16 ss_family = *(__be16 *)&a->in_addr.ss_family;
  104. a->in_addr.ss_family = ntohs(ss_family);
  105. WARN_ON(a->in_addr.ss_family == 512);
  106. }
  107. /*
  108. * encoders
  109. */
  110. static inline void ceph_encode_64(void **p, u64 v)
  111. {
  112. put_unaligned_le64(v, (__le64 *)*p);
  113. *p += sizeof(u64);
  114. }
  115. static inline void ceph_encode_32(void **p, u32 v)
  116. {
  117. put_unaligned_le32(v, (__le32 *)*p);
  118. *p += sizeof(u32);
  119. }
  120. static inline void ceph_encode_16(void **p, u16 v)
  121. {
  122. put_unaligned_le16(v, (__le16 *)*p);
  123. *p += sizeof(u16);
  124. }
  125. static inline void ceph_encode_8(void **p, u8 v)
  126. {
  127. *(u8 *)*p = v;
  128. (*p)++;
  129. }
  130. static inline void ceph_encode_copy(void **p, const void *s, int len)
  131. {
  132. memcpy(*p, s, len);
  133. *p += len;
  134. }
  135. /*
  136. * filepath, string encoders
  137. */
  138. static inline void ceph_encode_filepath(void **p, void *end,
  139. u64 ino, const char *path)
  140. {
  141. u32 len = path ? strlen(path) : 0;
  142. BUG_ON(*p + 1 + sizeof(ino) + sizeof(len) + len > end);
  143. ceph_encode_8(p, 1);
  144. ceph_encode_64(p, ino);
  145. ceph_encode_32(p, len);
  146. if (len)
  147. memcpy(*p, path, len);
  148. *p += len;
  149. }
  150. static inline void ceph_encode_string(void **p, void *end,
  151. const char *s, u32 len)
  152. {
  153. BUG_ON(*p + sizeof(len) + len > end);
  154. ceph_encode_32(p, len);
  155. if (len)
  156. memcpy(*p, s, len);
  157. *p += len;
  158. }
  159. #define ceph_encode_need(p, end, n, bad) \
  160. do { \
  161. if (!likely(ceph_has_room(p, end, n))) \
  162. goto bad; \
  163. } while (0)
  164. #define ceph_encode_64_safe(p, end, v, bad) \
  165. do { \
  166. ceph_encode_need(p, end, sizeof(u64), bad); \
  167. ceph_encode_64(p, v); \
  168. } while (0)
  169. #define ceph_encode_32_safe(p, end, v, bad) \
  170. do { \
  171. ceph_encode_need(p, end, sizeof(u32), bad); \
  172. ceph_encode_32(p, v); \
  173. } while (0)
  174. #define ceph_encode_16_safe(p, end, v, bad) \
  175. do { \
  176. ceph_encode_need(p, end, sizeof(u16), bad); \
  177. ceph_encode_16(p, v); \
  178. } while (0)
  179. #define ceph_encode_copy_safe(p, end, pv, n, bad) \
  180. do { \
  181. ceph_encode_need(p, end, n, bad); \
  182. ceph_encode_copy(p, pv, n); \
  183. } while (0)
  184. #define ceph_encode_string_safe(p, end, s, n, bad) \
  185. do { \
  186. ceph_encode_need(p, end, n, bad); \
  187. ceph_encode_string(p, end, s, n); \
  188. } while (0)
  189. #endif