14bc66c0fSBrooks Davis /*-
24bc66c0fSBrooks Davis * SPDX-License-Identifier: BSD-2-Clause
34bc66c0fSBrooks Davis *
44bc66c0fSBrooks Davis * Copyright 2000 Brian S. Dean <bsd@bsdhome.com>
54bc66c0fSBrooks Davis * All Rights Reserved.
64bc66c0fSBrooks Davis *
74bc66c0fSBrooks Davis * Redistribution and use in source and binary forms, with or without
84bc66c0fSBrooks Davis * modification, are permitted provided that the following conditions
94bc66c0fSBrooks Davis * are met:
104bc66c0fSBrooks Davis *
114bc66c0fSBrooks Davis * 1. Redistributions of source code must retain the above copyright
124bc66c0fSBrooks Davis * notice, this list of conditions and the following disclaimer.
134bc66c0fSBrooks Davis * 2. Redistributions in binary form must reproduce the above copyright
144bc66c0fSBrooks Davis * notice, this list of conditions and the following disclaimer in the
154bc66c0fSBrooks Davis * documentation and/or other materials provided with the distribution.
164bc66c0fSBrooks Davis *
174bc66c0fSBrooks Davis * THIS SOFTWARE IS PROVIDED BY BRIAN S. DEAN ``AS IS'' AND ANY
184bc66c0fSBrooks Davis * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
194bc66c0fSBrooks Davis * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
204bc66c0fSBrooks Davis * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BRIAN S. DEAN BE LIABLE
214bc66c0fSBrooks Davis * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
224bc66c0fSBrooks Davis * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
234bc66c0fSBrooks Davis * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
244bc66c0fSBrooks Davis * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
254bc66c0fSBrooks Davis * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
264bc66c0fSBrooks Davis * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
274bc66c0fSBrooks Davis * USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
284bc66c0fSBrooks Davis * DAMAGE.
294bc66c0fSBrooks Davis */
304bc66c0fSBrooks Davis
314bc66c0fSBrooks Davis #include <machine/reg.h>
324bc66c0fSBrooks Davis #include <machine/sysarch.h>
334bc66c0fSBrooks Davis
344bc66c0fSBrooks Davis int
i386_set_watch(int watchnum,unsigned int watchaddr,int size,int access,struct dbreg * d)354bc66c0fSBrooks Davis i386_set_watch(int watchnum, unsigned int watchaddr, int size,
364bc66c0fSBrooks Davis int access, struct dbreg * d)
374bc66c0fSBrooks Davis {
384bc66c0fSBrooks Davis int i;
394bc66c0fSBrooks Davis unsigned int mask;
404bc66c0fSBrooks Davis
414bc66c0fSBrooks Davis if (watchnum == -1) {
424bc66c0fSBrooks Davis for (i = 0, mask = 0x3; i < 4; i++, mask <<= 2)
434bc66c0fSBrooks Davis if ((DBREG_DRX(d,7) & mask) == 0)
444bc66c0fSBrooks Davis break;
454bc66c0fSBrooks Davis if (i < 4)
464bc66c0fSBrooks Davis watchnum = i;
474bc66c0fSBrooks Davis else
484bc66c0fSBrooks Davis return -1;
494bc66c0fSBrooks Davis }
504bc66c0fSBrooks Davis
514bc66c0fSBrooks Davis switch (access) {
524bc66c0fSBrooks Davis case DBREG_DR7_EXEC:
534bc66c0fSBrooks Davis size = 1; /* size must be 1 for an execution breakpoint */
544bc66c0fSBrooks Davis /* fall through */
554bc66c0fSBrooks Davis case DBREG_DR7_WRONLY:
564bc66c0fSBrooks Davis case DBREG_DR7_RDWR:
574bc66c0fSBrooks Davis break;
584bc66c0fSBrooks Davis default : return -1; break;
594bc66c0fSBrooks Davis }
604bc66c0fSBrooks Davis
614bc66c0fSBrooks Davis /*
624bc66c0fSBrooks Davis * we can watch a 1, 2, or 4 byte sized location
634bc66c0fSBrooks Davis */
644bc66c0fSBrooks Davis switch (size) {
654bc66c0fSBrooks Davis case 1 : mask = 0x00; break;
664bc66c0fSBrooks Davis case 2 : mask = 0x01 << 2; break;
674bc66c0fSBrooks Davis case 4 : mask = 0x03 << 2; break;
684bc66c0fSBrooks Davis default : return -1; break;
694bc66c0fSBrooks Davis }
704bc66c0fSBrooks Davis
714bc66c0fSBrooks Davis mask |= access;
724bc66c0fSBrooks Davis
734bc66c0fSBrooks Davis /* clear the bits we are about to affect */
744bc66c0fSBrooks Davis DBREG_DRX(d,7) &= ~((0x3 << (watchnum*2)) | (0x0f << (watchnum*4+16)));
754bc66c0fSBrooks Davis
764bc66c0fSBrooks Davis /* set drN register to the address, N=watchnum */
774bc66c0fSBrooks Davis DBREG_DRX(d,watchnum) = watchaddr;
784bc66c0fSBrooks Davis
794bc66c0fSBrooks Davis /* enable the watchpoint */
804bc66c0fSBrooks Davis DBREG_DRX(d,7) |= (0x2 << (watchnum*2)) | (mask << (watchnum*4+16));
814bc66c0fSBrooks Davis
824bc66c0fSBrooks Davis return watchnum;
834bc66c0fSBrooks Davis }
84