mpc85xx.c (a1cd472a40949e25b119637c934b00ffe2ae4b5f) mpc85xx.c (8b79898eb7ab9a554bf14be3615e9d7688a2f242)
1/*-
2 * Copyright (C) 2008 Semihalf, Rafal Jaworowski
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

--- 19 unchanged lines hidden (view full) ---

28 */
29
30#include <sys/cdefs.h>
31__FBSDID("$FreeBSD$");
32
33#include <sys/param.h>
34#include <sys/systm.h>
35
1/*-
2 * Copyright (C) 2008 Semihalf, Rafal Jaworowski
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

--- 19 unchanged lines hidden (view full) ---

28 */
29
30#include <sys/cdefs.h>
31__FBSDID("$FreeBSD$");
32
33#include <sys/param.h>
34#include <sys/systm.h>
35
36#include <vm/vm.h>
37#include <vm/vm_param.h>
38
36#include <machine/cpu.h>
37#include <machine/cpufunc.h>
39#include <machine/cpu.h>
40#include <machine/cpufunc.h>
41#include <machine/pio.h>
38#include <machine/spr.h>
39
42#include <machine/spr.h>
43
44#include <powerpc/mpc85xx/ocpbus.h>
45
40/*
41 * MPC85xx system specific routines
42 */
43
44void
45cpu_reset()
46{
46/*
47 * MPC85xx system specific routines
48 */
49
50void
51cpu_reset()
52{
53 uint32_t svr = mfsvr();
47
54
48 /* Clear DBCR0, disables debug interrupts and events. */
49 mtspr(SPR_DBCR0, 0);
50 __asm volatile("isync");
55 if (svr == SVR_MPC8572E || svr == SVR_MPC8572)
56 /* Systems with dedicated reset register */
57 out32(OCP85XX_RSTCR, 2);
58 else {
59 /* Clear DBCR0, disables debug interrupts and events. */
60 mtspr(SPR_DBCR0, 0);
61 __asm volatile("isync");
51
62
52 /* Enable Debug Interrupts in MSR. */
53 mtmsr(mfmsr() | PSL_DE);
63 /* Enable Debug Interrupts in MSR. */
64 mtmsr(mfmsr() | PSL_DE);
54
65
55 /* Enable debug interrupts and issue reset. */
56 mtspr(SPR_DBCR0, mfspr(SPR_DBCR0) | DBCR0_IDM | DBCR0_RST_SYSTEM);
66 /* Enable debug interrupts and issue reset. */
67 mtspr(SPR_DBCR0, mfspr(SPR_DBCR0) | DBCR0_IDM | DBCR0_RST_SYSTEM);
68 }
69
57 printf("Reset failed...\n");
58 while (1);
59}
70 printf("Reset failed...\n");
71 while (1);
72}