packet_peer.cpp 6.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257
  1. /*************************************************************************/
  2. /* packet_peer.cpp */
  3. /*************************************************************************/
  4. /* This file is part of: */
  5. /* GODOT ENGINE */
  6. /* http://www.godotengine.org */
  7. /*************************************************************************/
  8. /* Copyright (c) 2007-2015 Juan Linietsky, Ariel Manzur. */
  9. /* */
  10. /* Permission is hereby granted, free of charge, to any person obtaining */
  11. /* a copy of this software and associated documentation files (the */
  12. /* "Software"), to deal in the Software without restriction, including */
  13. /* without limitation the rights to use, copy, modify, merge, publish, */
  14. /* distribute, sublicense, and/or sell copies of the Software, and to */
  15. /* permit persons to whom the Software is furnished to do so, subject to */
  16. /* the following conditions: */
  17. /* */
  18. /* The above copyright notice and this permission notice shall be */
  19. /* included in all copies or substantial portions of the Software. */
  20. /* */
  21. /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
  22. /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
  23. /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
  24. /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
  25. /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
  26. /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
  27. /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
  28. /*************************************************************************/
  29. #include "packet_peer.h"
  30. #include "io/marshalls.h"
  31. #include "globals.h"
  32. /* helpers / binders */
  33. PacketPeer::PacketPeer() {
  34. }
  35. Error PacketPeer::get_packet_buffer(DVector<uint8_t> &r_buffer) const {
  36. const uint8_t *buffer;
  37. int buffer_size;
  38. Error err = get_packet(&buffer,buffer_size);
  39. if (err)
  40. return err;
  41. r_buffer.resize(buffer_size);
  42. if (buffer_size==0)
  43. return OK;
  44. DVector<uint8_t>::Write w = r_buffer.write();
  45. for(int i=0;i<buffer_size;i++)
  46. w[i]=buffer[i];
  47. return OK;
  48. }
  49. Error PacketPeer::put_packet_buffer(const DVector<uint8_t> &p_buffer) {
  50. int len = p_buffer.size();
  51. if (len==0)
  52. return OK;
  53. DVector<uint8_t>::Read r = p_buffer.read();
  54. return put_packet(&r[0],len);
  55. }
  56. Error PacketPeer::get_var(Variant &r_variant) const {
  57. const uint8_t *buffer;
  58. int buffer_size;
  59. Error err = get_packet(&buffer,buffer_size);
  60. if (err)
  61. return err;
  62. return decode_variant(r_variant,buffer,buffer_size);
  63. }
  64. Error PacketPeer::put_var(const Variant& p_packet) {
  65. int len;
  66. Error err = encode_variant(p_packet,NULL,len); // compute len first
  67. if (err)
  68. return err;
  69. if (len==0)
  70. return OK;
  71. uint8_t *buf = (uint8_t*)alloca(len);
  72. ERR_FAIL_COND_V(!buf,ERR_OUT_OF_MEMORY);
  73. err = encode_variant(p_packet,buf,len);
  74. ERR_FAIL_COND_V(err, err);
  75. return put_packet(buf, len);
  76. }
  77. Variant PacketPeer::_bnd_get_var() const {
  78. Variant var;
  79. get_var(var);
  80. return var;
  81. };
  82. void PacketPeer::_bind_methods() {
  83. ObjectTypeDB::bind_method(_MD("get_var"),&PacketPeer::_bnd_get_var);
  84. ObjectTypeDB::bind_method(_MD("put_var", "var:var"),&PacketPeer::put_var);
  85. ObjectTypeDB::bind_method(_MD("get_available_packet_count"),&PacketPeer::get_available_packet_count);
  86. };
  87. /***************/
  88. void PacketPeerStream::_set_stream_peer(REF p_peer) {
  89. ERR_FAIL_COND(p_peer.is_null());
  90. set_stream_peer(p_peer);
  91. }
  92. void PacketPeerStream::_bind_methods() {
  93. ObjectTypeDB::bind_method(_MD("set_stream_peer","peer:StreamPeer"),&PacketPeerStream::_set_stream_peer);
  94. }
  95. Error PacketPeerStream::_poll_buffer() const {
  96. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  97. int read = 0;
  98. Error err = peer->get_partial_data(&temp_buffer[0], ring_buffer.space_left(), read);
  99. if (err)
  100. return err;
  101. if (read==0)
  102. return OK;
  103. int w = ring_buffer.write(&temp_buffer[0],read);
  104. ERR_FAIL_COND_V(w!=read,ERR_BUG);
  105. return OK;
  106. }
  107. int PacketPeerStream::get_available_packet_count() const {
  108. _poll_buffer();
  109. uint32_t remaining = ring_buffer.data_left();
  110. int ofs=0;
  111. int count=0;
  112. while(remaining>=4) {
  113. uint8_t lbuf[4];
  114. ring_buffer.copy(lbuf,ofs,4);
  115. uint32_t len = decode_uint32(lbuf);
  116. remaining-=4;
  117. ofs+=4;
  118. if (len>remaining)
  119. break;
  120. remaining-=len;
  121. ofs+=len;
  122. count++;
  123. }
  124. return count;
  125. }
  126. Error PacketPeerStream::get_packet(const uint8_t **r_buffer,int &r_buffer_size) const {
  127. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  128. _poll_buffer();
  129. int remaining = ring_buffer.data_left();
  130. ERR_FAIL_COND_V(remaining<4,ERR_UNAVAILABLE);
  131. uint8_t lbuf[4];
  132. ring_buffer.copy(lbuf,0,4);
  133. remaining-=4;
  134. uint32_t len = decode_uint32(lbuf);
  135. ERR_FAIL_COND_V(remaining<(int)len,ERR_UNAVAILABLE);
  136. ring_buffer.read(lbuf,4); //get rid of first 4 bytes
  137. ring_buffer.read(&temp_buffer[0],len); // read packet
  138. *r_buffer=&temp_buffer[0];
  139. r_buffer_size=len;
  140. return OK;
  141. }
  142. Error PacketPeerStream::put_packet(const uint8_t *p_buffer,int p_buffer_size) {
  143. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  144. Error err = _poll_buffer(); //won't hurt to poll here too
  145. if (err)
  146. return err;
  147. if (p_buffer_size==0)
  148. return OK;
  149. ERR_FAIL_COND_V( p_buffer_size<0, ERR_INVALID_PARAMETER);
  150. ERR_FAIL_COND_V( p_buffer_size+4 > temp_buffer.size(), ERR_INVALID_PARAMETER );
  151. encode_uint32(p_buffer_size,&temp_buffer[0]);
  152. uint8_t *dst=&temp_buffer[4];
  153. for(int i=0;i<p_buffer_size;i++)
  154. dst[i]=p_buffer[i];
  155. return peer->put_data(&temp_buffer[0],p_buffer_size+4);
  156. }
  157. int PacketPeerStream::get_max_packet_size() const {
  158. return temp_buffer.size();
  159. }
  160. void PacketPeerStream::set_stream_peer(const Ref<StreamPeer> &p_peer) {
  161. ERR_FAIL_COND(p_peer.is_null());
  162. if (p_peer.ptr() != peer.ptr()) {
  163. ring_buffer.advance_read(ring_buffer.data_left()); // reset the ring buffer
  164. };
  165. peer=p_peer;
  166. }
  167. void PacketPeerStream::set_input_buffer_max_size(int p_max_size) {
  168. //warning may lose packets
  169. ERR_EXPLAIN("Buffer in use, resizing would cause loss of data");
  170. ERR_FAIL_COND(ring_buffer.data_left());
  171. ring_buffer.resize(nearest_shift(p_max_size+4));
  172. temp_buffer.resize(nearest_power_of_2(p_max_size+4));
  173. }
  174. PacketPeerStream::PacketPeerStream() {
  175. int rbsize=GLOBAL_DEF( "core/packet_stream_peer_max_buffer_po2",(16));
  176. ring_buffer.resize(rbsize);
  177. temp_buffer.resize(1<<rbsize);
  178. }