| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 1 | /* | 
|  | 2 | * Copyright (C) 2013 The Android Open Source Project | 
|  | 3 | * | 
|  | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); | 
|  | 5 | * you may not use this file except in compliance with the License. | 
|  | 6 | * You may obtain a copy of the License at | 
|  | 7 | * | 
|  | 8 | *      http://www.apache.org/licenses/LICENSE-2.0 | 
|  | 9 | * | 
|  | 10 | * Unless required by applicable law or agreed to in writing, software | 
|  | 11 | * distributed under the License is distributed on an "AS IS" BASIS, | 
|  | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | 
|  | 13 | * See the License for the specific language governing permissions and | 
|  | 14 | * limitations under the License. | 
|  | 15 | * | 
|  | 16 | * icmp.c - convenience functions for translating ICMP and ICMPv6 packets. | 
|  | 17 | */ | 
|  | 18 |  | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 19 | #include <linux/icmp.h> | 
|  | 20 | #include <netinet/icmp6.h> | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 21 | #include <netinet/in.h> | 
|  | 22 | #include <netinet/ip_icmp.h> | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 23 |  | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 24 | #include "icmp.h" | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 25 | #include "logging.h" | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 26 |  | 
|  | 27 | /* function: icmp_guess_ttl | 
|  | 28 | * Guesses the number of hops a received packet has traversed based on its TTL. | 
|  | 29 | * ttl - the ttl of the received packet. | 
|  | 30 | */ | 
|  | 31 | uint8_t icmp_guess_ttl(uint8_t ttl) { | 
|  | 32 | if (ttl > 128) { | 
|  | 33 | return 255 - ttl; | 
|  | 34 | } else if (ttl > 64) { | 
|  | 35 | return 128 - ttl; | 
|  | 36 | } else if (ttl > 32) { | 
|  | 37 | return 64 - ttl; | 
|  | 38 | } else { | 
|  | 39 | return 32 - ttl; | 
|  | 40 | } | 
|  | 41 | } | 
|  | 42 |  | 
|  | 43 | /* function: is_icmp_error | 
|  | 44 | * Determines whether an ICMP type is an error message. | 
|  | 45 | * type: the ICMP type | 
|  | 46 | */ | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 47 | int is_icmp_error(uint8_t type) { return type == 3 || type == 11 || type == 12; } | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 48 |  | 
|  | 49 | /* function: is_icmp6_error | 
|  | 50 | * Determines whether an ICMPv6 type is an error message. | 
|  | 51 | * type: the ICMPv6 type | 
|  | 52 | */ | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 53 | int is_icmp6_error(uint8_t type) { return type < 128; } | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 54 |  | 
|  | 55 | /* function: icmp_to_icmp6_type | 
|  | 56 | * Maps ICMP types to ICMPv6 types. Partial implementation of RFC 6145, section 4.2. | 
|  | 57 | * type - the ICMPv6 type | 
|  | 58 | */ | 
|  | 59 | uint8_t icmp_to_icmp6_type(uint8_t type, uint8_t code) { | 
|  | 60 | switch (type) { | 
|  | 61 | case ICMP_ECHO: | 
|  | 62 | return ICMP6_ECHO_REQUEST; | 
|  | 63 |  | 
|  | 64 | case ICMP_ECHOREPLY: | 
|  | 65 | return ICMP6_ECHO_REPLY; | 
|  | 66 |  | 
|  | 67 | case ICMP_TIME_EXCEEDED: | 
|  | 68 | return ICMP6_TIME_EXCEEDED; | 
|  | 69 |  | 
|  | 70 | case ICMP_DEST_UNREACH: | 
|  | 71 | // These two types need special translation which we don't support yet. | 
|  | 72 | if (code != ICMP_UNREACH_PROTOCOL && code != ICMP_UNREACH_NEEDFRAG) { | 
|  | 73 | return ICMP6_DST_UNREACH; | 
|  | 74 | } | 
|  | 75 | } | 
|  | 76 |  | 
|  | 77 | // We don't understand this ICMP type. Return parameter problem so the caller will bail out. | 
|  | 78 | logmsg_dbg(ANDROID_LOG_DEBUG, "icmp_to_icmp6_type: unhandled ICMP type %d", type); | 
|  | 79 | return ICMP6_PARAM_PROB; | 
|  | 80 | } | 
|  | 81 |  | 
|  | 82 | /* function: icmp_to_icmp6_code | 
|  | 83 | * Maps ICMP codes to ICMPv6 codes. Partial implementation of RFC 6145, section 4.2. | 
|  | 84 | * type - the ICMP type | 
|  | 85 | * code - the ICMP code | 
|  | 86 | */ | 
|  | 87 | uint8_t icmp_to_icmp6_code(uint8_t type, uint8_t code) { | 
|  | 88 | switch (type) { | 
|  | 89 | case ICMP_ECHO: | 
|  | 90 | case ICMP_ECHOREPLY: | 
|  | 91 | return 0; | 
|  | 92 |  | 
|  | 93 | case ICMP_TIME_EXCEEDED: | 
|  | 94 | return code; | 
|  | 95 |  | 
|  | 96 | case ICMP_DEST_UNREACH: | 
|  | 97 | switch (code) { | 
|  | 98 | case ICMP_UNREACH_NET: | 
|  | 99 | case ICMP_UNREACH_HOST: | 
|  | 100 | return ICMP6_DST_UNREACH_NOROUTE; | 
|  | 101 |  | 
|  | 102 | case ICMP_UNREACH_PORT: | 
|  | 103 | return ICMP6_DST_UNREACH_NOPORT; | 
|  | 104 |  | 
|  | 105 | case ICMP_UNREACH_NET_PROHIB: | 
|  | 106 | case ICMP_UNREACH_HOST_PROHIB: | 
|  | 107 | case ICMP_UNREACH_FILTER_PROHIB: | 
|  | 108 | case ICMP_UNREACH_PRECEDENCE_CUTOFF: | 
|  | 109 | return ICMP6_DST_UNREACH_ADMIN; | 
|  | 110 |  | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 111 | // Otherwise, we don't understand this ICMP type/code combination. Fall through. | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 112 | } | 
|  | 113 | } | 
|  | 114 | logmsg_dbg(ANDROID_LOG_DEBUG, "icmp_to_icmp6_code: unhandled ICMP type/code %d/%d", type, code); | 
|  | 115 | return 0; | 
|  | 116 | } | 
|  | 117 |  | 
|  | 118 | /* function: icmp6_to_icmp_type | 
|  | 119 | * Maps ICMPv6 types to ICMP types. Partial implementation of RFC 6145, section 5.2. | 
|  | 120 | * type - the ICMP type | 
|  | 121 | */ | 
|  | 122 | uint8_t icmp6_to_icmp_type(uint8_t type, uint8_t code) { | 
|  | 123 | switch (type) { | 
|  | 124 | case ICMP6_ECHO_REQUEST: | 
|  | 125 | return ICMP_ECHO; | 
|  | 126 |  | 
|  | 127 | case ICMP6_ECHO_REPLY: | 
|  | 128 | return ICMP_ECHOREPLY; | 
|  | 129 |  | 
|  | 130 | case ICMP6_DST_UNREACH: | 
|  | 131 | return ICMP_DEST_UNREACH; | 
|  | 132 |  | 
|  | 133 | case ICMP6_TIME_EXCEEDED: | 
|  | 134 | return ICMP_TIME_EXCEEDED; | 
|  | 135 | } | 
|  | 136 |  | 
|  | 137 | // We don't understand this ICMP type. Return parameter problem so the caller will bail out. | 
| Bernhard Rosenkränzer | a33592b | 2013-12-12 10:28:16 +0100 | [diff] [blame] | 138 | logmsg_dbg(ANDROID_LOG_DEBUG, "icmp6_to_icmp_type: unhandled ICMP type/code %d/%d", type, code); | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 139 | return ICMP_PARAMETERPROB; | 
|  | 140 | } | 
|  | 141 |  | 
|  | 142 | /* function: icmp6_to_icmp_code | 
|  | 143 | * Maps ICMPv6 codes to ICMP codes. Partial implementation of RFC 6145, section 5.2. | 
|  | 144 | * type - the ICMPv6 type | 
|  | 145 | * code - the ICMPv6 code | 
|  | 146 | */ | 
|  | 147 | uint8_t icmp6_to_icmp_code(uint8_t type, uint8_t code) { | 
|  | 148 | switch (type) { | 
|  | 149 | case ICMP6_ECHO_REQUEST: | 
|  | 150 | case ICMP6_ECHO_REPLY: | 
|  | 151 | case ICMP6_TIME_EXCEEDED: | 
|  | 152 | return code; | 
|  | 153 |  | 
|  | 154 | case ICMP6_DST_UNREACH: | 
|  | 155 | switch (code) { | 
|  | 156 | case ICMP6_DST_UNREACH_NOROUTE: | 
|  | 157 | return ICMP_UNREACH_HOST; | 
|  | 158 |  | 
|  | 159 | case ICMP6_DST_UNREACH_ADMIN: | 
|  | 160 | return ICMP_UNREACH_HOST_PROHIB; | 
|  | 161 |  | 
|  | 162 | case ICMP6_DST_UNREACH_BEYONDSCOPE: | 
|  | 163 | return ICMP_UNREACH_HOST; | 
|  | 164 |  | 
|  | 165 | case ICMP6_DST_UNREACH_ADDR: | 
|  | 166 | return ICMP_HOST_UNREACH; | 
|  | 167 |  | 
|  | 168 | case ICMP6_DST_UNREACH_NOPORT: | 
|  | 169 | return ICMP_UNREACH_PORT; | 
|  | 170 |  | 
| junyulai | c4e591a | 2018-11-26 22:36:10 +0900 | [diff] [blame] | 171 | // Otherwise, we don't understand this ICMPv6 type/code combination. Fall through. | 
| Lorenzo Colitti | cd70b35 | 2013-04-10 12:24:56 +0900 | [diff] [blame] | 172 | } | 
|  | 173 | } | 
|  | 174 |  | 
|  | 175 | logmsg_dbg(ANDROID_LOG_DEBUG, "icmp6_to_icmp_code: unhandled ICMP type/code %d/%d", type, code); | 
|  | 176 | return 0; | 
|  | 177 | } |