frame.py 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173
  1. import struct
  2. from os import urandom
  3. from exceptions import SocketClosed
  4. OPCODE_CONTINUATION = 0x0
  5. OPCODE_TEXT = 0x1
  6. OPCODE_BINARY = 0x2
  7. OPCODE_CLOSE = 0x8
  8. OPCODE_PING = 0x9
  9. OPCODE_PONG = 0xA
  10. class Frame(object):
  11. def __init__(self, opcode, payload, masking_key='', final=True, rsv1=False,
  12. rsv2=False, rsv3=False):
  13. if len(masking_key) not in (0, 4):
  14. raise ValueError('invalid masking key "%s"' % masking_key)
  15. self.final = final
  16. self.rsv1 = rsv1
  17. self.rsv2 = rsv2
  18. self.rsv3 = rsv3
  19. self.opcode = opcode
  20. self.masking_key = masking_key
  21. self.payload = payload
  22. def pack(self):
  23. """
  24. Pack the frame into a string according to the following scheme:
  25. +-+-+-+-+-------+-+-------------+-------------------------------+
  26. |F|R|R|R| opcode|M| Payload len | Extended payload length |
  27. |I|S|S|S| (4) |A| (7) | (16/64) |
  28. |N|V|V|V| |S| | (if payload len==126/127) |
  29. | |1|2|3| |K| | |
  30. +-+-+-+-+-------+-+-------------+ - - - - - - - - - - - - - - - +
  31. | Extended payload length continued, if payload len == 127 |
  32. + - - - - - - - - - - - - - - - +-------------------------------+
  33. | |Masking-key, if MASK set to 1 |
  34. +-------------------------------+-------------------------------+
  35. | Masking-key (continued) | Payload Data |
  36. +-------------------------------- - - - - - - - - - - - - - - - +
  37. : Payload Data continued ... :
  38. + - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - +
  39. | Payload Data continued ... |
  40. +---------------------------------------------------------------+
  41. """
  42. header = struct.pack('!B', (self.fin << 7) | (self.rsv1 << 6) |
  43. (self.rsv2 << 5) | (self.rsv3 << 4) | self.opcode)
  44. mask = bool(self.masking_key) << 7
  45. payload_len = len(self.payload)
  46. if payload_len <= 125:
  47. header += struct.pack('!B', mask | payload_len)
  48. elif payload_len < (1 << 16):
  49. header += struct.pack('!BH', mask | 126, payload_len)
  50. elif payload_len < (1 << 63):
  51. header += struct.pack('!BQ', mask | 127, payload_len)
  52. else:
  53. raise Exception('the payload length is too damn high!')
  54. if self.masking_key:
  55. return header + self.masking_key + self.mask_payload()
  56. return header + self.payload
  57. def mask_payload(self):
  58. return mask(self.masking_key, self.payload)
  59. def fragment(self, fragment_size, mask=False):
  60. frames = []
  61. for start in range(0, len(self.payload), fragment_size):
  62. payload = self.payload[start:start + fragment_size]
  63. key = urandom(4) if mask else ''
  64. frames.append(Frame(OPCODE_CONTINUATION, payload, key, False))
  65. frames[0].opcode = self.opcode
  66. frames[-1].final = True
  67. return frames
  68. def __str__(self):
  69. return '<Frame opcode=%c len=%d>' % (self.opcode, len(self.payload))
  70. def receive_fragments(sock):
  71. """
  72. Receive a sequence of frames that belong together:
  73. - An ititial frame with non-zero opcode
  74. - Zero or more frames with opcode = 0 and final = False
  75. - A final frame with opcpde = 0 and final = True
  76. The first and last frame may be the same frame, having a non-zero opcode
  77. and final = True. Thus, this function returns a list of at least a single
  78. frame.
  79. """
  80. fragments = [receive_frame(sock)]
  81. while not fragments[-1].final:
  82. fragments.append(receive_frame(sock))
  83. return fragments
  84. def receive_frame(sock):
  85. """
  86. Receive a single frame on the given socket.
  87. """
  88. b1, b2 = struct.unpack('!BB', recvn(sock, 2))
  89. final = bool(b1 & 0x80)
  90. rsv1 = bool(b1 & 0x40)
  91. rsv2 = bool(b1 & 0x20)
  92. rsv3 = bool(b1 & 0x10)
  93. opcode = b1 & 0x0F
  94. mask = bool(b2 & 0x80)
  95. payload_len = b2 & 0x7F
  96. if payload_len == 126:
  97. payload_len = struct.unpack('!H', recvn(sock, 2))
  98. elif payload_len == 127:
  99. payload_len = struct.unpack('!Q', recvn(sock, 8))
  100. if mask:
  101. masking_key = recvn(sock, 4)
  102. payload = mask(masking_key, recvn(payload_len))
  103. else:
  104. masking_key = ''
  105. payload = recvn(payload_len)
  106. return Frame(opcode, payload, masking_key=masking_key, final=final,
  107. rsv1=rsv1, rsv2=rsv2, rsv3=rsv3)
  108. def recvn(sock, n):
  109. """
  110. Keep receiving data from `sock' until exactly `n' bytes have been read.
  111. """
  112. data = ''
  113. while len(data) < n:
  114. received = sock.recv(n - len(data))
  115. if not len(received):
  116. raise SocketClosed()
  117. data += received
  118. return data
  119. def mask(key, original):
  120. """
  121. Mask an octet string using the given masking key.
  122. The following masking algorithm is used, as defined in RFC 6455:
  123. for each octet:
  124. j = i MOD 4
  125. transformed-octet-i = original-octet-i XOR masking-key-octet-j
  126. """
  127. if len(key) != 4:
  128. raise ValueError('invalid masking key "%s"' % key)
  129. key = map(ord, key)
  130. masked = bytearray(original)
  131. for i in xrange(len(masked)):
  132. masked[i] ^= key[i % 4]
  133. return masked