开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > 手机WAP编程 > 查看源码
wsp_pdu.c
资源名称：gateway-1.2.1　[点击查看]
上传用户：gzpyjq
上传日期：2013-01-31
资源大小：1852k
文件大小：7k
源码类别：

手机WAP编程

开发平台：

WINDOWS

wsp_pdu.c：源码内容
  1. /* wsp_pdu.c - pack and unpack WSP packets
  2.  *
  3.  * Generates packing and unpacking code from wsp_pdu.def.
  4.  * Code is very similar to wsp_pdu.c, please make any changes in both files.
  5.  *
  6.  * Richard Braakman
  7.  */
  9. #include "gwlib/gwlib.h"
  10. #include "wsp_pdu.h"
  12. WSP_PDU *wsp_pdu_create(int type) {
  13. WSP_PDU *pdu;
  15. pdu = gw_malloc(sizeof(*pdu));
  16. pdu->type = type;
  18. switch (pdu->type) {
  19. #define PDU(name, docstring, fields, is_valid) 
  20. case name: {
  21. struct name *p; p = &pdu->u.name; 
  22. fields 
  23. } break;
  24. #define UINT(field, docstring, bits) p->field = 0;
  25. #define UINTVAR(field, docstring) p->field = 0;
  26. #define OCTSTR(field, docstring, lengthfield) p->field = NULL;
  27. #define REST(field, docstring) p->field = NULL;
  28. #define TYPE(bits, value)
  29. #define RESERVED(bits)
  30. #include "wsp_pdu.def"
  31. #undef RESERVED
  32. #undef TYPE
  33. #undef REST
  34. #undef OCTSTR
  35. #undef UINTVAR
  36. #undef UINT
  37. #undef PDU
  38. default:
  39. panic(0, "Internal error: Unknown PDU type %d", pdu->type);
  40. break;
  41. }
  43. return pdu;
  44. }
  46. void wsp_pdu_destroy(WSP_PDU *pdu) {
  47. if (pdu == NULL)
  48. return;
  50. switch (pdu->type) {
  51. #define PDU(name, docstring, fields, is_valid) 
  52. case name: {
  53. struct name *p; p = &pdu->u.name; 
  54. fields 
  55. } break;
  56. #define UINT(field, docstring, bits)
  57. #define UINTVAR(field, docstring)
  58. #define OCTSTR(field, docstring, lengthfield) octstr_destroy(p->field);
  59. #define REST(field, docstring) octstr_destroy(p->field);
  60. #define TYPE(bits, value)
  61. #define RESERVED(bits)
  62. #include "wsp_pdu.def"
  63. #undef RESERVED
  64. #undef TYPE
  65. #undef REST
  66. #undef OCTSTR
  67. #undef UINTVAR
  68. #undef UINT
  69. #undef PDU
  70. default:
  71. panic(0, "Cannot destroy unknown WSP PDU type %d", pdu->type);
  72. break;
  73. }
  75. gw_free(pdu);
  76. }
  78. /* Determine which type of PDU this is, using the TYPE macros in
  79.  * the definition file. */
  80. static int wsp_pdu_type(Octstr *data) {
  81. long bitpos;
  82. long lastpos = -1;
  83. long lastnumbits = -1;
  84. long lastval = -1;
  85. int thistype;
  87. /* This code looks slow, but an optimizing compiler will
  88.  * reduce it considerably.  gcc -O2 will produce a single
  89.  * call to octstr_get_bits, folllowed by a sequence of
  90.  * tests on lastval. */
  92. /* Only UINT and RESERVED fields may precede the TYPE */
  93. #define PDU(name, docstring, fields, is_valid) 
  94. bitpos = 0; 
  95. thistype = name; 
  96. fields
  97. #define UINT(field, docstring, bits) bitpos += (bits);
  98. #define UINTVAR(field, docstring)
  99. #define OCTSTR(field, docstring, lengthfield)
  100. #define REST(field, docstring)
  101. #define TYPE(bits, value) 
  102. if ((bits) != lastnumbits || bitpos != lastpos) { 
  103. lastval = octstr_get_bits(data, bitpos, (bits)); 
  104. } 
  105. if (lastval == (value)) 
  106. return thistype; 
  107. lastnumbits = (bits); 
  108. lastpos = bitpos;
  109. #define RESERVED(bits) bitpos += (bits);
  110. #include "wsp_pdu.def"
  111. #undef RESERVED
  112. #undef TYPE
  113. #undef REST
  114. #undef OCTSTR
  115. #undef UINTVAR
  116. #undef UINT
  117. #undef PDU
  119. return -1;
  120. }
  122. WSP_PDU *wsp_pdu_unpack(Octstr *data) {
  123. WSP_PDU *pdu = NULL;
  124. long bitpos = 0;
  126. gw_assert(data != NULL);
  128. pdu = gw_malloc(sizeof(*pdu));
  130. pdu->type = wsp_pdu_type(data);
  132. switch (pdu->type) {
  133. #define PDU(name, docstring, fields, is_valid) 
  134. case name: { 
  135. struct name *p = &pdu->u.name; 
  136. fields 
  137. gw_assert(bitpos % 8 == 0); 
  138. if (bitpos / 8 != octstr_len(data)) { 
  139. warning(0, "Bad length for " #name " PDU, " 
  140. "expected %ld", bitpos / 8); 
  141. } 
  142. if (!(is_valid)) { 
  143. warning(0, #name " PDU failed %s", #is_valid); 
  144. } 
  145. } break;
  146. #define UINT(field, docstring, bits) 
  147. p->field = octstr_get_bits(data, bitpos, (bits)); 
  148. bitpos += (bits);
  149. #define UINTVAR(field, docstring) 
  150. gw_assert(bitpos % 8 == 0); 
  151. p->field = octstr_get_bits(data, bitpos + 1, 7); 
  152. while (octstr_get_bits(data, bitpos, 1)) { 
  153. bitpos += 8; 
  154. p->field <<= 7; 
  155. p->field |= octstr_get_bits(data, bitpos + 1, 7); 
  156. } 
  157. bitpos += 8;
  158. #define OCTSTR(field, docstring, lengthfield) 
  159. gw_assert(bitpos % 8 == 0); 
  160. p->field = octstr_copy(data, bitpos / 8, p->lengthfield); 
  161. bitpos += 8 * p->lengthfield;
  162. #define REST(field, docstring) 
  163. gw_assert(bitpos % 8 == 0); 
  164. if (bitpos / 8 <= octstr_len(data)) { 
  165. p->field = octstr_copy(data, bitpos / 8, 
  166. octstr_len(data) - bitpos / 8); 
  167. bitpos = octstr_len(data) * 8; 
  168. } else { 
  169. p->field = octstr_create(""); 
  170. }
  171. #define TYPE(bits, value) bitpos += (bits);
  172. #define RESERVED(bits) bitpos += (bits);
  173. #include "wsp_pdu.def"
  174. #undef RESERVED
  175. #undef TYPE
  176. #undef REST
  177. #undef OCTSTR
  178. #undef UINTVAR
  179. #undef UINT
  180. #undef PDU
  181. default:
  182. warning(0, "WSP PDU with unknown type %d", pdu->type);
  183. gw_free(pdu);
  184. return NULL;
  185. }
  187. return pdu;
  188. }
  190. static void fixup_length_fields(WSP_PDU *pdu) {
  191. switch (pdu->type) {
  192. #define PDU(name, docstring, fields, is_valid) 
  193. case name: { 
  194. struct name *p; p = &pdu->u.name; 
  195. fields 
  196. } break;
  197. #define UINT(field, docstring, bits)
  198. #define UINTVAR(field, docstring)
  199. #define OCTSTR(field, docstring, lengthfield) 
  200. p->lengthfield = octstr_len(p->field);
  201. #define REST(field, docstring)
  202. #define TYPE(bits, value)
  203. #define RESERVED(bits)
  204. #include "wsp_pdu.def"
  205. #undef RESERVED
  206. #undef TYPE
  207. #undef REST
  208. #undef OCTSTR
  209. #undef UINTVAR
  210. #undef UINT
  211. #undef PDU
  212. }
  213. }
  215. Octstr *wsp_pdu_pack(WSP_PDU *pdu) {
  216. Octstr *data;
  217. long bitpos;
  219. /* We rely on octstr_set_bits to lengthen our octstr as needed. */
  220. data = octstr_create("");
  222. fixup_length_fields(pdu);
  224. bitpos = 0;
  225. switch (pdu->type) {
  226. #define PDU(name, docstring, fields, is_valid) 
  227. case name: { 
  228. struct name *p = &pdu->u.name; 
  229. fields 
  230. gw_assert(bitpos % 8 == 0); 
  231. } break;
  232. #define UINT(field, docstring, bits) 
  233. octstr_set_bits(data, bitpos, (bits), p->field); 
  234. bitpos += (bits);
  235. #define UINTVAR(field, docstring) 
  236. gw_assert(bitpos % 8 == 0); 
  237. octstr_append_uintvar(data, p->field); 
  238. bitpos = 8 * octstr_len(data);
  239. #define OCTSTR(field, docstring, lengthfield) 
  240. gw_assert(bitpos % 8 == 0); 
  241. if (p->field != NULL) 
  242. octstr_append(data, p->field); 
  243. bitpos += 8 * octstr_len(p->field);
  244. #define REST(field, docstring) 
  245. gw_assert(bitpos % 8 == 0); 
  246. if (p->field != NULL) 
  247. octstr_append(data, p->field); 
  248. bitpos += 8 * octstr_len(p->field);
  249. #define TYPE(bits, value) 
  250. octstr_set_bits(data, bitpos, (bits), (value)); 
  251. bitpos += (bits);
  252. #define RESERVED(bits) bitpos += (bits);
  253. #include "wsp_pdu.def"
  254. #undef RESERVED
  255. #undef TYPE
  256. #undef REST
  257. #undef OCTSTR
  258. #undef UINTVAR
  259. #undef UINT
  260. #undef PDU
  261. default:
  262. panic(0, "Packing unknown WSP PDU type %ld", (long) pdu->type);
  263. }
  265. return data;
  266. }
  268. void wsp_pdu_dump(WSP_PDU *pdu, int level) {
  269. unsigned char *dbg = "wap.wsp";
  271. switch (pdu->type) {
  272. #define PDU(name, docstring, fields, is_valid) 
  273. case name: { 
  274. struct name *p = &pdu->u.name; 
  275. debug(dbg, 0, "%*sWSP %s PDU at %p:", 
  276. level, "", #name, (void *)pdu); 
  277. fields 
  278. } break;
  279. #define UINT(field, docstring, bits) 
  280. debug(dbg, 0, "%*s %s: %lu", level, "", docstring, p->field);
  281. #define UINTVAR(field, docstring) 
  282. debug(dbg, 0, "%*s %s: %lu", level, "", docstring, p->field);
  283. #define OCTSTR(field, docstring, lengthfield) 
  284. debug(dbg, 0, "%*s %s:", level, "", docstring); 
  285. octstr_dump(p->field, level + 1);
  286. #define REST(field, docstring) 
  287. debug(dbg, 0, "%*s %s:", level, "", docstring); 
  288. octstr_dump(p->field, level + 1);
  289. #define TYPE(bits, value)
  290. #define RESERVED(bits)
  291. #include "wsp_pdu.def"
  292. #undef RESERVED
  293. #undef TYPE
  294. #undef REST
  295. #undef OCTSTR
  296. #undef UINTVAR
  297. #undef UINT
  298. #undef PDU
  299. default:
  300. debug(dbg, 0, "%*sWSP PDU at %p:", level, "", (void *)pdu);
  301. debug(dbg, 0, "%*s unknown type %u", level, "", pdu->type);
  302. break;
  303. }
  304. debug("wap.wsp", 0, "%*sWSP PDU dump ends.", level, "");
  305. }