ICMP6.java
8.26 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
/*
* Copyright 2014 Open Networking Laboratory
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
package org.onlab.packet;
import org.onlab.packet.ipv6.IExtensionHeader;
import org.onlab.packet.ndp.NeighborAdvertisement;
import org.onlab.packet.ndp.NeighborSolicitation;
import org.onlab.packet.ndp.Redirect;
import org.onlab.packet.ndp.RouterAdvertisement;
import org.onlab.packet.ndp.RouterSolicitation;
import java.nio.ByteBuffer;
import java.util.HashMap;
import java.util.Map;
/**
* Implements ICMPv6 packet format. (RFC 4443)
*/
public class ICMP6 extends BasePacket {
public static final byte HEADER_LENGTH = 4; // bytes
public static final byte ROUTER_SOLICITATION = (byte) 0x85;
public static final byte ROUTER_ADVERTISEMENT = (byte) 0x86;
public static final byte NEIGHBOR_SOLICITATION = (byte) 0x87;
public static final byte NEIGHBOR_ADVERTISEMENT = (byte) 0x88;
public static final byte REDIRECT = (byte) 0x89;
public static final Map<Byte, Class<? extends IPacket>> PROTOCOL_CLASS_MAP =
new HashMap<>();
static {
ICMP6.PROTOCOL_CLASS_MAP.put(ICMP6.ROUTER_SOLICITATION, RouterSolicitation.class);
ICMP6.PROTOCOL_CLASS_MAP.put(ICMP6.ROUTER_ADVERTISEMENT, RouterAdvertisement.class);
ICMP6.PROTOCOL_CLASS_MAP.put(ICMP6.NEIGHBOR_SOLICITATION, NeighborSolicitation.class);
ICMP6.PROTOCOL_CLASS_MAP.put(ICMP6.NEIGHBOR_ADVERTISEMENT, NeighborAdvertisement.class);
ICMP6.PROTOCOL_CLASS_MAP.put(ICMP6.REDIRECT, Redirect.class);
}
protected byte icmpType;
protected byte icmpCode;
protected short checksum;
private static final byte[] ZERO_ADDRESS = new byte[Ip6Address.BYTE_LENGTH];
/**
* Gets ICMP6 type.
*
* @return the ICMP6 type
*/
public byte getIcmpType() {
return this.icmpType;
}
/**
* Sets ICMP6 type.
*
* @param icmpType the ICMP type to set
* @return this
*/
public ICMP6 setIcmpType(final byte icmpType) {
this.icmpType = icmpType;
return this;
}
/**
* Gets ICMP6 code.
*
* @return the ICMP6 code
*/
public byte getIcmpCode() {
return this.icmpCode;
}
/**
* Sets ICMP6 code.
*
* @param icmpCode the ICMP6 code to set
* @return this
*/
public ICMP6 setIcmpCode(final byte icmpCode) {
this.icmpCode = icmpCode;
return this;
}
/**
* Gets checksum.
*
* @return the checksum
*/
public short getChecksum() {
return this.checksum;
}
/**
* Sets checksum.
*
* @param checksum the checksum to set
* @return this
*/
public ICMP6 setChecksum(final short checksum) {
this.checksum = checksum;
return this;
}
@Override
public byte[] serialize() {
byte[] payloadData = null;
if (this.payload != null) {
this.payload.setParent(this);
payloadData = this.payload.serialize();
}
int payloadLength = 0;
if (payloadData != null) {
payloadLength = payloadData.length;
}
final byte[] data = new byte[HEADER_LENGTH + payloadLength];
final ByteBuffer bbData = ByteBuffer.wrap(data);
// Creating ByteBuffer for checksum calculation
final byte[] checksumData =
new byte[IPv6.FIXED_HEADER_LENGTH + HEADER_LENGTH + payloadLength];
final ByteBuffer bbChecksum = ByteBuffer.wrap(checksumData);
//
// Creating IPv6 Pseudo Header for checksum calculation according
// to RFC 4443 and RFC 2460
//
IPv6 ipv6Parent = null;
for (IPacket p = this.parent; p != null; p = p.getParent()) {
if (p instanceof IPv6) {
ipv6Parent = (IPv6) p;
break;
}
}
if (ipv6Parent != null) {
bbChecksum.put(((IPv6) ipv6Parent).getSourceAddress());
bbChecksum.put(((IPv6) ipv6Parent).getDestinationAddress());
} else {
// NOTE: IPv6 source and destination addresses unknown. Use zeroes.
bbChecksum.put(ZERO_ADDRESS);
bbChecksum.put(ZERO_ADDRESS);
}
bbChecksum.putInt(HEADER_LENGTH + payloadLength);
bbChecksum.put((byte) 0);
bbChecksum.put((byte) 0);
bbChecksum.put((byte) 0);
bbChecksum.put(IPv6.PROTOCOL_ICMP6);
bbChecksum.put(this.icmpType);
bbChecksum.put(this.icmpCode);
bbChecksum.put((byte) 0);
bbChecksum.put((byte) 0);
bbData.put(this.icmpType);
bbData.put(this.icmpCode);
bbData.putShort(this.checksum);
if (payloadData != null) {
bbData.put(payloadData);
bbChecksum.put(payloadData);
}
if (this.parent != null) {
if (this.parent instanceof IPv6) {
((IPv6) this.parent).setNextHeader(IPv6.PROTOCOL_ICMP6);
} else if (this.parent instanceof IExtensionHeader) {
((IExtensionHeader) this.parent).setNextHeader(IPv6.PROTOCOL_ICMP6);
}
}
// compute checksum if needed
if (this.checksum == 0) {
bbData.rewind();
bbChecksum.rewind();
int accumulation = 0;
for (int i = 0; i < checksumData.length / 2; ++i) {
accumulation += 0xffff & bbChecksum.getShort();
}
// pad to an even number of shorts
if (checksumData.length % 2 > 0) {
accumulation += (bbChecksum.get() & 0xff) << 8;
}
accumulation = (accumulation >> 16 & 0xffff)
+ (accumulation & 0xffff);
this.checksum = (short) (~accumulation & 0xffff);
bbData.putShort(2, this.checksum);
}
return data;
}
/*
* (non-Javadoc)
*
* @see java.lang.Object#hashCode()
*/
@Override
public int hashCode() {
final int prime = 5807;
int result = super.hashCode();
result = prime * result + this.icmpType;
result = prime * result + this.icmpCode;
result = prime * result + this.checksum;
return result;
}
/*
* (non-Javadoc)
*
* @see java.lang.Object#equals(java.lang.Object)
*/
@Override
public boolean equals(final Object obj) {
if (this == obj) {
return true;
}
if (!super.equals(obj)) {
return false;
}
if (!(obj instanceof ICMP6)) {
return false;
}
final ICMP6 other = (ICMP6) obj;
if (this.icmpType != other.icmpType) {
return false;
}
if (this.icmpCode != other.icmpCode) {
return false;
}
if (this.checksum != other.checksum) {
return false;
}
return true;
}
@Override
public IPacket deserialize(final byte[] data, final int offset,
final int length) {
final ByteBuffer bb = ByteBuffer.wrap(data, offset, length);
this.icmpType = bb.get();
this.icmpCode = bb.get();
this.checksum = bb.getShort();
IPacket payload;
if (ICMP6.PROTOCOL_CLASS_MAP.containsKey(this.icmpType)) {
final Class<? extends IPacket> clazz = ICMP6.PROTOCOL_CLASS_MAP
.get(this.icmpType);
try {
payload = clazz.newInstance();
} catch (final Exception e) {
throw new RuntimeException(
"Error parsing payload for ICMP6 packet", e);
}
} else {
payload = new Data();
}
this.payload = payload.deserialize(data, bb.position(),
bb.limit() - bb.position());
this.payload.setParent(this);
return this;
}
}