1 /* $NetBSD: ctrace.c,v 1.3 2022/04/03 01:10:58 christos Exp $ */ 2 3 /* trace.c 4 5 Subroutines that support dhcp tracing... */ 6 7 /* 8 * Copyright (C) 2004-2022 Internet Systems Consortium, Inc. ("ISC") 9 * Copyright (c) 2001-2003 by Internet Software Consortium 10 * 11 * This Source Code Form is subject to the terms of the Mozilla Public 12 * License, v. 2.0. If a copy of the MPL was not distributed with this 13 * file, You can obtain one at http://mozilla.org/MPL/2.0/. 14 * 15 * THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES 16 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 17 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR 18 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 19 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 20 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT 21 * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 22 * 23 * Internet Systems Consortium, Inc. 24 * PO Box 360 25 * Newmarket, NH 03857 USA 26 * <info@isc.org> 27 * https://www.isc.org/ 28 * 29 */ 30 31 #include <sys/cdefs.h> 32 __RCSID("$NetBSD: ctrace.c,v 1.3 2022/04/03 01:10:58 christos Exp $"); 33 34 #include "dhcpd.h" 35 36 #if defined (TRACING) 37 void trace_interface_register (trace_type_t *ttype, struct interface_info *ip) 38 { 39 trace_interface_packet_t tipkt; 40 41 if (trace_record ()) { 42 memset (&tipkt, 0, sizeof tipkt); 43 memcpy (&tipkt.hw_address, 44 &ip -> hw_address, sizeof ip -> hw_address); 45 if (ip->address_count) 46 memcpy(&tipkt.primary_address, 47 ip->addresses, sizeof(*ip->addresses)); 48 memcpy (tipkt.name, ip -> name, sizeof ip -> name); 49 tipkt.index = htonl (ip -> index); 50 51 trace_write_packet (ttype, sizeof tipkt, (char *)&tipkt, MDL); 52 } 53 } 54 55 void trace_interface_input (trace_type_t *ttype, unsigned len, char *buf) 56 { 57 trace_interface_packet_t *tipkt; 58 struct interface_info *ip; 59 struct sockaddr_in *sin; 60 struct iaddr addr; 61 isc_result_t status; 62 63 if (len != sizeof *tipkt) { 64 log_error ("trace interface packet size mismatch: %ld != %d", 65 (long)(sizeof *tipkt), len); 66 return; 67 } 68 tipkt = (trace_interface_packet_t *)buf; 69 70 ip = (struct interface_info *)0; 71 status = interface_allocate (&ip, MDL); 72 if (status != ISC_R_SUCCESS) { 73 foo: 74 log_error ("trace_interface_input: %s.", 75 isc_result_totext (status)); 76 return; 77 } 78 ip -> ifp = dmalloc (sizeof *(ip -> ifp), MDL); 79 if (!ip -> ifp) { 80 interface_dereference (&ip, MDL); 81 status = ISC_R_NOMEMORY; 82 goto foo; 83 } 84 85 memcpy (&ip -> hw_address, &tipkt -> hw_address, 86 sizeof ip -> hw_address); 87 /* XXX: Without the full addresses state it's not quite a full 88 * trace. 89 */ 90 ip->address_count = ip->address_max = 1; 91 ip->addresses = dmalloc(sizeof(*ip->addresses), MDL); 92 if (!ip->addresses) { 93 dfree(ip->ifp, MDL); 94 ip->ifp = NULL; 95 interface_dereference (&ip, MDL); 96 status = ISC_R_NOMEMORY; 97 goto foo; 98 } 99 memcpy(ip->addresses, &tipkt->primary_address, sizeof(*ip->addresses)); 100 memcpy (ip -> name, tipkt -> name, sizeof ip -> name); 101 ip -> index = ntohl (tipkt -> index); 102 103 interface_snorf (ip, 0); 104 if (dhcp_interface_discovery_hook) 105 (*dhcp_interface_discovery_hook) (ip); 106 107 /* Fake up an ifp. */ 108 memcpy (ip -> ifp -> ifr_name, ip -> name, sizeof ip -> name); 109 #ifdef HAVE_SA_LEN 110 ip -> ifp -> ifr_addr.sa_len = sizeof (struct sockaddr_in); 111 #endif 112 sin = (struct sockaddr_in *)&ip -> ifp -> ifr_addr; 113 sin->sin_addr = ip->addresses[0]; 114 115 addr.len = 4; 116 memcpy (addr.iabuf, &sin -> sin_addr.s_addr, addr.len); 117 if (dhcp_interface_setup_hook) 118 (*dhcp_interface_setup_hook) (ip, &addr); 119 interface_stash (ip); 120 121 if (!quiet_interface_discovery) { 122 log_info ("Listening on Trace/%s/%s%s%s", 123 ip -> name, 124 print_hw_addr (ip -> hw_address.hbuf [0], 125 ip -> hw_address.hlen - 1, 126 &ip -> hw_address.hbuf [1]), 127 (ip -> shared_network ? "/" : ""), 128 (ip -> shared_network ? 129 ip -> shared_network -> name : "")); 130 if (strcmp (ip -> name, "fallback")) { 131 log_info ("Sending on Trace/%s/%s%s%s", 132 ip -> name, 133 print_hw_addr (ip -> hw_address.hbuf [0], 134 ip -> hw_address.hlen - 1, 135 &ip -> hw_address.hbuf [1]), 136 (ip -> shared_network ? "/" : ""), 137 (ip -> shared_network ? 138 ip -> shared_network -> name : "")); 139 } 140 } 141 interface_dereference (&ip, MDL); 142 } 143 144 void trace_interface_stop (trace_type_t *ttype) { 145 /* XXX */ 146 } 147 148 void trace_inpacket_stash (struct interface_info *interface, 149 struct dhcp_packet *packet, 150 unsigned len, 151 unsigned int from_port, 152 struct iaddr from, 153 struct hardware *hfrom) 154 { 155 trace_inpacket_t tip; 156 trace_iov_t iov [2]; 157 158 if (!trace_record ()) 159 return; 160 tip.from_port = from_port; 161 tip.from = from; 162 tip.from.len = htonl (tip.from.len); 163 if (hfrom) { 164 tip.hfrom = *hfrom; 165 tip.havehfrom = 1; 166 } else { 167 memset (&tip.hfrom, 0, sizeof tip.hfrom); 168 tip.havehfrom = 0; 169 } 170 tip.index = htonl (interface -> index); 171 172 iov [0].buf = (char *)&tip; 173 iov [0].len = sizeof tip; 174 iov [1].buf = (char *)packet; 175 iov [1].len = len; 176 trace_write_packet_iov (inpacket_trace, 2, iov, MDL); 177 } 178 179 void trace_inpacket_input (trace_type_t *ttype, unsigned len, char *buf) 180 { 181 trace_inpacket_t *tip; 182 int index; 183 184 if (len < sizeof *tip) { 185 log_error ("trace_input_packet: too short - %d", len); 186 return; 187 } 188 tip = (trace_inpacket_t *)buf; 189 index = ntohl (tip -> index); 190 tip -> from.len = ntohl (tip -> from.len); 191 192 if (index > interface_count || 193 index < 0 || 194 !interface_vector [index]) { 195 log_error ("trace_input_packet: unknown interface index %d", 196 index); 197 return; 198 } 199 200 if (!bootp_packet_handler) { 201 log_error ("trace_input_packet: no bootp packet handler."); 202 return; 203 } 204 205 (*bootp_packet_handler) (interface_vector [index], 206 (struct dhcp_packet *)(tip + 1), 207 len - sizeof *tip, 208 tip -> from_port, 209 tip -> from, 210 (tip -> havehfrom ? 211 &tip -> hfrom 212 : (struct hardware *)0)); 213 } 214 215 void trace_inpacket_stop (trace_type_t *ttype) { } 216 217 ssize_t trace_packet_send (struct interface_info *interface, 218 struct packet *packet, 219 struct dhcp_packet *raw, 220 size_t len, 221 struct in_addr from, 222 struct sockaddr_in *to, 223 struct hardware *hto) 224 { 225 trace_outpacket_t tip; 226 trace_iov_t iov [2]; 227 228 if (trace_record ()) { 229 if (hto) { 230 tip.hto = *hto; 231 tip.havehto = 1; 232 } else { 233 memset (&tip.hto, 0, sizeof tip.hto); 234 tip.havehto = 0; 235 } 236 tip.from.len = 4; 237 memcpy (tip.from.iabuf, &from, 4); 238 tip.to.len = 4; 239 memcpy (tip.to.iabuf, &to -> sin_addr, 4); 240 tip.to_port = to -> sin_port; 241 tip.index = htonl (interface -> index); 242 243 iov [0].buf = (char *)&tip; 244 iov [0].len = sizeof tip; 245 iov [1].buf = (char *)raw; 246 iov [1].len = len; 247 trace_write_packet_iov (outpacket_trace, 2, iov, MDL); 248 } 249 if (!trace_playback ()) { 250 return send_packet (interface, packet, raw, len, 251 from, to, hto); 252 } 253 return len; 254 } 255 256 void trace_outpacket_input (trace_type_t *ttype, unsigned len, char *buf) 257 { 258 trace_outpacket_t *tip; 259 int index; 260 261 if (len < sizeof *tip) { 262 log_error ("trace_input_packet: too short - %d", len); 263 return; 264 } 265 tip = (trace_outpacket_t *)buf; 266 index = ntohl (tip -> index); 267 268 if (index > interface_count || 269 index < 0 || 270 !interface_vector [index]) { 271 log_error ("trace_input_packet: unknown interface index %d", 272 index); 273 return; 274 } 275 276 /* XXX would be nice to somehow take notice of these. */ 277 } 278 279 void trace_outpacket_stop (trace_type_t *ttype) { } 280 281 void trace_seed_stash (trace_type_t *ttype, unsigned seed) 282 { 283 u_int32_t outseed; 284 if (!trace_record ()) 285 return; 286 outseed = htonl (seed); 287 trace_write_packet (ttype, sizeof outseed, (char *)&outseed, MDL); 288 return; 289 } 290 291 void trace_seed_input (trace_type_t *ttype, unsigned length, char *buf) 292 { 293 u_int32_t *seed; 294 295 if (length != sizeof seed) { 296 log_error ("trace_seed_input: wrong size (%d)", length); 297 } 298 seed = (u_int32_t *)buf; 299 srandom (ntohl (*seed)); 300 } 301 302 void trace_seed_stop (trace_type_t *ttype) { } 303 #endif /* TRACING */ 304