]> git.saurik.com Git - apple/xnu.git/blobdiff - osfmk/kdp/kdp_udp.c
xnu-2422.1.72.tar.gz
[apple/xnu.git] / osfmk / kdp / kdp_udp.c
index 22bf8978a90950c2bd2d618752309ccf91e886f2..e51c482860309f16dd0bdde6f81c9cb2d268bab3 100644 (file)
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2000-2008 Apple Inc. All rights reserved.
+ * Copyright (c) 2000-2013 Apple Inc. All rights reserved.
  *
  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
  * 
@@ -35,7 +35,6 @@
  * Kernel Debugging Protocol UDP implementation.
  */
 
-#include <mach_kdb.h>
 #include <mach/boolean.h>
 #include <mach/mach_types.h>
 #include <mach/exception_types.h>
 #include <IOKit/IOPlatformExpert.h>
 #include <libkern/version.h>
 
+extern int      inet_aton(const char *, struct kdp_in_addr *); /* in libkern */
+extern char    *inet_ntoa_r(struct kdp_in_addr ina, char *buf,
+    size_t buflen); /* in libkern */
+
 #define DO_ALIGN       1             /* align all packet data accesses */
 #define KDP_SERIAL_IPADDR  0xABADBABE /* IP address used for serial KDP */
 #define LINK_UP_STATUS     (IFM_AVALID | IFM_ACTIVE)
@@ -94,9 +97,124 @@ static u_short ip_id;                          /* ip packet ctr, for ids */
  * Per RFC 768, August, 1980.
  */
 #define UDP_TTL        60 /* deflt time to live for UDP packets */
-int    udp_ttl = UDP_TTL;
+static int udp_ttl = UDP_TTL;
 static unsigned char   exception_seq;
 
