| // Copyright 2012 The Go Authors. All rights reserved. |
| // Use of this source code is governed by a BSD-style |
| // license that can be found in the LICENSE file. |
| |
| package icmp |
| |
| import ( |
| "encoding/binary" |
| |
| "golang.org/x/net/internal/iana" |
| "golang.org/x/net/ipv4" |
| "golang.org/x/net/ipv6" |
| ) |
| |
| // An Echo represents an ICMP echo request or reply message body. |
| type Echo struct { |
| ID int // identifier |
| Seq int // sequence number |
| Data []byte // data |
| } |
| |
| // Len implements the Len method of MessageBody interface. |
| func (p *Echo) Len(proto int) int { |
| if p == nil { |
| return 0 |
| } |
| return 4 + len(p.Data) |
| } |
| |
| // Marshal implements the Marshal method of MessageBody interface. |
| func (p *Echo) Marshal(proto int) ([]byte, error) { |
| b := make([]byte, 4+len(p.Data)) |
| binary.BigEndian.PutUint16(b[:2], uint16(p.ID)) |
| binary.BigEndian.PutUint16(b[2:4], uint16(p.Seq)) |
| copy(b[4:], p.Data) |
| return b, nil |
| } |
| |
| // parseEcho parses b as an ICMP echo request or reply message body. |
| func parseEcho(proto int, _ Type, b []byte) (MessageBody, error) { |
| bodyLen := len(b) |
| if bodyLen < 4 { |
| return nil, errMessageTooShort |
| } |
| p := &Echo{ID: int(binary.BigEndian.Uint16(b[:2])), Seq: int(binary.BigEndian.Uint16(b[2:4]))} |
| if bodyLen > 4 { |
| p.Data = make([]byte, bodyLen-4) |
| copy(p.Data, b[4:]) |
| } |
| return p, nil |
| } |
| |
| // An ExtendedEchoRequest represents an ICMP extended echo request |
| // message body. |
| type ExtendedEchoRequest struct { |
| ID int // identifier |
| Seq int // sequence number |
| Local bool // must be true when identifying by name or index |
| Extensions []Extension // extensions |
| } |
| |
| // Len implements the Len method of MessageBody interface. |
| func (p *ExtendedEchoRequest) Len(proto int) int { |
| if p == nil { |
| return 0 |
| } |
| l, _ := multipartMessageBodyDataLen(proto, false, nil, p.Extensions) |
| return l |
| } |
| |
| // Marshal implements the Marshal method of MessageBody interface. |
| func (p *ExtendedEchoRequest) Marshal(proto int) ([]byte, error) { |
| var typ Type |
| switch proto { |
| case iana.ProtocolICMP: |
| typ = ipv4.ICMPTypeExtendedEchoRequest |
| case iana.ProtocolIPv6ICMP: |
| typ = ipv6.ICMPTypeExtendedEchoRequest |
| default: |
| return nil, errInvalidProtocol |
| } |
| if !validExtensions(typ, p.Extensions) { |
| return nil, errInvalidExtension |
| } |
| b, err := marshalMultipartMessageBody(proto, false, nil, p.Extensions) |
| if err != nil { |
| return nil, err |
| } |
| binary.BigEndian.PutUint16(b[:2], uint16(p.ID)) |
| b[2] = byte(p.Seq) |
| if p.Local { |
| b[3] |= 0x01 |
| } |
| return b, nil |
| } |
| |
| // parseExtendedEchoRequest parses b as an ICMP extended echo request |
| // message body. |
| func parseExtendedEchoRequest(proto int, typ Type, b []byte) (MessageBody, error) { |
| if len(b) < 4 { |
| return nil, errMessageTooShort |
| } |
| p := &ExtendedEchoRequest{ID: int(binary.BigEndian.Uint16(b[:2])), Seq: int(b[2])} |
| if b[3]&0x01 != 0 { |
| p.Local = true |
| } |
| var err error |
| _, p.Extensions, err = parseMultipartMessageBody(proto, typ, b) |
| if err != nil { |
| return nil, err |
| } |
| return p, nil |
| } |
| |
| // An ExtendedEchoReply represents an ICMP extended echo reply message |
| // body. |
| type ExtendedEchoReply struct { |
| ID int // identifier |
| Seq int // sequence number |
| State int // 3-bit state working together with Message.Code |
| Active bool // probed interface is active |
| IPv4 bool // probed interface runs IPv4 |
| IPv6 bool // probed interface runs IPv6 |
| } |
| |
| // Len implements the Len method of MessageBody interface. |
| func (p *ExtendedEchoReply) Len(proto int) int { |
| if p == nil { |
| return 0 |
| } |
| return 4 |
| } |
| |
| // Marshal implements the Marshal method of MessageBody interface. |
| func (p *ExtendedEchoReply) Marshal(proto int) ([]byte, error) { |
| b := make([]byte, 4) |
| binary.BigEndian.PutUint16(b[:2], uint16(p.ID)) |
| b[2] = byte(p.Seq) |
| b[3] = byte(p.State<<5) & 0xe0 |
| if p.Active { |
| b[3] |= 0x04 |
| } |
| if p.IPv4 { |
| b[3] |= 0x02 |
| } |
| if p.IPv6 { |
| b[3] |= 0x01 |
| } |
| return b, nil |
| } |
| |
| // parseExtendedEchoReply parses b as an ICMP extended echo reply |
| // message body. |
| func parseExtendedEchoReply(proto int, _ Type, b []byte) (MessageBody, error) { |
| if len(b) < 4 { |
| return nil, errMessageTooShort |
| } |
| p := &ExtendedEchoReply{ |
| ID: int(binary.BigEndian.Uint16(b[:2])), |
| Seq: int(b[2]), |
| State: int(b[3]) >> 5, |
| } |
| if b[3]&0x04 != 0 { |
| p.Active = true |
| } |
| if b[3]&0x02 != 0 { |
| p.IPv4 = true |
| } |
| if b[3]&0x01 != 0 { |
| p.IPv6 = true |
| } |
| return p, nil |
| } |