packet_peer.cpp 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274
  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-2016 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. last_get_error=OK;
  35. }
  36. Error PacketPeer::get_packet_buffer(DVector<uint8_t> &r_buffer) const {
  37. const uint8_t *buffer;
  38. int buffer_size;
  39. Error err = get_packet(&buffer,buffer_size);
  40. if (err)
  41. return err;
  42. r_buffer.resize(buffer_size);
  43. if (buffer_size==0)
  44. return OK;
  45. DVector<uint8_t>::Write w = r_buffer.write();
  46. for(int i=0;i<buffer_size;i++)
  47. w[i]=buffer[i];
  48. return OK;
  49. }
  50. Error PacketPeer::put_packet_buffer(const DVector<uint8_t> &p_buffer) {
  51. int len = p_buffer.size();
  52. if (len==0)
  53. return OK;
  54. DVector<uint8_t>::Read r = p_buffer.read();
  55. return put_packet(&r[0],len);
  56. }
  57. Error PacketPeer::get_var(Variant &r_variant) const {
  58. const uint8_t *buffer;
  59. int buffer_size;
  60. Error err = get_packet(&buffer,buffer_size);
  61. if (err)
  62. return err;
  63. return decode_variant(r_variant,buffer,buffer_size);
  64. }
  65. Error PacketPeer::put_var(const Variant& p_packet) {
  66. int len;
  67. Error err = encode_variant(p_packet,NULL,len); // compute len first
  68. if (err)
  69. return err;
  70. if (len==0)
  71. return OK;
  72. uint8_t *buf = (uint8_t*)alloca(len);
  73. ERR_FAIL_COND_V(!buf,ERR_OUT_OF_MEMORY);
  74. err = encode_variant(p_packet,buf,len);
  75. ERR_FAIL_COND_V(err, err);
  76. return put_packet(buf, len);
  77. }
  78. Variant PacketPeer::_bnd_get_var() const {
  79. Variant var;
  80. get_var(var);
  81. return var;
  82. };
  83. Error PacketPeer::_put_packet(const DVector<uint8_t> &p_buffer) {
  84. return put_packet_buffer(p_buffer);
  85. }
  86. DVector<uint8_t> PacketPeer::_get_packet() const {
  87. DVector<uint8_t> raw;
  88. last_get_error=get_packet_buffer(raw);
  89. return raw;
  90. }
  91. Error PacketPeer::_get_packet_error() const {
  92. return last_get_error;
  93. }
  94. void PacketPeer::_bind_methods() {
  95. ObjectTypeDB::bind_method(_MD("get_var:Variant"),&PacketPeer::_bnd_get_var);
  96. ObjectTypeDB::bind_method(_MD("put_var", "var:Variant"),&PacketPeer::put_var);
  97. ObjectTypeDB::bind_method(_MD("get_packet"),&PacketPeer::_get_packet);
  98. ObjectTypeDB::bind_method(_MD("put_packet:Error", "buffer"),&PacketPeer::_put_packet);
  99. ObjectTypeDB::bind_method(_MD("get_packet_error:Error"),&PacketPeer::_get_packet_error);
  100. ObjectTypeDB::bind_method(_MD("get_available_packet_count"),&PacketPeer::get_available_packet_count);
  101. };
  102. /***************/
  103. void PacketPeerStream::_set_stream_peer(REF p_peer) {
  104. ERR_FAIL_COND(p_peer.is_null());
  105. set_stream_peer(p_peer);
  106. }
  107. void PacketPeerStream::_bind_methods() {
  108. ObjectTypeDB::bind_method(_MD("set_stream_peer","peer:StreamPeer"),&PacketPeerStream::_set_stream_peer);
  109. }
  110. Error PacketPeerStream::_poll_buffer() const {
  111. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  112. int read = 0;
  113. Error err = peer->get_partial_data(&temp_buffer[0], ring_buffer.space_left(), read);
  114. if (err)
  115. return err;
  116. if (read==0)
  117. return OK;
  118. int w = ring_buffer.write(&temp_buffer[0],read);
  119. ERR_FAIL_COND_V(w!=read,ERR_BUG);
  120. return OK;
  121. }
  122. int PacketPeerStream::get_available_packet_count() const {
  123. _poll_buffer();
  124. uint32_t remaining = ring_buffer.data_left();
  125. int ofs=0;
  126. int count=0;
  127. while(remaining>=4) {
  128. uint8_t lbuf[4];
  129. ring_buffer.copy(lbuf,ofs,4);
  130. uint32_t len = decode_uint32(lbuf);
  131. remaining-=4;
  132. ofs+=4;
  133. if (len>remaining)
  134. break;
  135. remaining-=len;
  136. ofs+=len;
  137. count++;
  138. }
  139. return count;
  140. }
  141. Error PacketPeerStream::get_packet(const uint8_t **r_buffer,int &r_buffer_size) const {
  142. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  143. _poll_buffer();
  144. int remaining = ring_buffer.data_left();
  145. ERR_FAIL_COND_V(remaining<4,ERR_UNAVAILABLE);
  146. uint8_t lbuf[4];
  147. ring_buffer.copy(lbuf,0,4);
  148. remaining-=4;
  149. uint32_t len = decode_uint32(lbuf);
  150. ERR_FAIL_COND_V(remaining<(int)len,ERR_UNAVAILABLE);
  151. ring_buffer.read(lbuf,4); //get rid of first 4 bytes
  152. ring_buffer.read(&temp_buffer[0],len); // read packet
  153. *r_buffer=&temp_buffer[0];
  154. r_buffer_size=len;
  155. return OK;
  156. }
  157. Error PacketPeerStream::put_packet(const uint8_t *p_buffer,int p_buffer_size) {
  158. ERR_FAIL_COND_V(peer.is_null(),ERR_UNCONFIGURED);
  159. Error err = _poll_buffer(); //won't hurt to poll here too
  160. if (err)
  161. return err;
  162. if (p_buffer_size==0)
  163. return OK;
  164. ERR_FAIL_COND_V( p_buffer_size<0, ERR_INVALID_PARAMETER);
  165. ERR_FAIL_COND_V( p_buffer_size+4 > temp_buffer.size(), ERR_INVALID_PARAMETER );
  166. encode_uint32(p_buffer_size,&temp_buffer[0]);
  167. uint8_t *dst=&temp_buffer[4];
  168. for(int i=0;i<p_buffer_size;i++)
  169. dst[i]=p_buffer[i];
  170. return peer->put_data(&temp_buffer[0],p_buffer_size+4);
  171. }
  172. int PacketPeerStream::get_max_packet_size() const {
  173. return temp_buffer.size();
  174. }
  175. void PacketPeerStream::set_stream_peer(const Ref<StreamPeer> &p_peer) {
  176. //ERR_FAIL_COND(p_peer.is_null());
  177. if (p_peer.ptr() != peer.ptr()) {
  178. ring_buffer.advance_read(ring_buffer.data_left()); // reset the ring buffer
  179. };
  180. peer=p_peer;
  181. }
  182. void PacketPeerStream::set_input_buffer_max_size(int p_max_size) {
  183. //warning may lose packets
  184. ERR_EXPLAIN("Buffer in use, resizing would cause loss of data");
  185. ERR_FAIL_COND(ring_buffer.data_left());
  186. ring_buffer.resize(nearest_shift(p_max_size+4));
  187. temp_buffer.resize(nearest_power_of_2(p_max_size+4));
  188. }
  189. PacketPeerStream::PacketPeerStream() {
  190. int rbsize=GLOBAL_DEF( "core/packet_stream_peer_max_buffer_po2",(16));
  191. ring_buffer.resize(rbsize);
  192. temp_buffer.resize(1<<rbsize);
  193. }