PacketProtoEncoder.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101
  1. /**
  2. * @file PacketProtoEncoder.c
  3. * @author Ambroz Bizjak <ambrop7@gmail.com>
  4. *
  5. * @section LICENSE
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions are met:
  9. * 1. Redistributions of source code must retain the above copyright
  10. * notice, this list of conditions and the following disclaimer.
  11. * 2. Redistributions in binary form must reproduce the above copyright
  12. * notice, this list of conditions and the following disclaimer in the
  13. * documentation and/or other materials provided with the distribution.
  14. * 3. Neither the name of the author nor the
  15. * names of its contributors may be used to endorse or promote products
  16. * derived from this software without specific prior written permission.
  17. *
  18. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
  19. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  20. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  21. * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  22. * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  23. * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  24. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  25. * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  27. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28. */
  29. #include <stddef.h>
  30. #include <string.h>
  31. #include <protocol/packetproto.h>
  32. #include <misc/balign.h>
  33. #include <misc/debug.h>
  34. #include <misc/byteorder.h>
  35. #include <flow/PacketProtoEncoder.h>
  36. static void output_handler_recv (PacketProtoEncoder *enc, uint8_t *data)
  37. {
  38. ASSERT(!enc->output_packet)
  39. ASSERT(data)
  40. DebugObject_Access(&enc->d_obj);
  41. // schedule receive
  42. enc->output_packet = data;
  43. PacketRecvInterface_Receiver_Recv(enc->input, enc->output_packet + sizeof(struct packetproto_header));
  44. }
  45. static void input_handler_done (PacketProtoEncoder *enc, int in_len)
  46. {
  47. ASSERT(enc->output_packet)
  48. DebugObject_Access(&enc->d_obj);
  49. // write length
  50. struct packetproto_header pp;
  51. pp.len = htol16(in_len);
  52. memcpy(enc->output_packet, &pp, sizeof(pp));
  53. // finish output packet
  54. enc->output_packet = NULL;
  55. PacketRecvInterface_Done(&enc->output, PACKETPROTO_ENCLEN(in_len));
  56. }
  57. void PacketProtoEncoder_Init (PacketProtoEncoder *enc, PacketRecvInterface *input, BPendingGroup *pg)
  58. {
  59. ASSERT(PacketRecvInterface_GetMTU(input) <= PACKETPROTO_MAXPAYLOAD)
  60. // init arguments
  61. enc->input = input;
  62. // init input
  63. PacketRecvInterface_Receiver_Init(enc->input, (PacketRecvInterface_handler_done)input_handler_done, enc);
  64. // init output
  65. PacketRecvInterface_Init(
  66. &enc->output, PACKETPROTO_ENCLEN(PacketRecvInterface_GetMTU(enc->input)),
  67. (PacketRecvInterface_handler_recv)output_handler_recv, enc, pg
  68. );
  69. // set no output packet
  70. enc->output_packet = NULL;
  71. DebugObject_Init(&enc->d_obj);
  72. }
  73. void PacketProtoEncoder_Free (PacketProtoEncoder *enc)
  74. {
  75. DebugObject_Free(&enc->d_obj);
  76. // free input
  77. PacketRecvInterface_Free(&enc->output);
  78. }
  79. PacketRecvInterface * PacketProtoEncoder_GetOutput (PacketProtoEncoder *enc)
  80. {
  81. DebugObject_Access(&enc->d_obj);
  82. return &enc->output;
  83. }