header.go 5.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163
  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. const (
  29. Version = 4 // protocol version
  30. HeaderLen = 20 // header length without extension headers
  31. maxHeaderLen = 60 // sensible default, revisit if later RFCs define new usage of version and header length fields
  32. )
  33. const (
  34. posTOS = 1 // type-of-service
  35. posTotalLen = 2 // packet total length
  36. posID = 4 // identification
  37. posFragOff = 6 // fragment offset
  38. posTTL = 8 // time-to-live
  39. posProtocol = 9 // next protocol
  40. posChecksum = 10 // checksum
  41. posSrc = 12 // source address
  42. posDst = 16 // destination address
  43. )
  44. type HeaderFlags int
  45. const (
  46. MoreFragments HeaderFlags = 1 << iota // more fragments flag
  47. DontFragment // don't fragment flag
  48. )
  49. // A Header represents an IPv4 header.
  50. type Header struct {
  51. Version int // protocol version
  52. Len int // header length
  53. TOS int // type-of-service
  54. TotalLen int // packet total length
  55. ID int // identification
  56. Flags HeaderFlags // flags
  57. FragOff int // fragment offset
  58. TTL int // time-to-live
  59. Protocol int // next protocol
  60. Checksum int // checksum
  61. Src net.IP // source address
  62. Dst net.IP // destination address
  63. Options []byte // options, extension headers
  64. }
  65. func (h *Header) String() string {
  66. if h == nil {
  67. return "<nil>"
  68. }
  69. 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)
  70. }
  71. // Please refer to the online manual; IP(4) on Darwin, FreeBSD and
  72. // OpenBSD. IP(7) on Linux.
  73. const supportsNewIPInput = runtime.GOOS == "linux" || runtime.GOOS == "openbsd"
  74. // Marshal returns the binary encoding of the IPv4 header h.
  75. func (h *Header) Marshal() ([]byte, error) {
  76. if h == nil {
  77. return nil, syscall.EINVAL
  78. }
  79. if h.Len < HeaderLen {
  80. return nil, errHeaderTooShort
  81. }
  82. hdrlen := HeaderLen + len(h.Options)
  83. b := make([]byte, hdrlen)
  84. b[0] = byte(Version<<4 | (hdrlen >> 2 & 0x0f))
  85. b[posTOS] = byte(h.TOS)
  86. flagsAndFragOff := (h.FragOff & 0x1fff) | int(h.Flags<<13)
  87. if supportsNewIPInput {
  88. b[posTotalLen], b[posTotalLen+1] = byte(h.TotalLen>>8), byte(h.TotalLen)
  89. b[posFragOff], b[posFragOff+1] = byte(flagsAndFragOff>>8), byte(flagsAndFragOff)
  90. } else {
  91. *(*uint16)(unsafe.Pointer(&b[posTotalLen : posTotalLen+1][0])) = uint16(h.TotalLen)
  92. *(*uint16)(unsafe.Pointer(&b[posFragOff : posFragOff+1][0])) = uint16(flagsAndFragOff)
  93. }
  94. b[posID], b[posID+1] = byte(h.ID>>8), byte(h.ID)
  95. b[posTTL] = byte(h.TTL)
  96. b[posProtocol] = byte(h.Protocol)
  97. b[posChecksum], b[posChecksum+1] = byte(h.Checksum>>8), byte(h.Checksum)
  98. if ip := h.Src.To4(); ip != nil {
  99. copy(b[posSrc:posSrc+net.IPv4len], ip[:net.IPv4len])
  100. }
  101. if ip := h.Dst.To4(); ip != nil {
  102. copy(b[posDst:posDst+net.IPv4len], ip[:net.IPv4len])
  103. } else {
  104. return nil, errMissingAddress
  105. }
  106. if len(h.Options) > 0 {
  107. copy(b[HeaderLen:], h.Options)
  108. }
  109. return b, nil
  110. }
  111. // See http://www.freebsd.org/doc/en/books/porters-handbook/freebsd-versions.html.
  112. var freebsdVersion uint32
  113. // ParseHeader parses b as an IPv4 header.
  114. func ParseHeader(b []byte) (*Header, error) {
  115. if len(b) < HeaderLen {
  116. return nil, errHeaderTooShort
  117. }
  118. hdrlen := int(b[0]&0x0f) << 2
  119. if hdrlen > len(b) {
  120. return nil, errBufferTooShort
  121. }
  122. h := &Header{}
  123. h.Version = int(b[0] >> 4)
  124. h.Len = hdrlen
  125. h.TOS = int(b[posTOS])
  126. if supportsNewIPInput {
  127. h.TotalLen = int(b[posTotalLen])<<8 | int(b[posTotalLen+1])
  128. h.FragOff = int(b[posFragOff])<<8 | int(b[posFragOff+1])
  129. } else {
  130. h.TotalLen = int(*(*uint16)(unsafe.Pointer(&b[posTotalLen : posTotalLen+1][0])))
  131. if runtime.GOOS != "freebsd" || freebsdVersion < 1000000 {
  132. h.TotalLen += hdrlen
  133. }
  134. h.FragOff = int(*(*uint16)(unsafe.Pointer(&b[posFragOff : posFragOff+1][0])))
  135. }
  136. h.Flags = HeaderFlags(h.FragOff&0xe000) >> 13
  137. h.FragOff = h.FragOff & 0x1fff
  138. h.ID = int(b[posID])<<8 | int(b[posID+1])
  139. h.TTL = int(b[posTTL])
  140. h.Protocol = int(b[posProtocol])
  141. h.Checksum = int(b[posChecksum])<<8 | int(b[posChecksum+1])
  142. h.Src = net.IPv4(b[posSrc], b[posSrc+1], b[posSrc+2], b[posSrc+3])
  143. h.Dst = net.IPv4(b[posDst], b[posDst+1], b[posDst+2], b[posDst+3])
  144. if hdrlen-HeaderLen > 0 {
  145. h.Options = make([]byte, hdrlen-HeaderLen)
  146. copy(h.Options, b[HeaderLen:])
  147. }
  148. return h, nil
  149. }