spi-topcliff-pch: Fix issue for transmitting over 4KByte
[zen-stable.git] / tools / testing / selftests / breakpoints / breakpoint_test.c
bloba0743f3b2b57f885bd692e58b1c6e40723dc4837
1 /*
2 * Copyright (C) 2011 Red Hat, Inc., Frederic Weisbecker <fweisbec@redhat.com>
4 * Licensed under the terms of the GNU GPL License version 2
6 * Selftests for breakpoints (and more generally the do_debug() path) in x86.
7 */
10 #include <sys/ptrace.h>
11 #include <unistd.h>
12 #include <stddef.h>
13 #include <sys/user.h>
14 #include <stdio.h>
15 #include <stdlib.h>
16 #include <signal.h>
17 #include <sys/types.h>
18 #include <sys/wait.h>
21 /* Breakpoint access modes */
22 enum {
23 BP_X = 1,
24 BP_RW = 2,
25 BP_W = 4,
28 static pid_t child_pid;
31 * Ensures the child and parent are always "talking" about
32 * the same test sequence. (ie: that we haven't forgotten
33 * to call check_trapped() somewhere).
35 static int nr_tests;
37 static void set_breakpoint_addr(void *addr, int n)
39 int ret;
41 ret = ptrace(PTRACE_POKEUSER, child_pid,
42 offsetof(struct user, u_debugreg[n]), addr);
43 if (ret) {
44 perror("Can't set breakpoint addr\n");
45 exit(-1);
49 static void toggle_breakpoint(int n, int type, int len,
50 int local, int global, int set)
52 int ret;
54 int xtype, xlen;
55 unsigned long vdr7, dr7;
57 switch (type) {
58 case BP_X:
59 xtype = 0;
60 break;
61 case BP_W:
62 xtype = 1;
63 break;
64 case BP_RW:
65 xtype = 3;
66 break;
69 switch (len) {
70 case 1:
71 xlen = 0;
72 break;
73 case 2:
74 xlen = 4;
75 break;
76 case 4:
77 xlen = 0xc;
78 break;
79 case 8:
80 xlen = 8;
81 break;
84 dr7 = ptrace(PTRACE_PEEKUSER, child_pid,
85 offsetof(struct user, u_debugreg[7]), 0);
87 vdr7 = (xlen | xtype) << 16;
88 vdr7 <<= 4 * n;
90 if (local) {
91 vdr7 |= 1 << (2 * n);
92 vdr7 |= 1 << 8;
94 if (global) {
95 vdr7 |= 2 << (2 * n);
96 vdr7 |= 1 << 9;
99 if (set)
100 dr7 |= vdr7;
101 else
102 dr7 &= ~vdr7;
104 ret = ptrace(PTRACE_POKEUSER, child_pid,
105 offsetof(struct user, u_debugreg[7]), dr7);
106 if (ret) {
107 perror("Can't set dr7");
108 exit(-1);
112 /* Dummy variables to test read/write accesses */
113 static unsigned long long dummy_var[4];
115 /* Dummy functions to test execution accesses */
116 static void dummy_func(void) { }
117 static void dummy_func1(void) { }
118 static void dummy_func2(void) { }
119 static void dummy_func3(void) { }
121 static void (*dummy_funcs[])(void) = {
122 dummy_func,
123 dummy_func1,
124 dummy_func2,
125 dummy_func3,
128 static int trapped;
130 static void check_trapped(void)
133 * If we haven't trapped, wake up the parent
134 * so that it notices the failure.
136 if (!trapped)
137 kill(getpid(), SIGUSR1);
138 trapped = 0;
140 nr_tests++;
143 static void write_var(int len)
145 char *pcval; short *psval; int *pival; long long *plval;
146 int i;
148 for (i = 0; i < 4; i++) {
149 switch (len) {
150 case 1:
151 pcval = (char *)&dummy_var[i];
152 *pcval = 0xff;
153 break;
154 case 2:
155 psval = (short *)&dummy_var[i];
156 *psval = 0xffff;
157 break;
158 case 4:
159 pival = (int *)&dummy_var[i];
160 *pival = 0xffffffff;
161 break;
162 case 8:
163 plval = (long long *)&dummy_var[i];
164 *plval = 0xffffffffffffffffLL;
165 break;
167 check_trapped();
171 static void read_var(int len)
173 char cval; short sval; int ival; long long lval;
174 int i;
176 for (i = 0; i < 4; i++) {
177 switch (len) {
178 case 1:
179 cval = *(char *)&dummy_var[i];
180 break;
181 case 2:
182 sval = *(short *)&dummy_var[i];
183 break;
184 case 4:
185 ival = *(int *)&dummy_var[i];
186 break;
187 case 8:
188 lval = *(long long *)&dummy_var[i];
189 break;
191 check_trapped();
196 * Do the r/w/x accesses to trigger the breakpoints. And run
197 * the usual traps.
199 static void trigger_tests(void)
201 int len, local, global, i;
202 char val;
203 int ret;
205 ret = ptrace(PTRACE_TRACEME, 0, NULL, 0);
206 if (ret) {
207 perror("Can't be traced?\n");
208 return;
211 /* Wake up father so that it sets up the first test */
212 kill(getpid(), SIGUSR1);
214 /* Test instruction breakpoints */
215 for (local = 0; local < 2; local++) {
216 for (global = 0; global < 2; global++) {
217 if (!local && !global)
218 continue;
220 for (i = 0; i < 4; i++) {
221 dummy_funcs[i]();
222 check_trapped();
227 /* Test write watchpoints */
228 for (len = 1; len <= sizeof(long); len <<= 1) {
229 for (local = 0; local < 2; local++) {
230 for (global = 0; global < 2; global++) {
231 if (!local && !global)
232 continue;
233 write_var(len);
238 /* Test read/write watchpoints (on read accesses) */
239 for (len = 1; len <= sizeof(long); len <<= 1) {
240 for (local = 0; local < 2; local++) {
241 for (global = 0; global < 2; global++) {
242 if (!local && !global)
243 continue;
244 read_var(len);
249 /* Icebp trap */
250 asm(".byte 0xf1\n");
251 check_trapped();
253 /* Int 3 trap */
254 asm("int $3\n");
255 check_trapped();
257 kill(getpid(), SIGUSR1);
260 static void check_success(const char *msg)
262 const char *msg2;
263 int child_nr_tests;
264 int status;
266 /* Wait for the child to SIGTRAP */
267 wait(&status);
269 msg2 = "Failed";
271 if (WSTOPSIG(status) == SIGTRAP) {
272 child_nr_tests = ptrace(PTRACE_PEEKDATA, child_pid,
273 &nr_tests, 0);
274 if (child_nr_tests == nr_tests)
275 msg2 = "Ok";
276 if (ptrace(PTRACE_POKEDATA, child_pid, &trapped, 1)) {
277 perror("Can't poke\n");
278 exit(-1);
282 nr_tests++;
284 printf("%s [%s]\n", msg, msg2);
287 static void launch_instruction_breakpoints(char *buf, int local, int global)
289 int i;
291 for (i = 0; i < 4; i++) {
292 set_breakpoint_addr(dummy_funcs[i], i);
293 toggle_breakpoint(i, BP_X, 1, local, global, 1);
294 ptrace(PTRACE_CONT, child_pid, NULL, 0);
295 sprintf(buf, "Test breakpoint %d with local: %d global: %d",
296 i, local, global);
297 check_success(buf);
298 toggle_breakpoint(i, BP_X, 1, local, global, 0);
302 static void launch_watchpoints(char *buf, int mode, int len,
303 int local, int global)
305 const char *mode_str;
306 int i;
308 if (mode == BP_W)
309 mode_str = "write";
310 else
311 mode_str = "read";
313 for (i = 0; i < 4; i++) {
314 set_breakpoint_addr(&dummy_var[i], i);
315 toggle_breakpoint(i, mode, len, local, global, 1);
316 ptrace(PTRACE_CONT, child_pid, NULL, 0);
317 sprintf(buf, "Test %s watchpoint %d with len: %d local: "
318 "%d global: %d", mode_str, i, len, local, global);
319 check_success(buf);
320 toggle_breakpoint(i, mode, len, local, global, 0);
324 /* Set the breakpoints and check the child successfully trigger them */
325 static void launch_tests(void)
327 char buf[1024];
328 int len, local, global, i;
330 /* Instruction breakpoints */
331 for (local = 0; local < 2; local++) {
332 for (global = 0; global < 2; global++) {
333 if (!local && !global)
334 continue;
335 launch_instruction_breakpoints(buf, local, global);
339 /* Write watchpoint */
340 for (len = 1; len <= sizeof(long); len <<= 1) {
341 for (local = 0; local < 2; local++) {
342 for (global = 0; global < 2; global++) {
343 if (!local && !global)
344 continue;
345 launch_watchpoints(buf, BP_W, len,
346 local, global);
351 /* Read-Write watchpoint */
352 for (len = 1; len <= sizeof(long); len <<= 1) {
353 for (local = 0; local < 2; local++) {
354 for (global = 0; global < 2; global++) {
355 if (!local && !global)
356 continue;
357 launch_watchpoints(buf, BP_RW, len,
358 local, global);
363 /* Icebp traps */
364 ptrace(PTRACE_CONT, child_pid, NULL, 0);
365 check_success("Test icebp");
367 /* Int 3 traps */
368 ptrace(PTRACE_CONT, child_pid, NULL, 0);
369 check_success("Test int 3 trap");
371 ptrace(PTRACE_CONT, child_pid, NULL, 0);
374 int main(int argc, char **argv)
376 pid_t pid;
377 int ret;
379 pid = fork();
380 if (!pid) {
381 trigger_tests();
382 return 0;
385 child_pid = pid;
387 wait(NULL);
389 launch_tests();
391 wait(NULL);
393 return 0;