833 lines
19 KiB
C
833 lines
19 KiB
C
/*
|
|
* Copyright (C) 1993-1996 Wolfgang Solfrank.
|
|
* Copyright (C) 1993-1996 TooLs GmbH.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by TooLs GmbH.
|
|
* 4. The name of TooLs GmbH may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
|
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
|
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
|
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
|
* ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
#include <sys/param.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/reboot.h>
|
|
#include <sys/systm.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/route.h>
|
|
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_systm.h>
|
|
#include <netinet/if_ether.h>
|
|
#include <netinet/in.h>
|
|
#include <netinet/ip.h>
|
|
#include <netinet/ip_var.h>
|
|
#include <netinet/udp.h>
|
|
|
|
#include <machine/stdarg.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/psl.h>
|
|
#include <machine/reg.h>
|
|
|
|
#include <kgdb/kgdb.h>
|
|
#include "debuggers.h"
|
|
#include <machine/kgdb.h>
|
|
|
|
int kgdbpanic = 0;
|
|
|
|
#ifdef KGDBUSER
|
|
char kgdbuser = 0; /* allows debugging of user processes by KGDB when set */
|
|
#endif
|
|
|
|
static struct kgdb_if kgdb_if;
|
|
#ifdef KGDBTEST
|
|
static struct kgdb_if new_if;
|
|
static int kgdb_test = 0;
|
|
#endif
|
|
|
|
static u_char *kgdbaddr __P((u_char *, int *, void **));
|
|
static void init __P((struct kgdb_if *));
|
|
static void peekmem __P((struct kgdb_if *, char *, char *, long));
|
|
static void pokemem __P((struct kgdb_if *, char *, char *, long));
|
|
static void getpkt __P((struct kgdb_if *, char *, int *));
|
|
static void putpkt __P((struct kgdb_if *, char *, int));
|
|
static int check_kgdb __P((struct kgdb_if *, struct in_addr *, u_short, u_short, char *, int));
|
|
static int connectkgdb __P((struct kgdb_if *, char *));
|
|
|
|
void
|
|
kgdb_init()
|
|
{
|
|
kgdb_if.connect = KGDB_DEF;
|
|
kgdbinit();
|
|
if (kgdbifinit(&kgdb_if, 0) < 0
|
|
|| !(kgdb_if.flags&KGDB_MYHW)) {
|
|
/* Interface not found, drop KGDB */
|
|
printf("KGDB: No interface found!\n");
|
|
kgdb_if.connect = KGDB_NOIF;
|
|
boothowto &= ~RB_KDB;
|
|
}
|
|
}
|
|
|
|
void
|
|
kgdb_connect(when)
|
|
{
|
|
boothowto |= RB_KDB;
|
|
if (when == 0)
|
|
printf("waiting for remote GDB\n");
|
|
kgdb_trap();
|
|
#ifdef KGDBTEST
|
|
new_if.connect = KGDB_ALL;
|
|
if (kgdbifinit(&new_if, 1) < 0
|
|
|| !(new_if.flags&KGDB_MYHW)) {
|
|
/* Interface not found, no test */
|
|
return;
|
|
}
|
|
init(&new_if);
|
|
putpkt(&new_if, "s", 1);
|
|
for (kgdb_test = 1; kgdb_test;) {
|
|
static char buf[512];
|
|
int plen;
|
|
|
|
getpkt(&new_if, buf, &plen);
|
|
if (!plen)
|
|
continue;
|
|
putpkt(&new_if, "eunknown command", 16);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void
|
|
kgdb_panic()
|
|
{
|
|
if (kgdb_if.connect == KGDB_NOIF)
|
|
return;
|
|
kgdbpanic = 1;
|
|
kgdb_trap();
|
|
}
|
|
|
|
int
|
|
kgdbcmds()
|
|
{
|
|
static char buf[512];
|
|
char *cp;
|
|
int plen;
|
|
|
|
if (!(kgdb_if.flags&KGDB_MYHW)) /* no interface */
|
|
return 0;
|
|
init(&kgdb_if);
|
|
if (kgdbpanic > 1) {
|
|
kgdb_if.leave(&kgdb_if);
|
|
return 0;
|
|
}
|
|
putpkt(&kgdb_if, "s", 1);
|
|
while (1) {
|
|
getpkt(&kgdb_if, buf, &plen);
|
|
if (!plen) {
|
|
if (kgdbpanic && kgdb_poll()) {
|
|
kgdb_if.leave(&kgdb_if);
|
|
return 0;
|
|
} else
|
|
continue;
|
|
} else
|
|
kgdbpanic = 0;
|
|
switch (*buf) {
|
|
default:
|
|
putpkt(&kgdb_if, "eunknown command", 16);
|
|
break;
|
|
case 'O':
|
|
/* This is an allowed reconnect, ack it */
|
|
putpkt(&kgdb_if, "s", 1);
|
|
break;
|
|
case 'R':
|
|
peekmem(&kgdb_if, buf, (char *)kgdbregs, sizeof kgdbregs);
|
|
break;
|
|
case 'W':
|
|
if (plen != sizeof kgdbregs + 1) {
|
|
putpkt(&kgdb_if, "einvalid register size", 22);
|
|
break;
|
|
}
|
|
pokemem(&kgdb_if, buf + 1, (char *)kgdbregs, sizeof kgdbregs);
|
|
break;
|
|
case 'M':
|
|
{
|
|
char *addr;
|
|
long len;
|
|
|
|
plen--;
|
|
if (!(cp = kgdbaddr(buf + 1, &plen, (void **)&addr))
|
|
|| !kgdbaddr(cp, &plen, (void **)&len)) {
|
|
putpkt(&kgdb_if, "einvalid peek format", 20);
|
|
break;
|
|
}
|
|
peekmem(&kgdb_if, buf, addr, len);
|
|
break;
|
|
}
|
|
case 'N':
|
|
{
|
|
char *addr;
|
|
int len;
|
|
|
|
plen--;
|
|
if (!(cp = kgdbaddr(buf + 1, &plen, (void **)&addr))
|
|
|| !(cp = kgdbaddr(cp, &plen, (void **)&len))
|
|
|| plen < len) {
|
|
putpkt(&kgdb_if, "einvalid poke format", 20);
|
|
break;
|
|
}
|
|
pokemem(&kgdb_if, cp, addr, len);
|
|
break;
|
|
}
|
|
case 'S':
|
|
kgdb_if.leave(&kgdb_if);
|
|
return 1;
|
|
case 'X':
|
|
putpkt(&kgdb_if, "ok",2);
|
|
#ifdef KGDBUSER
|
|
kgdbuser = 0;
|
|
#endif
|
|
kgdb_if.connect = KGDB_DEF; /* ??? */
|
|
kgdb_if.leave(&kgdb_if);
|
|
return 2;
|
|
case 'C':
|
|
kgdb_if.leave(&kgdb_if);
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
static u_char *
|
|
kgdbaddr(cp, pl, dp)
|
|
u_char *cp;
|
|
int *pl;
|
|
void **dp;
|
|
{
|
|
/* Assume that sizeof(void*) <= sizeof(long) */
|
|
long l;
|
|
int i;
|
|
|
|
if ((*pl -= sizeof(void *)) < 0)
|
|
return 0;
|
|
for (i = sizeof(void *), l = 0; --i >= 0;) {
|
|
l <<= 8;
|
|
l |= *cp++;
|
|
}
|
|
*dp = (void *)l;
|
|
return cp;
|
|
}
|
|
|
|
static void
|
|
peekmem(ifp, buf, addr, len)
|
|
struct kgdb_if *ifp;
|
|
char *buf, *addr;
|
|
long len;
|
|
{
|
|
char *cp;
|
|
int l;
|
|
|
|
cp = buf;
|
|
*cp++ = 'p';
|
|
for (l = len; --l >= 0;)
|
|
*cp++ = kgdbfbyte(addr++);
|
|
putpkt(ifp, buf, len + 1);
|
|
}
|
|
|
|
static void
|
|
pokemem(ifp, cp, addr, len)
|
|
struct kgdb_if *ifp;
|
|
char *cp, *addr;
|
|
long len;
|
|
{
|
|
int c;
|
|
|
|
while (--len >= 0)
|
|
kgdbsbyte(addr++, *cp++);
|
|
putpkt(ifp, "ok", 2);
|
|
}
|
|
|
|
__inline static u_long
|
|
getnl(s)
|
|
u_char *s;
|
|
{
|
|
return (*s << 24)
|
|
|(s[1] << 16)
|
|
|(s[2] << 8)
|
|
|s[3];
|
|
}
|
|
__inline static u_int
|
|
getns(s)
|
|
u_char *s;
|
|
{
|
|
return (*s << 8)
|
|
|s[1];
|
|
}
|
|
|
|
__inline static void
|
|
setnl(s, l)
|
|
u_char *s;
|
|
long l;
|
|
{
|
|
*s++ = l >> 24;
|
|
*s++ = l >> 16;
|
|
*s++ = l >> 8;
|
|
*s = l;
|
|
}
|
|
|
|
__inline static void
|
|
setns(s, l)
|
|
u_char *s;
|
|
{
|
|
*s++ = l >> 8;
|
|
*s = l;
|
|
}
|
|
|
|
static u_short
|
|
cksum(s, cp, l)
|
|
u_long s;
|
|
u_char *cp;
|
|
int l;
|
|
{
|
|
for (; (l -= 2) >= 0; cp += 2)
|
|
s += (*cp << 8) + cp[1];
|
|
if (l == -1)
|
|
s += *cp << 8;
|
|
while (s&0xffff0000)
|
|
s = (s&0xffff) + (s >> 16);
|
|
return s == 0xffff ? 0 : s;
|
|
}
|
|
|
|
static int
|
|
assemble(ifp, buf)
|
|
struct kgdb_if *ifp;
|
|
u_char *buf;
|
|
{
|
|
struct ip *ip, iph;
|
|
int off, len, i;
|
|
u_char *cp, *ecp;
|
|
|
|
ip = (struct ip *)buf;
|
|
kgdbcopy(ip, &iph, sizeof iph);
|
|
iph.ip_hl = 5;
|
|
iph.ip_tos = 0;
|
|
iph.ip_len = 0;
|
|
iph.ip_off = 0;
|
|
iph.ip_ttl = 0;
|
|
iph.ip_sum = 0;
|
|
if (ifp->asslen) {
|
|
if (kgdbcmp(&iph, ifp->ass, sizeof iph)) {
|
|
/*
|
|
* different packet
|
|
* decide whether to keep the old
|
|
* or start a new one
|
|
*/
|
|
i = getns(&ip->ip_id)^getns(&((struct ip *)ifp->ass)->ip_id);
|
|
i ^= (i >> 2)^(i >> 4)^(i >> 8)^(i >> 12);
|
|
if (i&1)
|
|
/* keep the old */
|
|
return 0;
|
|
ifp->asslen = 0;
|
|
}
|
|
}
|
|
if (!ifp->asslen) {
|
|
kgdbzero(ifp->assbit, sizeof ifp->assbit);
|
|
kgdbcopy(&iph, ifp->ass, sizeof iph);
|
|
}
|
|
off = getns(&ip->ip_off);
|
|
len = ((off&IP_OFFMASK) << 3) + getns(&ip->ip_len) - ip->ip_hl * 4;
|
|
if (ifp->asslen < len)
|
|
ifp->asslen = len;
|
|
if (ifp->asslen + sizeof *ip > sizeof ifp->ass) {
|
|
/* packet too long */
|
|
ifp->asslen = 0;
|
|
return 0;
|
|
}
|
|
if (!(off&IP_MF)) {
|
|
off &= IP_OFFMASK;
|
|
cp = ifp->assbit + (off >> 3);
|
|
for (i = off & 7; i < 8; *cp |= 1 << i++);
|
|
for (; cp < ifp->assbit + sizeof ifp->assbit; *cp++ = -1);
|
|
} else {
|
|
off &= IP_OFFMASK;
|
|
cp = ifp->assbit + (off >> 3);
|
|
ecp = ifp->assbit + (len >> 6);
|
|
if (cp == ecp)
|
|
for (i = off & 7; i <= (len >> 3)&7; *cp |= 1 << i++);
|
|
else {
|
|
for (i = off & 7; i < 8; *cp |= 1 << i++);
|
|
for (; ++cp < ecp; *cp = -1);
|
|
for (i = 0; i < ((len >> 3)&7); *cp |= 1 << i++);
|
|
}
|
|
}
|
|
kgdbcopy(buf + ip->ip_hl * 4,
|
|
ifp->ass + sizeof *ip + (off << 3),
|
|
len - (off << 3));
|
|
for (cp = ifp->assbit; cp < ifp->assbit + sizeof ifp->assbit;)
|
|
if (*cp++ != (u_char)-1)
|
|
/* not complete */
|
|
return 0;
|
|
ip = (struct ip *)ifp->ass;
|
|
setns(&ip->ip_len, sizeof *ip + ifp->asslen);
|
|
/* complete */
|
|
return 1;
|
|
}
|
|
|
|
static char *
|
|
inpkt(ifp, ibuf, poll)
|
|
struct kgdb_if *ifp;
|
|
char *ibuf;
|
|
int poll;
|
|
{
|
|
int cnt = 1000000;
|
|
int l, ul;
|
|
struct ether_header *eh;
|
|
struct ether_arp *ah;
|
|
struct ip *ip;
|
|
struct udphdr *udp;
|
|
struct ipovly ipo;
|
|
|
|
while (1) {
|
|
l = ifp->receive(ifp, ibuf, poll != 0);
|
|
if (!l) {
|
|
if (poll == 1 || (poll == 2 && --cnt <= 0))
|
|
break;
|
|
else
|
|
continue;
|
|
}
|
|
eh = (struct ether_header *)ibuf;
|
|
switch (getns(&eh->ether_type)) {
|
|
case ETHERTYPE_ARP:
|
|
ah = (struct ether_arp *)(ibuf + 14);
|
|
if ( getns(&ah->arp_hrd) != ARPHRD_ETHER
|
|
|| getns(&ah->arp_pro) != ETHERTYPE_IP
|
|
|| ah->arp_hln != 6
|
|
|| ah->arp_pln != 4)
|
|
/* unsupported arp packet */
|
|
break;
|
|
switch (getns(&ah->arp_op)) {
|
|
case ARPOP_REQUEST:
|
|
if ( (ifp->flags&KGDB_MYIP)
|
|
&& !kgdbcmp(ah->arp_tpa,
|
|
ifp->myinetaddr,
|
|
sizeof ifp->myinetaddr)) {
|
|
/* someone requested my address */
|
|
kgdbcopy(eh->ether_shost,
|
|
eh->ether_dhost,
|
|
sizeof eh->ether_dhost);
|
|
kgdbcopy(ifp->myenetaddr,
|
|
eh->ether_shost,
|
|
sizeof eh->ether_shost);
|
|
setns(&ah->arp_op, ARPOP_REPLY);
|
|
kgdbcopy(ah->arp_sha,
|
|
ah->arp_tha,
|
|
sizeof ah->arp_tha);
|
|
kgdbcopy(ah->arp_spa,
|
|
ah->arp_tpa,
|
|
sizeof ah->arp_tpa);
|
|
kgdbcopy(ifp->myenetaddr,
|
|
ah->arp_sha,
|
|
sizeof ah->arp_sha);
|
|
kgdbcopy(ifp->myinetaddr,
|
|
ah->arp_spa,
|
|
sizeof ah->arp_spa);
|
|
ifp->send(ifp, ibuf, 74);
|
|
continue;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
break;
|
|
case ETHERTYPE_IP:
|
|
if (kgdbcmp(eh->ether_dhost,
|
|
ifp->myenetaddr,
|
|
sizeof ifp->myenetaddr))
|
|
/* not only for us */
|
|
break;
|
|
ip = (struct ip *)(ibuf + 14);
|
|
if ( ip->ip_v != IPVERSION
|
|
|| ip->ip_hl < 5
|
|
|| getns(&ip->ip_len) + 14 > l)
|
|
/* invalid packet */
|
|
break;
|
|
if (cksum(0, ip, ip->ip_hl * 4))
|
|
/* wrong checksum */
|
|
break;
|
|
if (ip->ip_p != IPPROTO_UDP)
|
|
break;
|
|
if (getns(&ip->ip_off)&~IP_DF) {
|
|
if (!assemble(ifp, ip))
|
|
break;
|
|
ip = (struct ip *)ifp->ass;
|
|
ifp->asslen = 0;
|
|
}
|
|
udp = (struct udphdr *)((char *)ip + ip->ip_hl * 4);
|
|
ul = getns(&ip->ip_len) - ip->ip_hl * 4;
|
|
if (getns(&udp->uh_ulen) != ul)
|
|
/* invalid UDP packet length */
|
|
break;
|
|
kgdbcopy(ip, &ipo, sizeof ipo);
|
|
kgdbzero(ipo.ih_x1, sizeof ipo.ih_x1);
|
|
ipo.ih_len = udp->uh_ulen;
|
|
if ( udp->uh_sum
|
|
&& cksum(cksum(0, &ipo, sizeof ipo), udp, ul))
|
|
/* wrong checksum */
|
|
break;
|
|
if (!(ifp->flags&KGDB_MYIP)) {
|
|
if ( getns(&udp->uh_sport) == 67
|
|
&& getns(&udp->uh_dport) == 68
|
|
&& *(char *)(udp + 1) == 2) {
|
|
/* this is a BOOTP reply to our ethernet address */
|
|
/* should check a bit more? XXX */
|
|
kgdbcopy(&ip->ip_dst,
|
|
ifp->myinetaddr,
|
|
sizeof ifp->myinetaddr);
|
|
ifp->flags |= KGDB_MYIP;
|
|
}
|
|
/* give caller a chance to resend his request */
|
|
return 0;
|
|
}
|
|
if ( kgdbcmp(&ip->ip_dst, ifp->myinetaddr, sizeof ifp->myinetaddr)
|
|
|| getns(&udp->uh_sport) != KGDBPORT
|
|
|| getns(&udp->uh_dport) != KGDBPORT)
|
|
break;
|
|
/* so now it's a UDP packet for the debugger */
|
|
{
|
|
/* Check for reconnect packet */
|
|
u_char *p;
|
|
|
|
p = (u_char *)(udp + 1);
|
|
if (!getnl(p) && p[6] == 'O') {
|
|
l = getns(p + 4);
|
|
if (l <= ul - sizeof *udp - 6
|
|
&& check_kgdb(ifp, &ip->ip_src, udp->uh_sport,
|
|
udp->uh_dport, p + 6, l)) {
|
|
kgdbcopy(&ip->ip_src,
|
|
ifp->hisinetaddr,
|
|
sizeof ifp->hisinetaddr);
|
|
kgdbcopy(eh->ether_shost,
|
|
ifp->hisenetaddr,
|
|
sizeof ifp->hisenetaddr);
|
|
ifp->flags |= KGDB_HISHW|KGDB_HISIP;
|
|
return p;
|
|
}
|
|
}
|
|
}
|
|
if ((ifp->flags&KGDB_HISIP)
|
|
&& kgdbcmp(&ip->ip_src,
|
|
ifp->hisinetaddr, sizeof ifp->hisinetaddr))
|
|
/* It's a packet from someone else */
|
|
break;
|
|
if (!(ifp->flags&KGDB_HISIP)) {
|
|
ifp->flags |= KGDB_HISIP;
|
|
kgdbcopy(&ip->ip_src,
|
|
ifp->hisinetaddr, sizeof ifp->hisinetaddr);
|
|
}
|
|
if (!(ifp->flags&KGDB_HISHW)) {
|
|
ifp->flags |= KGDB_HISHW;
|
|
kgdbcopy(eh->ether_shost,
|
|
ifp->hisenetaddr, sizeof ifp->hisenetaddr);
|
|
}
|
|
return (char *)(udp + 1);
|
|
default:
|
|
/* unknown type */
|
|
break;
|
|
}
|
|
if (l)
|
|
kgdbgotpkt(ifp, ibuf, l);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static short kgdb_id = 0;
|
|
|
|
static void
|
|
outpkt(ifp, in, l, srcport, dstport)
|
|
struct kgdb_if *ifp;
|
|
char *in;
|
|
int l;
|
|
int srcport, dstport;
|
|
{
|
|
u_char *sp;
|
|
struct ether_header *eh;
|
|
struct ip *ip;
|
|
struct udphdr *udp;
|
|
u_char *cp;
|
|
char obuf[ETHERMTU+14];
|
|
struct ipovly ipo;
|
|
int i, off;
|
|
|
|
kgdbzero(obuf, sizeof obuf);
|
|
eh = (struct ether_header *)obuf;
|
|
if (!(ifp->flags&KGDB_HISHW))
|
|
for (cp = eh->ether_dhost; cp < eh->ether_dhost + sizeof eh->ether_dhost;)
|
|
*cp++ = -1;
|
|
else
|
|
kgdbcopy(ifp->hisenetaddr, eh->ether_dhost, sizeof eh->ether_dhost);
|
|
kgdbcopy(ifp->myenetaddr, eh->ether_shost, sizeof eh->ether_shost);
|
|
setns(&eh->ether_type, ETHERTYPE_IP);
|
|
ip = (struct ip *)(obuf + 14);
|
|
ip->ip_v = IPVERSION;
|
|
ip->ip_hl = 5;
|
|
setns(&ip->ip_id, kgdb_id++);
|
|
ip->ip_ttl = 255;
|
|
ip->ip_p = IPPROTO_UDP;
|
|
kgdbcopy(ifp->myinetaddr, &ip->ip_src, sizeof ip->ip_src);
|
|
kgdbcopy(ifp->hisinetaddr, &ip->ip_dst, sizeof ip->ip_dst);
|
|
udp = (struct udphdr *)(ip + 1);
|
|
setns(&udp->uh_sport, srcport);
|
|
setns(&udp->uh_dport, dstport);
|
|
setns(&udp->uh_ulen, l + sizeof *udp);
|
|
kgdbcopy(ip, &ipo, sizeof ipo);
|
|
kgdbzero(ipo.ih_x1, sizeof ipo.ih_x1);
|
|
ipo.ih_len = udp->uh_ulen;
|
|
setns(&udp->uh_sum,
|
|
~cksum(cksum(cksum(0, &ipo, sizeof ipo),
|
|
udp, sizeof *udp),
|
|
in, l));
|
|
for (cp = (u_char *)(udp + 1), l += sizeof *udp, off = 0;
|
|
l > 0;
|
|
l -= i, in += i, off += i, cp = (u_char *)udp) {
|
|
i = l > ifp->mtu - sizeof *ip ? ((ifp->mtu - sizeof *ip)&~7) : l;
|
|
kgdbcopy(in, cp, i);
|
|
setns(&ip->ip_len, i + sizeof *ip);
|
|
setns(&ip->ip_off, (l > i ? IP_MF : 0)|(off >> 3));
|
|
ip->ip_sum = 0;
|
|
setns(&ip->ip_sum, ~cksum(0, ip, sizeof *ip));
|
|
if (i + sizeof *ip < ETHERMIN)
|
|
i = ETHERMIN - sizeof *ip;
|
|
ifp->send(ifp, obuf, i + sizeof *ip + 14);
|
|
}
|
|
}
|
|
|
|
static void
|
|
init(ifp)
|
|
struct kgdb_if *ifp;
|
|
{
|
|
u_char *cp;
|
|
struct ether_header *eh;
|
|
struct ip *ip;
|
|
struct udphdr *udp;
|
|
u_char buf[ETHERMTU+14];
|
|
struct ipovly ipo;
|
|
int secs = 0;
|
|
|
|
ifp->start(ifp);
|
|
#ifdef __notyet__
|
|
if (!(ifp->flags&KGDB_MYIP))
|
|
kgdbinet(ifp);
|
|
#endif
|
|
if (ifp->flags&KGDB_MYIP)
|
|
return;
|
|
|
|
while (!(ifp->flags&KGDB_MYIP)) {
|
|
kgdbzero(buf, sizeof buf);
|
|
cp = buf;
|
|
*cp++ = 1; /* BOOTP_REQUEST */
|
|
*cp++ = 1; /* Ethernet hardware */
|
|
*cp++ = 6; /* length of address */
|
|
setnl(++cp, 0x12345678); /* some random number? */
|
|
setns(cp + 4, secs++);
|
|
kgdbcopy(ifp->myenetaddr, cp + 24, sizeof ifp->myenetaddr);
|
|
outpkt(ifp, buf, 300, 68, 67);
|
|
inpkt(ifp, buf, 2);
|
|
if (kgdbpanic && kgdb_poll()) {
|
|
kgdbpanic++;
|
|
return;
|
|
}
|
|
}
|
|
cp = ifp->myinetaddr;
|
|
printf("My IP address is %d.%d.%d.%d\n", cp[0], cp[1], cp[2], cp[3]);
|
|
}
|
|
|
|
static int
|
|
chksum(p, l)
|
|
char *p;
|
|
{
|
|
char csum;
|
|
|
|
for (csum = 0; --l >= 0; csum += *p++);
|
|
return csum;
|
|
}
|
|
|
|
static void
|
|
getpkt(ifp, buf, lp)
|
|
struct kgdb_if *ifp;
|
|
char *buf;
|
|
int *lp;
|
|
{
|
|
char *got;
|
|
int l;
|
|
char ibuf[ETHERMTU+14];
|
|
|
|
*lp = 0;
|
|
while (1) {
|
|
if (!(got = inpkt(ifp, ibuf, kgdbpanic != 0))) {
|
|
*lp = 0;
|
|
return;
|
|
}
|
|
if ( ifp->seq == getnl(got)
|
|
&& got[6] >= 'A'
|
|
&& got[6] <= 'Z'
|
|
&& (l = getns(got + 4))
|
|
&& (got[6] == 'O' || chksum(got + 6,l) == got[l + 6])) {
|
|
kgdbcopy(got + 6, buf, *lp = l);
|
|
return;
|
|
}
|
|
if (ifp->pktlen
|
|
&& ((ifp->flags&(KGDB_MYIP|KGDB_HISIP|KGDB_CONNECTED))
|
|
== (KGDB_MYIP|KGDB_HISIP|KGDB_CONNECTED)))
|
|
outpkt(ifp, ifp->pkt, ifp->pktlen, KGDBPORT, KGDBPORT);
|
|
}
|
|
}
|
|
|
|
static void
|
|
putpkt(ifp, buf, l)
|
|
struct kgdb_if *ifp;
|
|
char *buf;
|
|
int l;
|
|
{
|
|
setnl(ifp->pkt, ifp->seq++);
|
|
setns(ifp->pkt + 4, l);
|
|
kgdbcopy(buf, ifp->pkt + 6, l);
|
|
ifp->pkt[l + 6] = chksum(ifp->pkt + 6, l);
|
|
ifp->pktlen = l + 7;
|
|
if ((ifp->flags&(KGDB_MYIP|KGDB_HISIP|KGDB_CONNECTED))
|
|
!= (KGDB_MYIP|KGDB_HISIP|KGDB_CONNECTED))
|
|
return;
|
|
outpkt(ifp, ifp->pkt, ifp->pktlen, KGDBPORT, KGDBPORT);
|
|
}
|
|
|
|
static __inline int
|
|
maskcmp(in, mask, match)
|
|
u_char *in, *mask, *match;
|
|
{
|
|
int i;
|
|
|
|
for (i = 4; --i >= 0;)
|
|
if ((*in++&*mask++) != *match++)
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
check_kgdb(ifp, shost, sport, dport, p, l)
|
|
struct kgdb_if *ifp;
|
|
struct in_addr *shost;
|
|
u_short sport, dport;
|
|
char *p;
|
|
int l;
|
|
{
|
|
u_char hisenet[6];
|
|
u_char hisinet[4];
|
|
char save;
|
|
struct kgdb_allow *kap;
|
|
|
|
if (chksum(p, l) != p[l])
|
|
return 0;
|
|
p[l] = 0;
|
|
switch (ifp->connect) {
|
|
default:
|
|
return 0;
|
|
case KGDB_SAME:
|
|
if (kgdbcmp(shost, ifp->hisinetaddr, sizeof ifp->hisinetaddr))
|
|
return 0;
|
|
if (getns(&sport) != KGDBPORT || getns(&dport) != KGDBPORT)
|
|
return 0;
|
|
bzero(&hisinet, sizeof hisinet);
|
|
break;
|
|
case KGDB_ALL:
|
|
for (kap = kgdballow; kap < kgdballow + kgdbcount; kap++) {
|
|
if (maskcmp(shost, kap->mask, kap->match))
|
|
break;
|
|
}
|
|
if (kap >= kgdballow + kgdbcount)
|
|
return 0;
|
|
if (getns(&sport) != KGDBPORT || getns(&dport) != KGDBPORT)
|
|
return 0;
|
|
kgdbcopy(ifp->hisenetaddr, hisenet, sizeof hisenet);
|
|
kgdbcopy(ifp->hisinetaddr, hisinet, sizeof hisinet);
|
|
save = ifp->flags;
|
|
kgdbcopy(shost, ifp->hisinetaddr, sizeof ifp->hisinetaddr);
|
|
ifp->flags &= ~KGDB_HISHW;
|
|
ifp->flags |= KGDB_HISIP;
|
|
break;
|
|
}
|
|
if (connectkgdb(ifp, p) < 0) {
|
|
if (ifp->connect == KGDB_ALL) {
|
|
kgdbcopy(hisenet, ifp->hisenetaddr, sizeof ifp->hisenetaddr);
|
|
kgdbcopy(hisinet, ifp->hisinetaddr, sizeof ifp->hisinetaddr);
|
|
kgdb_if.flags = save;
|
|
}
|
|
return 0;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* Should check whether packet came across the correct interface
|
|
*/
|
|
int
|
|
checkkgdb(shost, sport, dport, m, off, len)
|
|
struct in_addr *shost;
|
|
u_short sport, dport;
|
|
struct mbuf *m;
|
|
{
|
|
char *p;
|
|
int l;
|
|
char ibuf[ETHERMTU+50];
|
|
|
|
m_copydata(m, off, len, ibuf);
|
|
p = ibuf;
|
|
if (getnl(p) || p[6] != 'O')
|
|
return 0;
|
|
l = getns(p + 4);
|
|
if (l > len - 6 || !check_kgdb(&kgdb_if, shost, sport, dport, p + 6, l))
|
|
return 0;
|
|
kgdb_connect(1);
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
connectkgdb(ifp, buf)
|
|
struct kgdb_if *ifp;
|
|
char *buf;
|
|
{
|
|
char *cp;
|
|
u_char *ip;
|
|
|
|
if (*buf != 'O')
|
|
return -1;
|
|
for (cp = buf; *cp && *cp != ':'; cp++);
|
|
if (!*cp)
|
|
return -1;
|
|
*cp++ = 0;
|
|
ip = ifp->hisinetaddr;
|
|
printf("debugged by %s@%s (%d.%d.%d.%d)\n",buf + 1,cp,
|
|
ip[0], ip[1], ip[2], ip[3]);
|
|
ifp->connect = KGDB_SAME; /* if someone once connected, he may do so again */
|
|
ifp->flags |= KGDB_CONNECTED;
|
|
ifp->seq = 0;
|
|
ifp->pktlen = 0;
|
|
return 0;
|
|
}
|