+struct kdp_ipovly {
+        uint32_t ih_next, ih_prev;     /* for protocol sequence q's */
+        u_char  ih_x1;                 /* (unused) */
+        u_char  ih_pr;                 /* protocol */
+        short   ih_len;                        /* protocol length */
+        struct  kdp_in_addr ih_src;    /* source internet address */
+        struct  kdp_in_addr ih_dst;    /* destination internet address */
+};
+
+struct kdp_udphdr {
+       u_short uh_sport;               /* source port */
+       u_short uh_dport;               /* destination port */
+       short   uh_ulen;                /* udp length */
+       u_short uh_sum;                 /* udp checksum */
+};
+
+struct  kdp_udpiphdr {
+        struct  kdp_ipovly ui_i;       /* overlaid ip structure */
+        struct  kdp_udphdr ui_u;       /* udp header */
+};
+#define        ui_next         ui_i.ih_next
+#define        ui_prev         ui_i.ih_prev
+#define        ui_x1           ui_i.ih_x1
+#define        ui_pr           ui_i.ih_pr
+#define        ui_len          ui_i.ih_len
+#define        ui_src          ui_i.ih_src
+#define        ui_dst          ui_i.ih_dst
+#define        ui_sport        ui_u.uh_sport
+#define        ui_dport        ui_u.uh_dport
+#define        ui_ulen         ui_u.uh_ulen
+#define        ui_sum          ui_u.uh_sum
+
+struct kdp_ip {
+       union {
+               uint32_t ip_w;
+               struct {
+                       unsigned int
+#ifdef __LITTLE_ENDIAN__
+                       ip_xhl:4,       /* header length */
+                       ip_xv:4,        /* version */
+                       ip_xtos:8,      /* type of service */
+                       ip_xlen:16;     /* total length */
+#endif
+#ifdef __BIG_ENDIAN__
+                       ip_xv:4,        /* version */
+                       ip_xhl:4,       /* header length */
+                       ip_xtos:8,      /* type of service */
+                       ip_xlen:16;     /* total length */
+#endif
+               } ip_x;
+       } ip_vhltl;
+        u_short ip_id;                 /* identification */
+        short   ip_off;                        /* fragment offset field */
+#define        IP_DF 0x4000                    /* dont fragment flag */
+#define        IP_MF 0x2000                    /* more fragments flag */
+#define        IP_OFFMASK 0x1fff               /* mask for fragmenting bits */
+        u_char  ip_ttl;                        /* time to live */
+        u_char  ip_p;                  /* protocol */
+        u_short ip_sum;                        /* checksum */
+        struct  kdp_in_addr ip_src,ip_dst;  /* source and dest address */
+};
+#define        ip_v            ip_vhltl.ip_x.ip_xv
+#define        ip_hl           ip_vhltl.ip_x.ip_xhl
+#define        ip_tos          ip_vhltl.ip_x.ip_xtos
+#define        ip_len          ip_vhltl.ip_x.ip_xlen
+
+#define        IPPROTO_UDP     17
+#define        IPVERSION       4
+
+#define        ETHERTYPE_IP    0x0800  /* IP protocol */
+
+/*
+ * Ethernet Address Resolution Protocol.
+ *
+ * See RFC 826 for protocol description.  Structure below is adapted
+ * to resolving internet addresses.  Field names used correspond to
+ * RFC 826.
+ */
+
+#define        ETHERTYPE_ARP   0x0806  /* Addr. resolution protocol */
+
+struct  kdp_arphdr {
+       u_short ar_hrd;         /* format of hardware address */
+#define        ARPHRD_ETHER    1       /* ethernet hardware format */
+#define        ARPHRD_FRELAY   15      /* frame relay hardware format */
+       u_short ar_pro;         /* format of protocol address */
+       u_char  ar_hln;         /* length of hardware address */
+       u_char  ar_pln;         /* length of protocol address */
+       u_short ar_op;          /* one of: */
+#define        ARPOP_REQUEST   1       /* request to resolve address */
+#define        ARPOP_REPLY     2       /* response to previous request */
+#define        ARPOP_REVREQUEST 3      /* request protocol address given hardware */
+#define        ARPOP_REVREPLY  4       /* response giving protocol address */
+#define        ARPOP_INVREQUEST 8      /* request to identify peer */
+#define        ARPOP_INVREPLY  9       /* response identifying peer */
+};
+
+struct  kdp_ether_arp {
+       struct  kdp_arphdr ea_hdr;              /* fixed-size header */
+       u_char  arp_sha[ETHER_ADDR_LEN];        /* sender hardware address */
+       u_char  arp_spa[4];                     /* sender protocol address */
+       u_char  arp_tha[ETHER_ADDR_LEN];        /* target hardware address */
+       u_char  arp_tpa[4];                     /* target protocol address */
+};
+#define        arp_hrd ea_hdr.ar_hrd
+#define        arp_pro ea_hdr.ar_pro
+#define        arp_hln ea_hdr.ar_hln
+#define        arp_pln ea_hdr.ar_pln
+#define        arp_op  ea_hdr.ar_op
+
+#define        ETHERMTU        1500
+#define        ETHERHDRSIZE    14
+#define        ETHERCRC        4
+#define        KDP_MAXPACKET   (ETHERHDRSIZE + ETHERMTU + ETHERCRC)
+
 static struct {
     unsigned char      data[KDP_MAXPACKET];
     unsigned int       off, len;
@@ -107,12 +225,12 @@ struct kdp_manual_pkt manual_pkt;
 
 struct {
     struct {
-       struct in_addr          in;
-       struct ether_addr       ea;
+       struct kdp_in_addr      in;
+       struct kdp_ether_addr   ea;
     } loc;
     struct {
-       struct in_addr          in;
-       struct ether_addr       ea;
+       struct kdp_in_addr      in;
+       struct kdp_ether_addr   ea;
     } rmt;
 } adr;
 
@@ -142,7 +260,7 @@ static void kdp_serial_send(void *rpkt, unsigned int rpkt_len);
 #endif
 
 static uint32_t kdp_current_ip_address = 0;
-static struct ether_addr kdp_current_mac_address = {{0, 0, 0, 0, 0, 0}};
+static struct kdp_ether_addr kdp_current_mac_address = {{0, 0, 0, 0, 0, 0}};
 static void *kdp_current_ifp;
 
 static void kdp_handler( void *);
@@ -159,12 +277,12 @@ static boolean_t router_specified = FALSE;
 static boolean_t corename_specified = FALSE;
 static unsigned int panicd_port = CORE_REMOTE_PORT;
 
-static struct ether_addr etherbroadcastaddr = {{0xff, 0xff, 0xff, 0xff, 0xff, 0xff}};
+static struct kdp_ether_addr etherbroadcastaddr = {{0xff, 0xff, 0xff, 0xff, 0xff, 0xff}};
 
-static struct ether_addr router_mac = {{0, 0, 0 , 0, 0, 0}};
-static struct ether_addr destination_mac = {{0, 0, 0 , 0, 0, 0}};
-static struct ether_addr temp_mac = {{0, 0, 0 , 0, 0, 0}};
-static struct ether_addr current_resolved_MAC = {{0, 0, 0 , 0, 0, 0}};
+static struct kdp_ether_addr router_mac = {{0, 0, 0 , 0, 0, 0}};
+static struct kdp_ether_addr destination_mac = {{0, 0, 0 , 0, 0, 0}};
+static struct kdp_ether_addr temp_mac = {{0, 0, 0 , 0, 0, 0}};
+static struct kdp_ether_addr current_resolved_MAC = {{0, 0, 0 , 0, 0, 0}};
 
 static boolean_t flag_panic_dump_in_progress = FALSE;
 static boolean_t flag_router_mac_initialized = FALSE;
@@ -178,7 +296,7 @@ static unsigned int last_panic_port = CORE_REMOTE_PORT;
 #define KDP_THROTTLE_VALUE       (10ULL * NSEC_PER_SEC)
 
 uint32_t kdp_crashdump_pkt_size = 512;
-#define KDP_LARGE_CRASHDUMP_PKT_SIZE (1440 - 6 - sizeof(struct udpiphdr))
+#define KDP_LARGE_CRASHDUMP_PKT_SIZE (1440 - 6 - sizeof(struct kdp_udpiphdr))
 static char panicd_ip_str[20];
 static char router_ip_str[20];
 static char corename_str[50];
@@ -195,18 +313,15 @@ extern void               kdp_call(void);
 extern boolean_t       kdp_call_kdb(void);
 extern int             kern_dump(void);
 
-extern int inet_aton(const char *cp, struct in_addr *pin);
-extern int inet_ntoa2(struct in_addr * pin, char * cp, const int len);
-
 void * kdp_get_interface(void);
 void    kdp_set_gateway_mac(void *gatewaymac);
-void   kdp_set_ip_and_mac_addresses(struct in_addr *ipaddr, struct ether_addr *);
-void   kdp_set_interface(void *interface, const struct ether_addr *macaddr);
+void   kdp_set_ip_and_mac_addresses(struct kdp_in_addr *ipaddr, struct kdp_ether_addr *);
+void   kdp_set_interface(void *interface, const struct kdp_ether_addr *macaddr);
 
 void                   kdp_disable_arp(void);
-static void            kdp_arp_reply(struct ether_arp *);
-static void            kdp_process_arp_reply(struct ether_arp *);
-static boolean_t       kdp_arp_resolve(uint32_t, struct ether_addr *);
+static void            kdp_arp_reply(struct kdp_ether_arp *);
+static void            kdp_process_arp_reply(struct kdp_ether_arp *);
+static boolean_t       kdp_arp_resolve(uint32_t, struct kdp_ether_addr *);
 
 static volatile unsigned       kdp_reentry_deadline;
 
@@ -302,7 +417,6 @@ inline static void kdp_receive_data(void *packet, unsigned int *len,
 }
 
 
-
 void kdp_register_link(kdp_link_t link, kdp_mode_t mode)
 {
         kdp_en_linkstatus = link;
@@ -322,12 +436,7 @@ kdp_register_send_receive(
 {
        unsigned int    debug = 0;
 
-       debug_log_init();
-
-       kdp_timer_callout_init();
-
        PE_parse_boot_argn("debug", &debug, sizeof (debug));
-       kdp_crashdump_feature_mask = htonl(kdp_crashdump_feature_mask);
 
 
        if (!debug)
@@ -444,7 +553,7 @@ enaddr_copy(
        void    *dst
 )
 {
-       bcopy((char *)src, (char *)dst, sizeof (struct ether_addr));
+       bcopy((char *)src, (char *)dst, sizeof (struct kdp_ether_addr));
 }
 
 static unsigned short
@@ -475,26 +584,26 @@ kdp_reply(
           const boolean_t         sideband
           )
 {
-       struct udpiphdr         aligned_ui, *ui = &aligned_ui;
-       struct ip               aligned_ip, *ip = &aligned_ip;
-       struct in_addr          tmp_ipaddr;
-       struct ether_addr       tmp_enaddr;
-       struct ether_header     *eh = NULL;
+       struct kdp_udpiphdr     aligned_ui, *ui = &aligned_ui;
+       struct kdp_ip           aligned_ip, *ip = &aligned_ip;
+       struct kdp_in_addr      tmp_ipaddr;
+       struct kdp_ether_addr   tmp_enaddr;
+       struct kdp_ether_header *eh = NULL;
     
        if (!pkt.input)
                kdp_panic("kdp_reply");
        
-       pkt.off -= (unsigned int)sizeof (struct udpiphdr);
+       pkt.off -= (unsigned int)sizeof (struct kdp_udpiphdr);
 
 #if DO_ALIGN    
        bcopy((char *)&pkt.data[pkt.off], (char *)ui, sizeof(*ui));
 #else
-       ui = (struct udpiphdr *)&pkt.data[pkt.off];
+       ui = (struct kdp_udpiphdr *)&pkt.data[pkt.off];
 #endif
        ui->ui_next = ui->ui_prev = 0;
        ui->ui_x1 = 0;
        ui->ui_pr = IPPROTO_UDP;
-       ui->ui_len = htons((u_short)pkt.len + sizeof (struct udphdr));
+       ui->ui_len = htons((u_short)pkt.len + sizeof (struct kdp_udphdr));
        tmp_ipaddr = ui->ui_src;
        ui->ui_src = ui->ui_dst;
        ui->ui_dst = tmp_ipaddr;
@@ -506,12 +615,12 @@ kdp_reply(
        bcopy((char *)ui, (char *)&pkt.data[pkt.off], sizeof(*ui));
        bcopy((char *)&pkt.data[pkt.off], (char *)ip, sizeof(*ip));
 #else
-       ip = (struct ip *)&pkt.data[pkt.off];
+       ip = (struct kdp_ip *)&pkt.data[pkt.off];
 #endif
-       ip->ip_len = htons(sizeof (struct udpiphdr) + pkt.len);
+       ip->ip_len = htons(sizeof (struct kdp_udpiphdr) + pkt.len);
        ip->ip_v = IPVERSION;
        ip->ip_id = htons(ip_id++);
-       ip->ip_hl = sizeof (struct ip) >> 2;
+       ip->ip_hl = sizeof (struct kdp_ip) >> 2;
        ip->ip_ttl = udp_ttl;
        ip->ip_sum = 0;
        ip->ip_sum = htons(~ip_sum((unsigned char *)ip, ip->ip_hl));
@@ -519,17 +628,17 @@ kdp_reply(
        bcopy((char *)ip, (char *)&pkt.data[pkt.off], sizeof(*ip));
 #endif
     
-       pkt.len += (unsigned int)sizeof (struct udpiphdr);
+       pkt.len += (unsigned int)sizeof (struct kdp_udpiphdr);
     
-       pkt.off -= (unsigned int)sizeof (struct ether_header);
+       pkt.off -= (unsigned int)sizeof (struct kdp_ether_header);
     
-       eh = (struct ether_header *)&pkt.data[pkt.off];
+       eh = (struct kdp_ether_header *)&pkt.data[pkt.off];
        enaddr_copy(eh->ether_shost, &tmp_enaddr);
        enaddr_copy(eh->ether_dhost, eh->ether_shost);
        enaddr_copy(&tmp_enaddr, eh->ether_dhost);
        eh->ether_type = htons(ETHERTYPE_IP);
     
-       pkt.len += (unsigned int)sizeof (struct ether_header);
+       pkt.len += (unsigned int)sizeof (struct kdp_ether_header);
     
        // save reply for possible retransmission
        assert(pkt.len <= KDP_MAXPACKET);
@@ -548,24 +657,24 @@ kdp_send(
     unsigned short             remote_port
 )
 {
-    struct udpiphdr            aligned_ui, *ui = &aligned_ui;
-    struct ip                  aligned_ip, *ip = &aligned_ip;
-    struct ether_header                *eh;
+    struct kdp_udpiphdr                aligned_ui, *ui = &aligned_ui;
+    struct kdp_ip              aligned_ip, *ip = &aligned_ip;
+    struct kdp_ether_header    *eh;
     
     if (pkt.input)
        kdp_panic("kdp_send");
 
-    pkt.off -= (unsigned int)sizeof (struct udpiphdr);
+    pkt.off -= (unsigned int)sizeof (struct kdp_udpiphdr);
 
 #if DO_ALIGN
     bcopy((char *)&pkt.data[pkt.off], (char *)ui, sizeof(*ui));
 #else
-    ui = (struct udpiphdr *)&pkt.data[pkt.off];
+    ui = (struct kdp_udpiphdr *)&pkt.data[pkt.off];
 #endif
     ui->ui_next = ui->ui_prev = 0;
     ui->ui_x1 = 0;
     ui->ui_pr = IPPROTO_UDP;
-    ui->ui_len = htons((u_short)pkt.len + sizeof (struct udphdr));
+    ui->ui_len = htons((u_short)pkt.len + sizeof (struct kdp_udphdr));
     ui->ui_src = adr.loc.in;
     ui->ui_dst = adr.rmt.in;
     ui->ui_sport = htons(KDP_REMOTE_PORT);
@@ -576,12 +685,12 @@ kdp_send(
     bcopy((char *)ui, (char *)&pkt.data[pkt.off], sizeof(*ui));
     bcopy((char *)&pkt.data[pkt.off], (char *)ip, sizeof(*ip));
 #else
-    ip = (struct ip *)&pkt.data[pkt.off];
+    ip = (struct kdp_ip *)&pkt.data[pkt.off];
 #endif
-    ip->ip_len = htons(sizeof (struct udpiphdr) + pkt.len);
+    ip->ip_len = htons(sizeof (struct kdp_udpiphdr) + pkt.len);
     ip->ip_v = IPVERSION;
     ip->ip_id = htons(ip_id++);
-    ip->ip_hl = sizeof (struct ip) >> 2;
+    ip->ip_hl = sizeof (struct kdp_ip) >> 2;
     ip->ip_ttl = udp_ttl;
     ip->ip_sum = 0;
     ip->ip_sum = htons(~ip_sum((unsigned char *)ip, ip->ip_hl));
@@ -589,16 +698,16 @@ kdp_send(
     bcopy((char *)ip, (char *)&pkt.data[pkt.off], sizeof(*ip));
 #endif
     
-    pkt.len += (unsigned int)sizeof (struct udpiphdr);
+    pkt.len += (unsigned int)sizeof (struct kdp_udpiphdr);
     
-    pkt.off -= (unsigned int)sizeof (struct ether_header);
+    pkt.off -= (unsigned int)sizeof (struct kdp_ether_header);
     
-    eh = (struct ether_header *)&pkt.data[pkt.off];
+    eh = (struct kdp_ether_header *)&pkt.data[pkt.off];
     enaddr_copy(&adr.loc.ea, eh->ether_shost);
     enaddr_copy(&adr.rmt.ea, eh->ether_dhost);
     eh->ether_type = htons(ETHERTYPE_IP);
     
-    pkt.len += (unsigned int)sizeof (struct ether_header);
+    pkt.len += (unsigned int)sizeof (struct kdp_ether_header);
     kdp_send_data(&pkt.data[pkt.off], pkt.len);
 }
 
@@ -619,10 +728,10 @@ inline static void debugger_if_necessary(void)
    when the interface gets initialized for real.
 */
 void
-kdp_set_interface(void *ifp, const struct ether_addr *macaddr)
+kdp_set_interface(void *ifp, const struct kdp_ether_addr *macaddr)
 {
        char kdpstr[80];
-        struct in_addr addr = { 0 };
+        struct kdp_in_addr addr = { 0 };
         unsigned int len;
         
        kdp_current_ifp = ifp;
@@ -669,8 +778,8 @@ kdp_get_interface(void)
 
 void 
 kdp_set_ip_and_mac_addresses(
-       struct in_addr          *ipaddr, 
-       struct ether_addr       *macaddr)
+       struct kdp_in_addr              *ipaddr, 
+       struct kdp_ether_addr   *macaddr)
 {
         static uint64_t last_time    = (uint64_t) -1;
         static uint64_t throttle_val = 0;
@@ -690,7 +799,7 @@ kdp_set_ip_and_mac_addresses(
         if (save_ip_in_nvram == FALSE)
             goto done;
 
-        if (inet_ntoa2(ipaddr, addr, sizeof(addr)) == FALSE)
+        if (inet_ntoa_r(*ipaddr, addr, sizeof(addr)) == NULL)
             goto done;
 
         /* throttle writes if needed */
@@ -712,11 +821,11 @@ done:
 void
 kdp_set_gateway_mac(void *gatewaymac)
 {
-    router_mac = *(struct ether_addr *)gatewaymac;
+    router_mac = *(struct kdp_ether_addr *)gatewaymac;
     flag_router_mac_initialized = TRUE;
 } 
 
-struct ether_addr 
+struct kdp_ether_addr 
 kdp_get_mac_addr(void)
 {
   return kdp_current_mac_address;
@@ -737,10 +846,10 @@ kdp_disable_arp(void)
 static void
 kdp_arp_dispatch(void)
 {
-       struct ether_arp        aligned_ea, *ea = &aligned_ea;
+       struct kdp_ether_arp    aligned_ea, *ea = &aligned_ea;
        unsigned                arp_header_offset;
 
-       arp_header_offset = (unsigned)sizeof(struct ether_header) + pkt.off;
+       arp_header_offset = (unsigned)sizeof(struct kdp_ether_header) + pkt.off;
        memcpy((void *)ea, (void *)&pkt.data[arp_header_offset], sizeof(*ea));
 
        switch(ntohs(ea->arp_op)) {
@@ -756,18 +865,18 @@ kdp_arp_dispatch(void)
 }
 
 static void
-kdp_process_arp_reply(struct ether_arp *ea)
+kdp_process_arp_reply(struct kdp_ether_arp *ea)
 {
        /* Are we interested in ARP replies? */
        if (flag_arp_resolved == TRUE)
                return;
 
        /* Did we receive a reply from the right source? */
-       if (((struct in_addr *)(ea->arp_spa))->s_addr != target_ip)
+       if (((struct kdp_in_addr *)(ea->arp_spa))->s_addr != target_ip)
          return;
 
        flag_arp_resolved = TRUE;
-       current_resolved_MAC = *(struct ether_addr *) (ea->arp_sha);
+       current_resolved_MAC = *(struct kdp_ether_addr *) (ea->arp_sha);
 
        return;
 }
@@ -777,15 +886,15 @@ kdp_process_arp_reply(struct ether_arp *ea)
  */
 
 static void 
-kdp_arp_reply(struct ether_arp *ea)
+kdp_arp_reply(struct kdp_ether_arp *ea)
 {
-       struct ether_header     *eh;
+       struct kdp_ether_header *eh;
 
-       struct in_addr          isaddr, itaddr, myaddr;
-       struct ether_addr       my_enaddr;
+       struct kdp_in_addr              isaddr, itaddr, myaddr;
+       struct kdp_ether_addr   my_enaddr;
 
-       eh = (struct ether_header *)&pkt.data[pkt.off];
-       pkt.off += (unsigned int)sizeof(struct ether_header);
+       eh = (struct kdp_ether_header *)&pkt.data[pkt.off];
+       pkt.off += (unsigned int)sizeof(struct kdp_ether_header);
 
        if(ntohs(ea->arp_op) != ARPOP_REQUEST)
          return;
@@ -819,7 +928,7 @@ kdp_arp_reply(struct ether_arp *ea)
                (void)memcpy(eh->ether_shost, &my_enaddr, sizeof(eh->ether_shost));
                eh->ether_type = htons(ETHERTYPE_ARP);
                (void)memcpy(&pkt.data[pkt.off], ea, sizeof(*ea));
-               pkt.off -= (unsigned int)sizeof (struct ether_header);
+               pkt.off -= (unsigned int)sizeof (struct kdp_ether_header);
                /* pkt.len is still the length we want, ether_header+ether_arp */
                kdp_send_data(&pkt.data[pkt.off], pkt.len);
        }
@@ -828,9 +937,9 @@ kdp_arp_reply(struct ether_arp *ea)
 static void
 kdp_poll(void)
 {
-       struct ether_header     *eh = NULL;
-       struct udpiphdr         aligned_ui, *ui = &aligned_ui;
-       struct ip               aligned_ip, *ip = &aligned_ip;
+       struct kdp_ether_header *eh = NULL;
+       struct kdp_udpiphdr     aligned_ui, *ui = &aligned_ui;
+       struct kdp_ip           aligned_ip, *ip = &aligned_ip;
        static int              msg_printed;
 
        if (pkt.input)
@@ -850,9 +959,9 @@ kdp_poll(void)
        if (pkt.len == 0)
                return;
 
-       if (pkt.len >= sizeof(struct ether_header))
+       if (pkt.len >= sizeof(struct kdp_ether_header))
        {
-               eh = (struct ether_header *)&pkt.data[pkt.off];  
+               eh = (struct kdp_ether_header *)&pkt.data[pkt.off];  
        
                if (kdp_flag & KDP_ARP)
                {
@@ -864,10 +973,10 @@ kdp_poll(void)
                }
        }
 
-       if (pkt.len < (sizeof (struct ether_header) + sizeof (struct udpiphdr)))
+       if (pkt.len < (sizeof (struct kdp_ether_header) + sizeof (struct kdp_udpiphdr)))
                return;
 
-       pkt.off += (unsigned int)sizeof (struct ether_header);
+       pkt.off += (unsigned int)sizeof (struct kdp_ether_header);
        if (ntohs(eh->ether_type) != ETHERTYPE_IP) {
                return;
        }
@@ -876,16 +985,16 @@ kdp_poll(void)
        bcopy((char *)&pkt.data[pkt.off], (char *)ui, sizeof(*ui));
        bcopy((char *)&pkt.data[pkt.off], (char *)ip, sizeof(*ip));
 #else
-       ui = (struct udpiphdr *)&pkt.data[pkt.off];
-       ip = (struct ip *)&pkt.data[pkt.off];
+       ui = (struct kdp_udpiphdr *)&pkt.data[pkt.off];
+       ip = (struct kdp_ip *)&pkt.data[pkt.off];
 #endif
 
-       pkt.off += (unsigned int)sizeof (struct udpiphdr);
+       pkt.off += (unsigned int)sizeof (struct kdp_udpiphdr);
        if (ui->ui_pr != IPPROTO_UDP) {
                return;
        }
  
-       if (ip->ip_hl > (sizeof (struct ip) >> 2)) {
+       if (ip->ip_hl > (sizeof (struct kdp_ip) >> 2)) {
                return;
        }
 
@@ -921,7 +1030,7 @@ kdp_poll(void)
        /*
         * Calculate kdp packet length.
         */
-       pkt.len = ntohs((u_short)ui->ui_ulen) - (unsigned int)sizeof (struct udphdr);
+       pkt.len = ntohs((u_short)ui->ui_ulen) - (unsigned int)sizeof (struct kdp_udphdr);
        pkt.input = TRUE;
 }
 
@@ -932,8 +1041,8 @@ kdp_poll(void)
 static void
 transmit_ARP_request(uint32_t ip_addr)
 {
-       struct ether_header     *eh = (struct ether_header *) &pkt.data[0];
-       struct ether_arp        *ea = (struct ether_arp *) &pkt.data[sizeof(struct ether_header)];
+       struct kdp_ether_header *eh = (struct kdp_ether_header *) &pkt.data[0];
+       struct kdp_ether_arp    *ea = (struct kdp_ether_arp *) &pkt.data[sizeof(struct kdp_ether_header)];
 
        KDP_DEBUG("Transmitting ARP request\n");
        /* Populate the ether_header */
@@ -957,13 +1066,13 @@ transmit_ARP_request(uint32_t ip_addr)
        memcpy(ea->arp_spa, (void *) &kdp_current_ip_address, sizeof(kdp_current_ip_address));
 
        pkt.off = 0;
-       pkt.len = sizeof(struct ether_header) + sizeof(struct ether_arp);
+       pkt.len = sizeof(struct kdp_ether_header) + sizeof(struct kdp_ether_arp);
        /* Transmit */
        kdp_send_data(&pkt.data[pkt.off], pkt.len);
 }
 
 static boolean_t
-kdp_arp_resolve(uint32_t arp_target_ip, struct ether_addr *resolved_MAC)
+kdp_arp_resolve(uint32_t arp_target_ip, struct kdp_ether_addr *resolved_MAC)
 {
        int poll_count = 256; /* ~770 ms modulo broadcast/delayed traffic? */
        char tretries = 0;
@@ -1101,7 +1210,7 @@ static void
 kdp_connection_wait(void)
 {
        unsigned short          reply_port;
-       struct ether_addr       kdp_mac_addr = kdp_get_mac_addr();
+       struct kdp_ether_addr   kdp_mac_addr = kdp_get_mac_addr();
        unsigned int            ip_addr = ntohl(kdp_get_ip_address());
 
        /*
@@ -1144,6 +1253,7 @@ kdp_connection_wait(void)
         }
             
        printf("\nWaiting for remote debugger connection.\n");
+       kprintf("\nWaiting for remote debugger connection.\n");
 
 
        if (reattach_wait == 0) {
@@ -1153,9 +1263,6 @@ kdp_connection_wait(void)
                        printf("------------    ----\n");
                        printf("continue....    'c'\n");
                        printf("reboot......    'r'\n");
-#if MACH_KDB
-                       printf("enter kdb...    'k'\n");
-#endif
                }
        } else
                reattach_wait = 0;
@@ -1175,15 +1282,7 @@ kdp_connection_wait(void)
                                        printf("Rebooting...\n");
                                        kdp_machine_reboot();
                                        break;
-#if MACH_KDB
-                               case 'k':
-                                       printf("calling kdb...\n");
-                                       if (kdp_call_kdb())
-                                               return;
-                                       else
-                                               printf("not implemented...\n");
-#endif
-                                       default:
+                               default:
                                        break;
                                }
                        }
@@ -1218,6 +1317,7 @@ kdp_connection_wait(void)
        if (current_debugger == KDP_CUR_DB)
                active_debugger=1;
        printf("Connected to remote debugger.\n");
+       kprintf("Connected to remote debugger.\n");
 }
 
 static void
@@ -1232,7 +1332,7 @@ kdp_send_exception(
     unsigned int                poll_timeout;
 
     do {
-       pkt.off = sizeof (struct ether_header) + sizeof (struct udpiphdr);
+       pkt.off = sizeof (struct kdp_ether_header) + sizeof (struct kdp_udpiphdr);
        kdp_exception((unsigned char *)&pkt.data[pkt.off], 
                        (int *)&pkt.len, 
                        (unsigned short *)&remote_port,
@@ -1280,13 +1380,16 @@ kdp_raise_exception(
 )
 {
     int                        index;
+    unsigned int       initial_not_in_kdp = not_in_kdp;
 
+    not_in_kdp = 0;
     /* Was a system trace requested ? */
     if (kdp_snapshot && (!panic_active()) && (panic_caller == 0)) {
            stack_snapshot_ret = kdp_stackshot(stack_snapshot_pid,
            stack_snapshot_buf, stack_snapshot_bufsize,
            stack_snapshot_flags, stack_snapshot_dispatch_offset, 
                &stack_snapshot_bytes_traced);
+           not_in_kdp = initial_not_in_kdp;
            return;
     }
 
@@ -1396,6 +1499,9 @@ kdp_raise_exception(
 exit_raise_exception:
     if (kdp_en_setmode)  
         (*kdp_en_setmode)(FALSE); /* link cleanup */
+
+    not_in_kdp = initial_not_in_kdp;
+
     enable_preemption();
 }
 
@@ -1405,35 +1511,37 @@ kdp_reset(void)
        kdp.reply_port = kdp.exception_port = 0;
        kdp.is_halted = kdp.is_conn = FALSE;
        kdp.exception_seq = kdp.conn_seq = 0;
-        kdp.session_key = 0;
+       kdp.session_key = 0;
+       pkt.input = manual_pkt.input = FALSE;
+       pkt.len = pkt.off = manual_pkt.len = 0;
 }
 
 struct corehdr *
 create_panic_header(unsigned int request, const char *corename, 
     unsigned length, unsigned int block)
 {
-       struct udpiphdr         aligned_ui, *ui = &aligned_ui;
-       struct ip               aligned_ip, *ip = &aligned_ip;
-       struct ether_header     *eh;
+       struct kdp_udpiphdr     aligned_ui, *ui = &aligned_ui;
+       struct kdp_ip           aligned_ip, *ip = &aligned_ip;
+       struct kdp_ether_header *eh;
        struct corehdr          *coreh;
        const char              *mode = "octet";
-       char                    modelen  = strlen(mode);
+       char                    modelen  = strlen(mode) + 1;
 
        size_t                  fmask_size = sizeof(KDP_FEATURE_MASK_STRING) + sizeof(kdp_crashdump_feature_mask);
 
-       pkt.off = sizeof (struct ether_header);
+       pkt.off = sizeof (struct kdp_ether_header);
        pkt.len = (unsigned int)(length + ((request == KDP_WRQ) ? modelen + fmask_size : 0) + 
-           (corename ? strlen(corename): 0) + sizeof(struct corehdr));
+       (corename ? (strlen(corename) + 1 ): 0) + sizeof(struct corehdr));
 
 #if DO_ALIGN
        bcopy((char *)&pkt.data[pkt.off], (char *)ui, sizeof(*ui));
 #else
-       ui = (struct udpiphdr *)&pkt.data[pkt.off];
+       ui = (struct kdp_udpiphdr *)&pkt.data[pkt.off];
 #endif
        ui->ui_next = ui->ui_prev = 0;
        ui->ui_x1 = 0;
        ui->ui_pr = IPPROTO_UDP;
-       ui->ui_len = htons((u_short)pkt.len + sizeof (struct udphdr));
+       ui->ui_len = htons((u_short)pkt.len + sizeof (struct kdp_udphdr));
        ui->ui_src.s_addr = (uint32_t)kdp_current_ip_address;
        /* Already in network byte order via inet_aton() */
        ui->ui_dst.s_addr = panic_server_ip;
@@ -1445,12 +1553,12 @@ create_panic_header(unsigned int request, const char *corename,
        bcopy((char *)ui, (char *)&pkt.data[pkt.off], sizeof(*ui));
        bcopy((char *)&pkt.data[pkt.off], (char *)ip, sizeof(*ip));
 #else
-       ip = (struct ip *)&pkt.data[pkt.off];
+       ip = (struct kdp_ip *)&pkt.data[pkt.off];
 #endif
-       ip->ip_len = htons(sizeof (struct udpiphdr) + pkt.len);
+       ip->ip_len = htons(sizeof (struct kdp_udpiphdr) + pkt.len);
        ip->ip_v = IPVERSION;
        ip->ip_id = htons(ip_id++);
-       ip->ip_hl = sizeof (struct ip) >> 2;
+       ip->ip_hl = sizeof (struct kdp_ip) >> 2;
        ip->ip_ttl = udp_ttl;
        ip->ip_sum = 0;
        ip->ip_sum = htons(~ip_sum((unsigned char *)ip, ip->ip_hl));
@@ -1458,9 +1566,9 @@ create_panic_header(unsigned int request, const char *corename,
        bcopy((char *)ip, (char *)&pkt.data[pkt.off], sizeof(*ip));
 #endif
     
-       pkt.len += (unsigned int)sizeof (struct udpiphdr);
+       pkt.len += (unsigned int)sizeof (struct kdp_udpiphdr);
 
-       pkt.off += (unsigned int)sizeof (struct udpiphdr);
+       pkt.off += (unsigned int)sizeof (struct kdp_udpiphdr);
   
        coreh = (struct corehdr *) &pkt.data[pkt.off];
        coreh->th_opcode = htons((u_short)request);
@@ -1487,15 +1595,15 @@ create_panic_header(unsigned int request, const char *corename,
                coreh->th_block = htonl((unsigned int) block);
        }
 
-       pkt.off -= (unsigned int)sizeof (struct udpiphdr);
-       pkt.off -= (unsigned int)sizeof (struct ether_header);
+       pkt.off -= (unsigned int)sizeof (struct kdp_udpiphdr);
+       pkt.off -= (unsigned int)sizeof (struct kdp_ether_header);
 
-       eh = (struct ether_header *)&pkt.data[pkt.off];
+       eh = (struct kdp_ether_header *)&pkt.data[pkt.off];
        enaddr_copy(&kdp_current_mac_address, eh->ether_shost);
        enaddr_copy(&destination_mac, eh->ether_dhost);
        eh->ether_type = htons(ETHERTYPE_IP);
     
-       pkt.len += (unsigned int)sizeof (struct ether_header);
+       pkt.len += (unsigned int)sizeof (struct kdp_ether_header);
        return coreh;
 }
 
@@ -1698,27 +1806,6 @@ isdigit (char c)
 {
   return ((c > 47) && (c < 58));
 }
-/* From user mode Libc - this ought to be in a library */
-static char *
-strnstr(char *s, const char *find, size_t slen)
-{
-  char c, sc;
-  size_t len;
-  
-  if ((c = *find++) != '\0') {
-    len = strlen(find);
-    do {
-      do {
-       if ((sc = *s++) == '\0' || slen-- < 1)
-         return (NULL);
-      } while (sc != c);
-      if (len > slen)
-       return (NULL);
-    } while (strncmp(s, find, len) != 0);
-    s--;
-  }
-  return (s);
-}
 
 /* Horrid hack to extract xnu version if possible - a much cleaner approach
  * would be to have the integrator run a script which would copy the
@@ -1900,7 +1987,6 @@ kdp_panic_dump(void)
        }
 
        flag_panic_dump_in_progress = TRUE;
-       not_in_kdp = 0;
 
        if (pkt.input)
                kdp_panic("kdp_panic_dump: unexpected pending input packet");
@@ -1927,7 +2013,7 @@ kdp_panic_dump(void)
                      (unsigned int) (abstime & 0xffffffff));
         }
 
-       if (0 == inet_aton(panicd_ip_str, (struct in_addr *) &panic_server_ip)) {
+       if (0 == inet_aton(panicd_ip_str, (struct kdp_in_addr *) &panic_server_ip)) {
                kdb_printf("inet_aton() failed interpreting %s as a panic server IP\n", panicd_ip_str);
        }
        else
@@ -1942,7 +2028,7 @@ kdp_panic_dump(void)
        else {
                if (!flag_panic_dump_in_progress) goto panic_dump_exit;
                if (router_specified) {
-                       if (0 == inet_aton(router_ip_str, (struct in_addr *) &parsed_router_ip))
+                       if (0 == inet_aton(router_ip_str, (struct kdp_in_addr *) &parsed_router_ip))
                                kdb_printf("inet_aton() failed interpreting %s as an IP\n", router_ip_str);
                        else {
                                router_ip = parsed_router_ip;
@@ -2013,8 +2099,6 @@ kdp_panic_dump(void)
 
 panic_dump_exit:
        abort_panic_transfer();
-       pkt.input = FALSE;
-       pkt.len = 0;
        kdp_reset();
        return;
 }
@@ -2024,7 +2108,6 @@ abort_panic_transfer(void)
 {
        flag_panic_dump_in_progress = FALSE;
        flag_dont_abort_panic_dump  = FALSE;
-       not_in_kdp = 1;
        panic_block = 0;
 }
 
@@ -2110,33 +2193,45 @@ kdp_init(void)
        strlcpy(kdp_kernelversion_string, version, sizeof(kdp_kernelversion_string));
 
        /* Relies on platform layer calling panic_init() before kdp_init() */
-       if (kernel_uuid[0] != '\0') {
+       if (kernel_uuid_string[0] != '\0') {
                /*
                 * Update kdp_kernelversion_string with our UUID
                 * generated at link time.
                 */
 
                strlcat(kdp_kernelversion_string, "; UUID=", sizeof(kdp_kernelversion_string));
-               strlcat(kdp_kernelversion_string, kernel_uuid, sizeof(kdp_kernelversion_string));
+               strlcat(kdp_kernelversion_string, kernel_uuid_string, sizeof(kdp_kernelversion_string));
        }
 
+       debug_log_init();
+
+#if defined(__x86_64__) || defined(__arm__)
+       if (vm_kernel_slide) {
+               char    KASLR_stext[19];
+               strlcat(kdp_kernelversion_string, "; stext=", sizeof(kdp_kernelversion_string));
+               snprintf(KASLR_stext, sizeof(KASLR_stext), "%p", (void *) vm_kernel_stext);
+               strlcat(kdp_kernelversion_string, KASLR_stext, sizeof(kdp_kernelversion_string));
+       }
+#endif
+
        if (debug_boot_arg & DB_REBOOT_POST_CORE)
                kdp_flag |= REBOOT_POST_CORE;
+#if    defined(__x86_64__)     
+       kdp_machine_init();
+#endif
+
+       kdp_timer_callout_init();
+       kdp_crashdump_feature_mask = htonl(kdp_crashdump_feature_mask);
+
 #if CONFIG_SERIAL_KDP
        char kdpname[80];
-       struct in_addr ipaddr;
-       struct ether_addr macaddr;
+       struct kdp_in_addr ipaddr;
+       struct kdp_ether_addr macaddr;
 
 
-#if CONFIG_EMBEDDED
-       //serial will be the debugger, unless match name is explicitly provided, and it's not "serial"
-       if(PE_parse_boot_argn("kdp_match_name", kdpname, sizeof(kdpname)) && strncmp(kdpname, "serial", sizeof(kdpname)) != 0)
-               return;
-#else
        // serial must be explicitly requested
        if(!PE_parse_boot_argn("kdp_match_name", kdpname, sizeof(kdpname)) || strncmp(kdpname, "serial", sizeof(kdpname)) != 0)
                return;
-#endif
        
        kprintf("Initializing serial KDP\n");