addons.go 4.0 KB

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