PacketReassembler.cpp 2.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091
  1. //
  2. // Created by Grishka on 19.03.2018.
  3. //
  4. #include "PacketReassembler.h"
  5. #include "logging.h"
  6. #include <assert.h>
  7. using namespace tgvoip;
  8. PacketReassembler::PacketReassembler(){
  9. }
  10. PacketReassembler::~PacketReassembler(){
  11. }
  12. void PacketReassembler::Reset(){
  13. }
  14. void PacketReassembler::AddFragment(Buffer pkt, unsigned int fragmentIndex, unsigned int fragmentCount, uint32_t pts, bool keyframe){
  15. for(Packet& packet:packets){
  16. if(packet.timestamp==pts){
  17. if(fragmentCount!=packet.partCount){
  18. LOGE("Received fragment total count %u inconsistent with previous %u", fragmentCount, packet.partCount);
  19. return;
  20. }
  21. packet.AddFragment(std::move(pkt), fragmentIndex);
  22. return;
  23. }
  24. }
  25. if(pts<maxTimestamp){
  26. LOGW("Received fragment doesn't belong here (ts=%u < maxTs=%u)", pts, maxTimestamp);
  27. return;
  28. }
  29. if(fragmentIndex>=fragmentCount){
  30. LOGE("Received fragment index %u is out of bounds %u", fragmentIndex, fragmentCount);
  31. return;
  32. }
  33. if(fragmentCount>255){
  34. LOGE("Received fragment total count too big %u", fragmentCount);
  35. return;
  36. }
  37. maxTimestamp=std::max(maxTimestamp, pts);
  38. Packet packet(fragmentCount);
  39. packet.timestamp=pts;
  40. packet.isKeyframe=keyframe;
  41. packet.receivedPartCount=0;
  42. packet.AddFragment(std::move(pkt), fragmentIndex);
  43. packets.push_back(std::move(packet));
  44. while(packets.size()>3){
  45. Packet&& old=std::move(packets[0]);
  46. packets.erase(packets.begin());
  47. if(old.receivedPartCount==old.partCount){
  48. Buffer buffer=old.Reassemble();
  49. callback(std::move(buffer), old.timestamp, old.isKeyframe);
  50. //LOGV("Packet %u reassembled", old.timestamp);
  51. }else{
  52. LOGW("Packet %u not reassembled (%u of %u)", old.timestamp, old.receivedPartCount, old.partCount);
  53. }
  54. }
  55. }
  56. void PacketReassembler::SetCallback(std::function<void(Buffer packet, uint32_t pts, bool keyframe)> callback){
  57. this->callback=callback;
  58. }
  59. void PacketReassembler::Packet::AddFragment(Buffer pkt, uint32_t fragmentIndex){
  60. //LOGV("Add fragment %u/%u to packet %u", fragmentIndex, partCount, timestamp);
  61. parts[fragmentIndex]=std::move(pkt);
  62. receivedPartCount++;
  63. }
  64. Buffer PacketReassembler::Packet::Reassemble(){
  65. if(partCount==1){
  66. return std::move(parts[0]);
  67. }
  68. BufferOutputStream out(10240);
  69. for(unsigned int i=0;i<partCount;i++){
  70. out.WriteBytes(parts[i]);
  71. parts[i]=Buffer();
  72. }
  73. return Buffer(std::move(out));
  74. }