1132624Smarcel/*
2132624Smarcel * Copyright (c) 2004 Marcel Moolenaar
3132624Smarcel * All rights reserved.
4132624Smarcel *
5132624Smarcel * Redistribution and use in source and binary forms, with or without
6132624Smarcel * modification, are permitted provided that the following conditions
7132624Smarcel * are met:
8132624Smarcel *
9132624Smarcel * 1. Redistributions of source code must retain the above copyright
10132624Smarcel *    notice, this list of conditions and the following disclaimer.
11132624Smarcel * 2. Redistributions in binary form must reproduce the above copyright
12132624Smarcel *    notice, this list of conditions and the following disclaimer in the
13132624Smarcel *    documentation and/or other materials provided with the distribution.
14132624Smarcel *
15132624Smarcel * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
16132624Smarcel * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17132624Smarcel * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18132624Smarcel * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
19132624Smarcel * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20132624Smarcel * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21132624Smarcel * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22132624Smarcel * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23132624Smarcel * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24132624Smarcel * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25132624Smarcel */
26132624Smarcel
27132624Smarcel#include <sys/cdefs.h>
28132624Smarcel__FBSDID("$FreeBSD$");
29132624Smarcel
30132624Smarcel#include <sys/param.h>
31222813Sattilio#include <sys/cpuset.h>
32132624Smarcel#include <sys/proc.h>
33132624Smarcel#include <sys/types.h>
34132624Smarcel#include <sys/signal.h>
35132624Smarcel#include <err.h>
36132624Smarcel#include <inttypes.h>
37132624Smarcel#include <kvm.h>
38132624Smarcel#include <stdio.h>
39132624Smarcel#include <stdlib.h>
40175452Semaste#include <string.h>
41222813Sattilio#include <unistd.h>
42132624Smarcel
43142151Skan#include <defs.h>
44149954Smarcel#include <frame-unwind.h>
45142151Skan
46132624Smarcel#include "kgdb.h"
47132624Smarcel
48210852Sjhbstatic CORE_ADDR dumppcb;
49132624Smarcelstatic int dumptid;
50132624Smarcel
51222813Sattiliostatic cpuset_t stopped_cpus;
52161621Sjhb
53132624Smarcelstatic struct kthr *first;
54132624Smarcelstruct kthr *curkthr;
55132624Smarcel
56210852SjhbCORE_ADDR
57167142Skibkgdb_lookup(const char *sym)
58132624Smarcel{
59210852Sjhb	CORE_ADDR addr;
60210852Sjhb	char *name;
61132624Smarcel
62210852Sjhb	asprintf(&name, "&%s", sym);
63210852Sjhb	addr = kgdb_parse(name);
64210852Sjhb	free(name);
65210852Sjhb	return (addr);
66132624Smarcel}
67132624Smarcel
68132624Smarcelstruct kthr *
69132624Smarcelkgdb_thr_first(void)
70132624Smarcel{
71132624Smarcel	return (first);
72132624Smarcel}
73132624Smarcel
74225017Sjhbstatic void
75225017Sjhbkgdb_thr_add_procs(uintptr_t paddr)
76225017Sjhb{
77225017Sjhb	struct proc p;
78225017Sjhb	struct thread td;
79225017Sjhb	struct kthr *kt;
80225017Sjhb	CORE_ADDR addr;
81225017Sjhb
82225017Sjhb	while (paddr != 0) {
83225017Sjhb		if (kvm_read(kvm, paddr, &p, sizeof(p)) != sizeof(p)) {
84225017Sjhb			warnx("kvm_read: %s", kvm_geterr(kvm));
85225017Sjhb			break;
86225017Sjhb		}
87225017Sjhb		addr = (uintptr_t)TAILQ_FIRST(&p.p_threads);
88225017Sjhb		while (addr != 0) {
89225017Sjhb			if (kvm_read(kvm, addr, &td, sizeof(td)) !=
90225017Sjhb			    sizeof(td)) {
91225017Sjhb				warnx("kvm_read: %s", kvm_geterr(kvm));
92225017Sjhb				break;
93225017Sjhb			}
94225017Sjhb			kt = malloc(sizeof(*kt));
95225017Sjhb			kt->next = first;
96225017Sjhb			kt->kaddr = addr;
97225017Sjhb			if (td.td_tid == dumptid)
98225017Sjhb				kt->pcb = dumppcb;
99275644Sdchagin			else if (td.td_oncpu != NOCPU &&
100225017Sjhb			    CPU_ISSET(td.td_oncpu, &stopped_cpus))
101246893Smarcel				kt->pcb = kgdb_trgt_core_pcb(td.td_oncpu);
102225017Sjhb			else
103225017Sjhb				kt->pcb = (uintptr_t)td.td_pcb;
104225017Sjhb			kt->kstack = td.td_kstack;
105225017Sjhb			kt->tid = td.td_tid;
106225017Sjhb			kt->pid = p.p_pid;
107225017Sjhb			kt->paddr = paddr;
108225017Sjhb			kt->cpu = td.td_oncpu;
109225017Sjhb			first = kt;
110225017Sjhb			addr = (uintptr_t)TAILQ_NEXT(&td, td_plist);
111225017Sjhb		}
112225017Sjhb		paddr = (uintptr_t)LIST_NEXT(&p, p_list);
113225017Sjhb	}
114225017Sjhb}
115225017Sjhb
116132624Smarcelstruct kthr *
117132624Smarcelkgdb_thr_init(void)
118132624Smarcel{
119222813Sattilio	long cpusetsize;
120132624Smarcel	struct kthr *kt;
121210852Sjhb	CORE_ADDR addr;
122210852Sjhb	uintptr_t paddr;
123178670Sjhb
124178670Sjhb	while (first != NULL) {
125178670Sjhb		kt = first;
126178670Sjhb		first = kt->next;
127178670Sjhb		free(kt);
128178670Sjhb	}
129132624Smarcel
130210852Sjhb	addr = kgdb_lookup("allproc");
131210852Sjhb	if (addr == 0)
132132624Smarcel		return (NULL);
133132624Smarcel	kvm_read(kvm, addr, &paddr, sizeof(paddr));
134132624Smarcel
135210852Sjhb	dumppcb = kgdb_lookup("dumppcb");
136210852Sjhb	if (dumppcb == 0)
137132624Smarcel		return (NULL);
138132624Smarcel
139210852Sjhb	addr = kgdb_lookup("dumptid");
140132624Smarcel	if (addr != 0)
141132624Smarcel		kvm_read(kvm, addr, &dumptid, sizeof(dumptid));
142132624Smarcel	else
143132624Smarcel		dumptid = -1;
144132624Smarcel
145210852Sjhb	addr = kgdb_lookup("stopped_cpus");
146222813Sattilio	CPU_ZERO(&stopped_cpus);
147222813Sattilio	cpusetsize = sysconf(_SC_CPUSET_SIZE);
148222813Sattilio	if (cpusetsize != -1 && (u_long)cpusetsize <= sizeof(cpuset_t) &&
149222813Sattilio	    addr != 0)
150222813Sattilio		kvm_read(kvm, addr, &stopped_cpus, cpusetsize);
151161621Sjhb
152225017Sjhb	kgdb_thr_add_procs(paddr);
153225017Sjhb	addr = kgdb_lookup("zombproc");
154225017Sjhb	if (addr != 0) {
155225017Sjhb		kvm_read(kvm, addr, &paddr, sizeof(paddr));
156225017Sjhb		kgdb_thr_add_procs(paddr);
157132624Smarcel	}
158142151Skan	curkthr = kgdb_thr_lookup_tid(dumptid);
159132624Smarcel	if (curkthr == NULL)
160132624Smarcel		curkthr = first;
161132624Smarcel	return (first);
162132624Smarcel}
163132624Smarcel
164132624Smarcelstruct kthr *
165142151Skankgdb_thr_lookup_tid(int tid)
166132624Smarcel{
167132624Smarcel	struct kthr *kt;
168132624Smarcel
169132624Smarcel	kt = first;
170132624Smarcel	while (kt != NULL && kt->tid != tid)
171132624Smarcel		kt = kt->next;
172132624Smarcel	return (kt);
173132624Smarcel}
174132624Smarcel
175132624Smarcelstruct kthr *
176142151Skankgdb_thr_lookup_taddr(uintptr_t taddr)
177142151Skan{
178142151Skan	struct kthr *kt;
179142151Skan
180142151Skan	kt = first;
181142151Skan	while (kt != NULL && kt->kaddr != taddr)
182142151Skan		kt = kt->next;
183142151Skan	return (kt);
184142151Skan}
185142151Skan
186142151Skanstruct kthr *
187142151Skankgdb_thr_lookup_pid(int pid)
188142151Skan{
189142151Skan	struct kthr *kt;
190142151Skan
191142151Skan	kt = first;
192142151Skan	while (kt != NULL && kt->pid != pid)
193142151Skan		kt = kt->next;
194142151Skan	return (kt);
195142151Skan}
196142151Skan
197142151Skanstruct kthr *
198142151Skankgdb_thr_lookup_paddr(uintptr_t paddr)
199142151Skan{
200142151Skan	struct kthr *kt;
201142151Skan
202142151Skan	kt = first;
203142151Skan	while (kt != NULL && kt->paddr != paddr)
204142151Skan		kt = kt->next;
205142151Skan	return (kt);
206142151Skan}
207142151Skan
208142151Skanstruct kthr *
209132624Smarcelkgdb_thr_next(struct kthr *kt)
210132624Smarcel{
211132624Smarcel	return (kt->next);
212132624Smarcel}
213132624Smarcel
214132624Smarcelstruct kthr *
215132624Smarcelkgdb_thr_select(struct kthr *kt)
216132624Smarcel{
217132624Smarcel	struct kthr *pcur;
218132624Smarcel
219132624Smarcel	pcur = curkthr;
220132624Smarcel	curkthr = kt;
221132624Smarcel	return (pcur);
222132624Smarcel}
223142151Skan
224142151Skanchar *
225142151Skankgdb_thr_extra_thread_info(int tid)
226142151Skan{
227175452Semaste	char comm[MAXCOMLEN + 1];
228175452Semaste	char td_name[MAXCOMLEN + 1];
229142151Skan	struct kthr *kt;
230142151Skan	struct proc *p;
231175452Semaste	struct thread *t;
232178713Sjhb	static char buf[64];
233142151Skan
234142151Skan	kt = kgdb_thr_lookup_tid(tid);
235142151Skan	if (kt == NULL)
236178713Sjhb		return (NULL);
237178713Sjhb	snprintf(buf, sizeof(buf), "PID=%d", kt->pid);
238142151Skan	p = (struct proc *)kt->paddr;
239142151Skan	if (kvm_read(kvm, (uintptr_t)&p->p_comm[0], &comm, sizeof(comm)) !=
240142151Skan	    sizeof(comm))
241178713Sjhb		return (buf);
242178713Sjhb	strlcat(buf, ": ", sizeof(buf));
243178713Sjhb	strlcat(buf, comm, sizeof(buf));
244178713Sjhb	t = (struct thread *)kt->kaddr;
245175452Semaste	if (kvm_read(kvm, (uintptr_t)&t->td_name[0], &td_name,
246175452Semaste	    sizeof(td_name)) == sizeof(td_name) &&
247178713Sjhb	    strcmp(comm, td_name) != 0) {
248178713Sjhb		strlcat(buf, "/", sizeof(buf));
249178713Sjhb		strlcat(buf, td_name, sizeof(buf));
250178713Sjhb	}
251178713Sjhb	return (buf);
252142151Skan}
253