sys/powerpc/booke/machdep.c

   1 /*-
   2  * Copyright (C) 2006-2012 Semihalf
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  15  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  16  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
  17  * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  18  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
  19  * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
  20  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
  21  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
  22  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  23  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  24  */
  25 /*-
  26  * Copyright (C) 2001 Benno Rice
  27  * All rights reserved.
  28  *
  29  * Redistribution and use in source and binary forms, with or without
  30  * modification, are permitted provided that the following conditions
  31  * are met:
  32  * 1. Redistributions of source code must retain the above copyright
  33  *    notice, this list of conditions and the following disclaimer.
  34  * 2. Redistributions in binary form must reproduce the above copyright
  35  *    notice, this list of conditions and the following disclaimer in the
  36  *    documentation and/or other materials provided with the distribution.
  37  *
  38  * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR
  39  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  40  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  41  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  42  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  43  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  44  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  45  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  46  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
  47  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  48  * $NetBSD: machdep.c,v 1.74.2.1 2000/11/01 16:13:48 tv Exp $
  49  */
  50 /*-
  51  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
  52  * Copyright (C) 1995, 1996 TooLs GmbH.
  53  * All rights reserved.
  54  *
  55  * Redistribution and use in source and binary forms, with or without
  56  * modification, are permitted provided that the following conditions
  57  * are met:
  58  * 1. Redistributions of source code must retain the above copyright
  59  *    notice, this list of conditions and the following disclaimer.
  60  * 2. Redistributions in binary form must reproduce the above copyright
  61  *    notice, this list of conditions and the following disclaimer in the
  62  *    documentation and/or other materials provided with the distribution.
  63  * 3. All advertising materials mentioning features or use of this software
  64  *    must display the following acknowledgement:
  65  *      This product includes software developed by TooLs GmbH.
  66  * 4. The name of TooLs GmbH may not be used to endorse or promote products
  67  *    derived from this software without specific prior written permission.
  68  *
  69  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
  70  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  71  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  72  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  73  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  74  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  75  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  76  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  77  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
  78  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  79  */
  80
  81 #include <sys/cdefs.h>
  82 __FBSDID("$FreeBSD$");
  83
  84 #include "opt_compat.h"
  85 #include "opt_ddb.h"
  86 #include "opt_kstack_pages.h"
  87 #include "opt_platform.h"
  88
  89 #include <sys/cdefs.h>
  90 #include <sys/types.h>
  91 #include <sys/param.h>
  92 #include <sys/proc.h>
  93 #include <sys/systm.h>
  94 #include <sys/time.h>
  95 #include <sys/bio.h>
  96 #include <sys/buf.h>
  97 #include <sys/bus.h>
  98 #include <sys/cons.h>
  99 #include <sys/cpu.h>
 100 #include <sys/kdb.h>
 101 #include <sys/kernel.h>
 102 #include <sys/lock.h>
 103 #include <sys/mutex.h>
 104 #include <sys/rwlock.h>
 105 #include <sys/sysctl.h>
 106 #include <sys/exec.h>
 107 #include <sys/ktr.h>
 108 #include <sys/syscallsubr.h>
 109 #include <sys/sysproto.h>
 110 #include <sys/signalvar.h>
 111 #include <sys/sysent.h>
 112 #include <sys/imgact.h>
 113 #include <sys/msgbuf.h>
 114 #include <sys/ptrace.h>
 115
 116 #include <vm/vm.h>
 117 #include <vm/pmap.h>
 118 #include <vm/vm_page.h>
 119 #include <vm/vm_object.h>
 120 #include <vm/vm_pager.h>
 121
 122 #include <machine/cpu.h>
 123 #include <machine/kdb.h>
 124 #include <machine/reg.h>
 125 #include <machine/vmparam.h>
 126 #include <machine/spr.h>
 127 #include <machine/hid.h>
 128 #include <machine/psl.h>
 129 #include <machine/trap.h>
 130 #include <machine/md_var.h>
 131 #include <machine/mmuvar.h>
 132 #include <machine/sigframe.h>
 133 #include <machine/machdep.h>
 134 #include <machine/metadata.h>
 135 #include <machine/platform.h>
 136
 137 #include <sys/linker.h>
 138 #include <sys/reboot.h>
 139
 140 #include <contrib/libfdt/libfdt.h>
 141 #include <dev/fdt/fdt_common.h>
 142 #include <dev/ofw/openfirm.h>
 143
 144 #ifdef DDB
 145 #include <ddb/ddb.h>
 146 #endif
 147
 148 #ifdef  DEBUG
 149 #define debugf(fmt, args...) printf(fmt, ##args)
 150 #else
 151 #define debugf(fmt, args...)
 152 #endif
 153
 154 extern unsigned char kernel_text[];
 155 extern unsigned char _etext[];
 156 extern unsigned char _edata[];
 157 extern unsigned char __bss_start[];
 158 extern unsigned char __sbss_start[];
 159 extern unsigned char __sbss_end[];
 160 extern unsigned char _end[];
 161
 162 /*
 163  * Bootinfo is passed to us by legacy loaders. Save the address of the
 164  * structure to handle backward compatibility.
 165  */
 166 uint32_t *bootinfo;
 167
 168 struct kva_md_info kmi;
 169 struct pcpu __pcpu[MAXCPU];
 170 struct trapframe frame0;
 171 int cold = 1;
 172 long realmem = 0;
 173 long Maxmem = 0;
 174 char machine[] = "powerpc";
 175 SYSCTL_STRING(_hw, HW_MACHINE, machine, CTLFLAG_RD, machine, 0, "");
 176
 177 int cacheline_size = 32;
 178
 179 SYSCTL_INT(_machdep, CPU_CACHELINE, cacheline_size,
 180            CTLFLAG_RD, &cacheline_size, 0, "");
 181
 182 int hw_direct_map = 0;
 183
 184 static void cpu_booke_startup(void *);
 185 SYSINIT(cpu, SI_SUB_CPU, SI_ORDER_FIRST, cpu_booke_startup, NULL);
 186
 187 void print_kernel_section_addr(void);
 188 void print_kenv(void);
 189 u_int booke_init(uint32_t, uint32_t);
 190
 191 extern int elf32_nxstack;
 192
 193 static void
 194 cpu_booke_startup(void *dummy)
 195 {
 196         int indx;
 197         unsigned long size;
 198
 199         /* Initialise the decrementer-based clock. */
 200         decr_init();
 201
 202         /* Good {morning,afternoon,evening,night}. */
 203         cpu_setup(PCPU_GET(cpuid));
 204
 205         printf("real memory  = %lu (%ld MB)\n", ptoa(physmem),
 206             ptoa(physmem) / 1048576);
 207         realmem = physmem;
 208
 209         /* Display any holes after the first chunk of extended memory. */
 210         if (bootverbose) {
 211                 printf("Physical memory chunk(s):\n");
 212                 for (indx = 0; phys_avail[indx + 1] != 0; indx += 2) {
 213                         size = phys_avail[indx + 1] - phys_avail[indx];
 214
 215                         printf("0x%08x - 0x%08x, %lu bytes (%lu pages)\n",
 216                             phys_avail[indx], phys_avail[indx + 1] - 1,
 217                             size, size / PAGE_SIZE);
 218                 }
 219         }
 220
 221         vm_ksubmap_init(&kmi);
 222
 223         printf("avail memory = %lu (%ld MB)\n", ptoa(vm_cnt.v_free_count),
 224             ptoa(vm_cnt.v_free_count) / 1048576);
 225
 226         /* Set up buffers, so they can be used to read disk labels. */
 227         bufinit();
 228         vm_pager_bufferinit();
 229
 230         /* Cpu supports execution permissions on the pages. */
 231         elf32_nxstack = 1;
 232 }
 233
 234 static char *
 235 kenv_next(char *cp)
 236 {
 237
 238         if (cp != NULL) {
 239                 while (*cp != 0)
 240                         cp++;
 241                 cp++;
 242                 if (*cp == 0)
 243                         cp = NULL;
 244         }
 245         return (cp);
 246 }
 247
 248 void
 249 print_kenv(void)
 250 {
 251         int len;
 252         char *cp;
 253
 254         debugf("loader passed (static) kenv:\n");
 255         if (kern_envp == NULL) {
 256                 debugf(" no env, null ptr\n");
 257                 return;
 258         }
 259         debugf(" kern_envp = 0x%08x\n", (u_int32_t)kern_envp);
 260
 261         len = 0;
 262         for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
 263                 debugf(" %x %s\n", (u_int32_t)cp, cp);
 264 }
 265
 266 void
 267 print_kernel_section_addr(void)
 268 {
 269
 270         debugf("kernel image addresses:\n");
 271         debugf(" kernel_text    = 0x%08x\n", (uint32_t)kernel_text);
 272         debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
 273         debugf(" _edata         = 0x%08x\n", (uint32_t)_edata);
 274         debugf(" __sbss_start   = 0x%08x\n", (uint32_t)__sbss_start);
 275         debugf(" __sbss_end     = 0x%08x\n", (uint32_t)__sbss_end);
 276         debugf(" __sbss_start   = 0x%08x\n", (uint32_t)__bss_start);
 277         debugf(" _end           = 0x%08x\n", (uint32_t)_end);
 278 }
 279
 280 static int
 281 booke_check_for_fdt(uint32_t arg1, vm_offset_t *dtbp)
 282 {
 283         void *ptr;
 284
 285         if (arg1 % 8 != 0)
 286                 return (-1);
 287
 288         ptr = (void *)pmap_early_io_map(arg1, PAGE_SIZE);
 289         if (fdt_check_header(ptr) != 0)
 290                 return (-1);
 291
 292         *dtbp = (vm_offset_t)ptr;
 293
 294         return (0);
 295 }
 296
 297 u_int
 298 booke_init(uint32_t arg1, uint32_t arg2)
 299 {
 300         struct pcpu *pc;
 301         void *kmdp, *mdp;
 302         vm_offset_t dtbp, end;
 303 #ifdef DDB
 304         vm_offset_t ksym_start;
 305         vm_offset_t ksym_end;
 306 #endif
 307
 308         kmdp = NULL;
 309
 310         end = (uintptr_t)_end;
 311         dtbp = (vm_offset_t)NULL;
 312
 313         /* Set up TLB initially */
 314         bootinfo = NULL;
 315         tlb1_init();
 316
 317         /*
 318          * Handle the various ways we can get loaded and started:
 319          *  -   FreeBSD's loader passes the pointer to the metadata
 320          *      in arg1, with arg2 undefined. arg1 has a value that's
 321          *      relative to the kernel's link address (i.e. larger
 322          *      than 0xc0000000).
 323          *  -   Juniper's loader passes the metadata pointer in arg2
 324          *      and sets arg1 to zero. This is to signal that the
 325          *      loader maps the kernel and starts it at its link
 326          *      address (unlike the FreeBSD loader).
 327          *  -   U-Boot passes the standard argc and argv parameters
 328          *      in arg1 and arg2 (resp). arg1 is between 1 and some
 329          *      relatively small number, such as 64K. arg2 is the
 330          *      physical address of the argv vector.
 331          *  -   ePAPR loaders pass an FDT blob in r3 (arg1) and the magic hex
 332          *      string 0x45504150 ('ePAP') in r6 (which has been lost by now).
 333          *      r4 (arg2) is supposed to be set to zero, but is not always.
 334          */
 335
 336         if (arg1 == 0)                          /* Juniper loader */
 337                 mdp = (void *)arg2;
 338         else if (booke_check_for_fdt(arg1, &dtbp) == 0) { /* ePAPR */
 339                 end = roundup(end, 8);
 340                 memmove((void *)end, (void *)dtbp, fdt_totalsize((void *)dtbp));
 341                 dtbp = end;
 342                 end += fdt_totalsize((void *)dtbp);
 343                 mdp = NULL;
 344         } else if (arg1 > (uintptr_t)kernel_text)       /* FreeBSD loader */
 345                 mdp = (void *)arg1;
 346         else                                    /* U-Boot */
 347                 mdp = NULL;
 348
 349         /*
 350          * Parse metadata and fetch parameters.
 351          */
 352         if (mdp != NULL) {
 353                 preload_metadata = mdp;
 354                 kmdp = preload_search_by_type("elf kernel");
 355                 if (kmdp != NULL) {
 356                         boothowto = MD_FETCH(kmdp, MODINFOMD_HOWTO, int);
 357                         kern_envp = MD_FETCH(kmdp, MODINFOMD_ENVP, char *);
 358                         dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
 359                         end = MD_FETCH(kmdp, MODINFOMD_KERNEND, vm_offset_t);
 360
 361                         bootinfo = (uint32_t *)preload_search_info(kmdp,
 362                             MODINFO_METADATA | MODINFOMD_BOOTINFO);
 363
 364 #ifdef DDB
 365                         ksym_start = MD_FETCH(kmdp, MODINFOMD_SSYM, uintptr_t);
 366                         ksym_end = MD_FETCH(kmdp, MODINFOMD_ESYM, uintptr_t);
 367                         db_fetch_ksymtab(ksym_start, ksym_end);
 368 #endif
 369                 }
 370         } else {
 371                 bzero(__sbss_start, __sbss_end - __sbss_start);
 372                 bzero(__bss_start, _end - __bss_start);
 373         }
 374
 375 #if defined(FDT_DTB_STATIC)
 376         /*
 377          * In case the device tree blob was not retrieved (from metadata) try
 378          * to use the statically embedded one.
 379          */
 380         if (dtbp == (vm_offset_t)NULL)
 381                 dtbp = (vm_offset_t)&fdt_static_dtb;
 382 #endif
 383
 384         if (OF_install(OFW_FDT, 0) == FALSE)
 385                 while (1);
 386
 387         if (OF_init((void *)dtbp) != 0)
 388                 while (1);
 389
 390         OF_interpret("perform-fixup", 0);
 391
 392         /* Reset TLB1 to get rid of temporary mappings */
 393         tlb1_init();
 394
 395         /* Reset Time Base */
 396         mttb(0);
 397
 398         /* Init params/tunables that can be overridden by the loader. */
 399         init_param1();
 400
 401         /* Start initializing proc0 and thread0. */
 402         proc_linkup0(&proc0, &thread0);
 403         thread0.td_frame = &frame0;
 404
 405         /* Set up per-cpu data and store the pointer in SPR general 0. */
 406         pc = &__pcpu[0];
 407         pcpu_init(pc, 0, sizeof(struct pcpu));
 408         pc->pc_curthread = &thread0;
 409 #ifdef __powerpc64__
 410         __asm __volatile("mr 13,%0" :: "r"(pc->pc_curthread));
 411 #else
 412         __asm __volatile("mr 2,%0" :: "r"(pc->pc_curthread));
 413 #endif
 414         __asm __volatile("mtsprg 0, %0" :: "r"(pc));
 415
 416         /* Initialize system mutexes. */
 417         mutex_init();
 418
 419         /* Initialize the console before printing anything. */
 420         cninit();
 421
 422         /* Print out some debug info... */
 423         debugf("%s: console initialized\n", __func__);
 424         debugf(" arg3 mdp = 0x%08x\n", (u_int32_t)mdp);
 425         debugf(" end = 0x%08x\n", (u_int32_t)end);
 426         debugf(" boothowto = 0x%08x\n", boothowto);
 427         debugf(" kernel ccsrbar = 0x%08x\n", CCSRBAR_VA);
 428         debugf(" MSR = 0x%08x\n", mfmsr());
 429 #if defined(BOOKE_E500)
 430         debugf(" HID0 = 0x%08x\n", mfspr(SPR_HID0));
 431         debugf(" HID1 = 0x%08x\n", mfspr(SPR_HID1));
 432         debugf(" BUCSR = 0x%08x\n", mfspr(SPR_BUCSR));
 433 #endif
 434
 435         debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
 436
 437         print_kernel_section_addr();
 438         print_kenv();
 439 #if defined(BOOKE_E500)
 440         //tlb1_print_entries();
 441         //tlb1_print_tlbentries();
 442 #endif
 443
 444         kdb_init();
 445
 446 #ifdef KDB
 447         if (boothowto & RB_KDB)
 448                 kdb_enter(KDB_WHY_BOOTFLAGS, "Boot flags requested debugger");
 449 #endif
 450
 451         /* Initialise platform module */
 452         platform_probe_and_attach();
 453
 454         /* Initialise virtual memory. */
 455         pmap_mmu_install(MMU_TYPE_BOOKE, 0);
 456         pmap_bootstrap((uintptr_t)kernel_text, end);
 457         pmap_bootstrapped = 1;
 458         debugf("MSR = 0x%08x\n", mfmsr());
 459 #if defined(BOOKE_E500)
 460         //tlb1_print_entries();
 461         //tlb1_print_tlbentries();
 462 #endif
 463
 464         /* Initialize params/tunables that are derived from memsize. */
 465         init_param2(physmem);
 466
 467         /* Finish setting up thread0. */
 468         thread0.td_pcb = (struct pcb *)
 469             ((thread0.td_kstack + thread0.td_kstack_pages * PAGE_SIZE -
 470             sizeof(struct pcb)) & ~15);
 471         bzero((void *)thread0.td_pcb, sizeof(struct pcb));
 472         pc->pc_curpcb = thread0.td_pcb;
 473
 474         /* Initialise the message buffer. */
 475         msgbufinit(msgbufp, msgbufsize);
 476
 477         /* Enable Machine Check interrupt. */
 478         mtmsr(mfmsr() | PSL_ME);
 479         isync();
 480
 481         /* Enable L1 caches */
 482         booke_enable_l1_cache();
 483
 484         debugf("%s: SP = 0x%08x\n", __func__,
 485             ((uintptr_t)thread0.td_pcb - 16) & ~15);
 486
 487         return (((uintptr_t)thread0.td_pcb - 16) & ~15);
 488 }
 489
 490 #define RES_GRANULE 32
 491 extern uint32_t tlb0_miss_locks[];
 492
 493 /* Initialise a struct pcpu. */
 494 void
 495 cpu_pcpu_init(struct pcpu *pcpu, int cpuid, size_t sz)
 496 {
 497
 498         pcpu->pc_tid_next = TID_MIN;
 499
 500 #ifdef SMP
 501         uint32_t *ptr;
 502         int words_per_gran = RES_GRANULE / sizeof(uint32_t);
 503
 504         ptr = &tlb0_miss_locks[cpuid * words_per_gran];
 505         pcpu->pc_booke_tlb_lock = ptr;
 506         *ptr = TLB_UNLOCKED;
 507         *(ptr + 1) = 0;         /* recurse counter */
 508 #endif
 509 }
 510
 511 /*
 512  * Flush the D-cache for non-DMA I/O so that the I-cache can
 513  * be made coherent later.
 514  */
 515 void
 516 cpu_flush_dcache(void *ptr, size_t len)
 517 {
 518         register_t addr, off;
 519
 520         /*
 521          * Align the address to a cacheline and adjust the length
 522          * accordingly. Then round the length to a multiple of the
 523          * cacheline for easy looping.
 524          */
 525         addr = (uintptr_t)ptr;
 526         off = addr & (cacheline_size - 1);
 527         addr -= off;
 528         len = (len + off + cacheline_size - 1) & ~(cacheline_size - 1);
 529
 530         while (len > 0) {
 531                 __asm __volatile ("dcbf 0,%0" :: "r"(addr));
 532                 __asm __volatile ("sync");
 533                 addr += cacheline_size;
 534                 len -= cacheline_size;
 535         }
 536 }
 537
 538 void
 539 spinlock_enter(void)
 540 {
 541         struct thread *td;
 542         register_t msr;
 543
 544         td = curthread;
 545         if (td->td_md.md_spinlock_count == 0) {
 546                 msr = intr_disable();
 547                 td->td_md.md_spinlock_count = 1;
 548                 td->td_md.md_saved_msr = msr;
 549         } else
 550                 td->td_md.md_spinlock_count++;
 551         critical_enter();
 552 }
 553
 554 void
 555 spinlock_exit(void)
 556 {
 557         struct thread *td;
 558         register_t msr;
 559
 560         td = curthread;
 561         critical_exit();
 562         msr = td->td_md.md_saved_msr;
 563         td->td_md.md_spinlock_count--;
 564         if (td->td_md.md_spinlock_count == 0)
 565                 intr_restore(msr);
 566 }
 567
 568 /* Shutdown the CPU as much as possible. */
 569 void
 570 cpu_halt(void)
 571 {
 572
 573         mtmsr(mfmsr() & ~(PSL_CE | PSL_EE | PSL_ME | PSL_DE));
 574         while (1)
 575                 ;
 576 }
 577
 578 int
 579 ptrace_set_pc(struct thread *td, unsigned long addr)
 580 {
 581         struct trapframe *tf;
 582
 583         tf = td->td_frame;
 584         tf->srr0 = (register_t)addr;
 585
 586         return (0);
 587 }
 588
 589 int
 590 ptrace_single_step(struct thread *td)
 591 {
 592         struct trapframe *tf;
 593
 594         tf = td->td_frame;
 595         tf->srr1 |= PSL_DE;
 596         tf->cpu.booke.dbcr0 |= (DBCR0_IDM | DBCR0_IC);
 597         return (0);
 598 }
 599
 600 int
 601 ptrace_clear_single_step(struct thread *td)
 602 {
 603         struct trapframe *tf;
 604
 605         tf = td->td_frame;
 606         tf->srr1 &= ~PSL_DE;
 607         tf->cpu.booke.dbcr0 &= ~(DBCR0_IDM | DBCR0_IC);
 608         return (0);
 609 }
 610
 611 void
 612 kdb_cpu_clear_singlestep(void)
 613 {
 614         register_t r;
 615
 616         r = mfspr(SPR_DBCR0);
 617         mtspr(SPR_DBCR0, r & ~DBCR0_IC);
 618         kdb_frame->srr1 &= ~PSL_DE;
 619 }
 620
 621 void
 622 kdb_cpu_set_singlestep(void)
 623 {
 624         register_t r;
 625
 626         r = mfspr(SPR_DBCR0);
 627         mtspr(SPR_DBCR0, r | DBCR0_IC | DBCR0_IDM);
 628         kdb_frame->srr1 |= PSL_DE;
 629 }
 630
 631 void
 632 bzero(void *buf, size_t len)
 633 {
 634         caddr_t p;
 635
 636         p = buf;
 637
 638         while (((vm_offset_t) p & (sizeof(u_long) - 1)) && len) {
 639                 *p++ = 0;
 640                 len--;
 641         }
 642
 643         while (len >= sizeof(u_long) * 8) {
 644                 *(u_long*) p = 0;
 645                 *((u_long*) p + 1) = 0;
 646                 *((u_long*) p + 2) = 0;
 647                 *((u_long*) p + 3) = 0;
 648                 len -= sizeof(u_long) * 8;
 649                 *((u_long*) p + 4) = 0;
 650                 *((u_long*) p + 5) = 0;
 651                 *((u_long*) p + 6) = 0;
 652                 *((u_long*) p + 7) = 0;
 653                 p += sizeof(u_long) * 8;
 654         }
 655
 656         while (len >= sizeof(u_long)) {
 657                 *(u_long*) p = 0;
 658                 len -= sizeof(u_long);
 659                 p += sizeof(u_long);
 660         }
 661
 662         while (len) {
 663                 *p++ = 0;
 664                 len--;
 665         }
 666 }
 667