header.go 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170
  1. // Copyright 2012 The Go Authors. All rights reserved.
  2. // Use of this source code is governed by a BSD-style
  3. // license that can be found in the LICENSE file.
  4. package ipv4
  5. import (
  6. "errors"
  7. "fmt"
  8. "net"
  9. "runtime"
  10. "syscall"
  11. "unsafe"
  12. )
  13. var (
  14. errMissingAddress = errors.New("missing address")
  15. errMissingHeader = errors.New("missing header")
  16. errHeaderTooShort = errors.New("header too short")
  17. errBufferTooShort = errors.New("buffer too short")
  18. errInvalidConnType = errors.New("invalid conn type")
  19. )
  20. // References:
  21. //
  22. // RFC 791 Internet Protocol
  23. // http://tools.ietf.org/html/rfc791
  24. // RFC 1112 Host Extensions for IP Multicasting
  25. // http://tools.ietf.org/html/rfc1112
  26. // RFC 1122 Requirements for Internet Hosts
  27. // http://tools.ietf.org/html/rfc1122
  28. // RFC 3678 Socket Interface Extensions for Multicast Source Filters
  29. // http://tools.ietf.org/html/rfc3678
  30. // RFC 4607 Source-Specific Multicast for IP
  31. // http://tools.ietf.org/html/rfc4607
  32. const (
  33. Version = 4 // protocol version
  34. HeaderLen = 20 // header length without extension headers
  35. maxHeaderLen = 60 // sensible default, revisit if later RFCs define new usage of version and header length fields
  36. )
  37. const (
  38. posTOS = 1 // type-of-service
  39. posTotalLen = 2 // packet total length
  40. posID = 4 // identification
  41. posFragOff = 6 // fragment offset
  42. posTTL = 8 // time-to-live
  43. posProtocol = 9 // next protocol
  44. posChecksum = 10 // checksum
  45. posSrc = 12 // source address
  46. posDst = 16 // destination address
  47. )
  48. type HeaderFlags int
  49. const (
  50. MoreFragments HeaderFlags = 1 << iota // more fragments flag
  51. DontFragment // don't fragment flag
  52. )
  53. // A Header represents an IPv4 header.
  54. type Header struct {
  55. Version int // protocol version
  56. Len int // header length
  57. TOS int // type-of-service
  58. TotalLen int // packet total length
  59. ID int // identification
  60. Flags HeaderFlags // flags
  61. FragOff int // fragment offset
  62. TTL int // time-to-live
  63. Protocol int // next protocol
  64. Checksum int // checksum
  65. Src net.IP // source address
  66. Dst net.IP // destination address
  67. Options []byte // options, extension headers
  68. }
  69. func (h *Header) String() string {
  70. if h == nil {
  71. return "<nil>"
  72. }
  73. return fmt.Sprintf("ver: %v, hdrlen: %v, tos: %#x, totallen: %v, id: %#x, flags: %#x, fragoff: %#x, ttl: %v, proto: %v, cksum: %#x, src: %v, dst: %v", h.Version, h.Len, h.TOS, h.TotalLen, h.ID, h.Flags, h.FragOff, h.TTL, h.Protocol, h.Checksum, h.Src, h.Dst)
  74. }
  75. // Please refer to the online manual; IP(4) on Darwin, FreeBSD and
  76. // OpenBSD. IP(7) on Linux.
  77. const supportsNewIPInput = runtime.GOOS == "linux" || runtime.GOOS == "openbsd"
  78. // Marshal returns the binary encoding of the IPv4 header h.
  79. func (h *Header) Marshal() ([]byte, error) {
  80. if h == nil {
  81. return nil, syscall.EINVAL
  82. }
  83. if h.Len < HeaderLen {
  84. return nil, errHeaderTooShort
  85. }
  86. hdrlen := HeaderLen + len(h.Options)
  87. b := make([]byte, hdrlen)
  88. b[0] = byte(Version<<4 | (hdrlen >> 2 & 0x0f))
  89. b[posTOS] = byte(h.TOS)
  90. flagsAndFragOff := (h.FragOff & 0x1fff) | int(h.Flags<<13)
  91. if supportsNewIPInput {
  92. b[posTotalLen], b[posTotalLen+1] = byte(h.TotalLen>>8), byte(h.TotalLen)
  93. b[posFragOff], b[posFragOff+1] = byte(flagsAndFragOff>>8), byte(flagsAndFragOff)
  94. } else {
  95. // TODO(mikio): fix potential misaligned memory access
  96. *(*uint16)(unsafe.Pointer(&b[posTotalLen : posTotalLen+1][0])) = uint16(h.TotalLen)
  97. *(*uint16)(unsafe.Pointer(&b[posFragOff : posFragOff+1][0])) = uint16(flagsAndFragOff)
  98. }
  99. b[posID], b[posID+1] = byte(h.ID>>8), byte(h.ID)
  100. b[posTTL] = byte(h.TTL)
  101. b[posProtocol] = byte(h.Protocol)
  102. b[posChecksum], b[posChecksum+1] = byte(h.Checksum>>8), byte(h.Checksum)
  103. if ip := h.Src.To4(); ip != nil {
  104. copy(b[posSrc:posSrc+net.IPv4len], ip[:net.IPv4len])
  105. }
  106. if ip := h.Dst.To4(); ip != nil {
  107. copy(b[posDst:posDst+net.IPv4len], ip[:net.IPv4len])
  108. } else {
  109. return nil, errMissingAddress
  110. }
  111. if len(h.Options) > 0 {
  112. copy(b[HeaderLen:], h.Options)
  113. }
  114. return b, nil
  115. }
  116. // See http://www.freebsd.org/doc/en/books/porters-handbook/freebsd-versions.html.
  117. var freebsdVersion uint32
  118. // ParseHeader parses b as an IPv4 header.
  119. func ParseHeader(b []byte) (*Header, error) {
  120. if len(b) < HeaderLen {
  121. return nil, errHeaderTooShort
  122. }
  123. hdrlen := int(b[0]&0x0f) << 2
  124. if hdrlen > len(b) {
  125. return nil, errBufferTooShort
  126. }
  127. h := &Header{}
  128. h.Version = int(b[0] >> 4)
  129. h.Len = hdrlen
  130. h.TOS = int(b[posTOS])
  131. if supportsNewIPInput {
  132. h.TotalLen = int(b[posTotalLen])<<8 | int(b[posTotalLen+1])
  133. h.FragOff = int(b[posFragOff])<<8 | int(b[posFragOff+1])
  134. } else {
  135. // TODO(mikio): fix potential misaligned memory access
  136. h.TotalLen = int(*(*uint16)(unsafe.Pointer(&b[posTotalLen : posTotalLen+1][0])))
  137. if runtime.GOOS != "freebsd" || freebsdVersion < 1000000 {
  138. h.TotalLen += hdrlen
  139. }
  140. // TODO(mikio): fix potential misaligned memory access
  141. h.FragOff = int(*(*uint16)(unsafe.Pointer(&b[posFragOff : posFragOff+1][0])))
  142. }
  143. h.Flags = HeaderFlags(h.FragOff&0xe000) >> 13
  144. h.FragOff = h.FragOff & 0x1fff
  145. h.ID = int(b[posID])<<8 | int(b[posID+1])
  146. h.TTL = int(b[posTTL])
  147. h.Protocol = int(b[posProtocol])
  148. h.Checksum = int(b[posChecksum])<<8 | int(b[posChecksum+1])
  149. h.Src = net.IPv4(b[posSrc], b[posSrc+1], b[posSrc+2], b[posSrc+3])
  150. h.Dst = net.IPv4(b[posDst], b[posDst+1], b[posDst+2], b[posDst+3])
  151. if hdrlen-HeaderLen > 0 {
  152. h.Options = make([]byte, hdrlen-HeaderLen)
  153. copy(h.Options, b[HeaderLen:])
  154. }
  155. return h, nil
  156. }