addons.go 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169
  1. // +build !confonly
  2. package encoding
  3. import (
  4. "io"
  5. "github.com/golang/protobuf/proto"
  6. "v2ray.com/core/common/buf"
  7. "v2ray.com/core/common/protocol"
  8. )
  9. // EncodeHeaderAddons Add addons byte to the header
  10. func EncodeHeaderAddons(buffer *buf.Buffer, addons *Addons) error {
  11. switch addons.Flow {
  12. default:
  13. if err := buffer.WriteByte(0); err != nil {
  14. return newError("failed to write addons protobuf length").Base(err)
  15. }
  16. }
  17. return nil
  18. }
  19. func DecodeHeaderAddons(buffer *buf.Buffer, reader io.Reader) (*Addons, error) {
  20. addons := new(Addons)
  21. buffer.Clear()
  22. if _, err := buffer.ReadFullFrom(reader, 1); err != nil {
  23. return nil, newError("failed to read addons protobuf length").Base(err)
  24. }
  25. if length := int32(buffer.Byte(0)); length != 0 {
  26. buffer.Clear()
  27. if _, err := buffer.ReadFullFrom(reader, length); err != nil {
  28. return nil, newError("failed to read addons protobuf value").Base(err)
  29. }
  30. if err := proto.Unmarshal(buffer.Bytes(), addons); err != nil {
  31. return nil, newError("failed to unmarshal addons protobuf value").Base(err)
  32. }
  33. // Verification.
  34. switch addons.Flow {
  35. default:
  36. }
  37. }
  38. return addons, nil
  39. }
  40. // EncodeBodyAddons returns a Writer that auto-encrypt content written by caller.
  41. func EncodeBodyAddons(writer io.Writer, request *protocol.RequestHeader, addons *Addons) buf.Writer {
  42. switch addons.Flow {
  43. default:
  44. if request.Command == protocol.RequestCommandUDP {
  45. return NewMultiLengthPacketWriter(writer.(buf.Writer))
  46. }
  47. }
  48. return buf.NewWriter(writer)
  49. }
  50. // DecodeBodyAddons returns a Reader from which caller can fetch decrypted body.
  51. func DecodeBodyAddons(reader io.Reader, request *protocol.RequestHeader, addons *Addons) buf.Reader {
  52. switch addons.Flow {
  53. default:
  54. if request.Command == protocol.RequestCommandUDP {
  55. return NewLengthPacketReader(reader)
  56. }
  57. }
  58. return buf.NewReader(reader)
  59. }
  60. func NewMultiLengthPacketWriter(writer buf.Writer) *MultiLengthPacketWriter {
  61. return &MultiLengthPacketWriter{
  62. Writer: writer,
  63. }
  64. }
  65. type MultiLengthPacketWriter struct {
  66. buf.Writer
  67. }
  68. func (w *MultiLengthPacketWriter) WriteMultiBuffer(mb buf.MultiBuffer) error {
  69. defer buf.ReleaseMulti(mb)
  70. mb2Write := make(buf.MultiBuffer, 0, len(mb)+1)
  71. for _, b := range mb {
  72. length := b.Len()
  73. if length == 0 || length+2 > buf.Size {
  74. continue
  75. }
  76. eb := buf.New()
  77. if err := eb.WriteByte(byte(length >> 8)); err != nil {
  78. eb.Release()
  79. continue
  80. }
  81. if err := eb.WriteByte(byte(length)); err != nil {
  82. eb.Release()
  83. continue
  84. }
  85. if _, err := eb.Write(b.Bytes()); err != nil {
  86. eb.Release()
  87. continue
  88. }
  89. mb2Write = append(mb2Write, eb)
  90. }
  91. if mb2Write.IsEmpty() {
  92. return nil
  93. }
  94. return w.Writer.WriteMultiBuffer(mb2Write)
  95. }
  96. type LengthPacketWriter struct {
  97. io.Writer
  98. cache []byte
  99. }
  100. func (w *LengthPacketWriter) WriteMultiBuffer(mb buf.MultiBuffer) error {
  101. length := mb.Len() // none of mb is nil
  102. if length == 0 {
  103. return nil
  104. }
  105. defer func() {
  106. w.cache = w.cache[:0]
  107. }()
  108. w.cache = append(w.cache, byte(length>>8), byte(length))
  109. for i, b := range mb {
  110. w.cache = append(w.cache, b.Bytes()...)
  111. b.Release()
  112. mb[i] = nil
  113. }
  114. if _, err := w.Write(w.cache); err != nil {
  115. return newError("failed to write a packet").Base(err)
  116. }
  117. return nil
  118. }
  119. func NewLengthPacketReader(reader io.Reader) *LengthPacketReader {
  120. return &LengthPacketReader{
  121. Reader: reader,
  122. cache: make([]byte, 2),
  123. }
  124. }
  125. type LengthPacketReader struct {
  126. io.Reader
  127. cache []byte
  128. }
  129. func (r *LengthPacketReader) ReadMultiBuffer() (buf.MultiBuffer, error) {
  130. if _, err := io.ReadFull(r.Reader, r.cache); err != nil { // maybe EOF
  131. return nil, newError("failed to read packet length").Base(err)
  132. }
  133. length := int32(r.cache[0])<<8 | int32(r.cache[1])
  134. mb := make(buf.MultiBuffer, 0, length/buf.Size+1)
  135. for length > 0 {
  136. size := length
  137. if size > buf.Size {
  138. size = buf.Size
  139. }
  140. length -= size
  141. b := buf.New()
  142. if _, err := b.ReadFullFrom(r.Reader, size); err != nil {
  143. return nil, newError("failed to read packet payload").Base(err)
  144. }
  145. mb = append(mb, b)
  146. }
  147. return mb, nil
  148. }