linux/arch/arm/mach-iop13xx/setup.c
<<
>>
Prefs
   1/*
   2 * iop13xx platform Initialization
   3 * Copyright (c) 2005-2006, Intel Corporation.
   4 *
   5 * This program is free software; you can redistribute it and/or modify it
   6 * under the terms and conditions of the GNU General Public License,
   7 * version 2, as published by the Free Software Foundation.
   8 *
   9 * This program is distributed in the hope it will be useful, but WITHOUT
  10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12 * more details.
  13 *
  14 * You should have received a copy of the GNU General Public License along with
  15 * this program; if not, write to the Free Software Foundation, Inc., 59 Temple
  16 * Place - Suite 330, Boston, MA 02111-1307 USA.
  17 *
  18 */
  19
  20#include <linux/dma-mapping.h>
  21#include <linux/serial_8250.h>
  22#include <linux/io.h>
  23#ifdef CONFIG_MTD_PHYSMAP
  24#include <linux/mtd/physmap.h>
  25#endif
  26#include <asm/mach/map.h>
  27#include <mach/hardware.h>
  28#include <asm/irq.h>
  29#include <asm/hardware/iop_adma.h>
  30
  31#define IOP13XX_UART_XTAL 33334000
  32#define IOP13XX_SETUP_DEBUG 0
  33#define PRINTK(x...) ((void)(IOP13XX_SETUP_DEBUG && printk(x)))
  34
  35/* Standard IO mapping for all IOP13XX based systems
  36 */
  37static struct map_desc iop13xx_std_desc[] __initdata = {
  38        {    /* mem mapped registers */
  39                .virtual = IOP13XX_PMMR_VIRT_MEM_BASE,
  40                .pfn     = __phys_to_pfn(IOP13XX_PMMR_PHYS_MEM_BASE),
  41                .length  = IOP13XX_PMMR_SIZE,
  42                .type    = MT_DEVICE,
  43        }, { /* PCIE IO space */
  44                .virtual = IOP13XX_PCIE_LOWER_IO_VA,
  45                .pfn     = __phys_to_pfn(IOP13XX_PCIE_LOWER_IO_PA),
  46                .length  = IOP13XX_PCIX_IO_WINDOW_SIZE,
  47                .type    = MT_DEVICE,
  48        }, { /* PCIX IO space */
  49                .virtual = IOP13XX_PCIX_LOWER_IO_VA,
  50                .pfn     = __phys_to_pfn(IOP13XX_PCIX_LOWER_IO_PA),
  51                .length  = IOP13XX_PCIX_IO_WINDOW_SIZE,
  52                .type    = MT_DEVICE,
  53        },
  54};
  55
  56static struct resource iop13xx_uart0_resources[] = {
  57        [0] = {
  58                .start = IOP13XX_UART0_PHYS,
  59                .end = IOP13XX_UART0_PHYS + 0x3f,
  60                .flags = IORESOURCE_MEM,
  61        },
  62        [1] = {
  63                .start = IRQ_IOP13XX_UART0,
  64                .end = IRQ_IOP13XX_UART0,
  65                .flags = IORESOURCE_IRQ
  66        }
  67};
  68
  69static struct resource iop13xx_uart1_resources[] = {
  70        [0] = {
  71                .start = IOP13XX_UART1_PHYS,
  72                .end = IOP13XX_UART1_PHYS + 0x3f,
  73                .flags = IORESOURCE_MEM,
  74        },
  75        [1] = {
  76                .start = IRQ_IOP13XX_UART1,
  77                .end = IRQ_IOP13XX_UART1,
  78                .flags = IORESOURCE_IRQ
  79        }
  80};
  81
  82static struct plat_serial8250_port iop13xx_uart0_data[] = {
  83        {
  84       .membase     = (char*)(IOP13XX_UART0_VIRT),
  85       .mapbase     = (IOP13XX_UART0_PHYS),
  86       .irq         = IRQ_IOP13XX_UART0,
  87       .uartclk     = IOP13XX_UART_XTAL,
  88       .regshift    = 2,
  89       .iotype      = UPIO_MEM,
  90       .flags       = UPF_SKIP_TEST,
  91        },
  92        {  },
  93};
  94
  95static struct plat_serial8250_port iop13xx_uart1_data[] = {
  96        {
  97       .membase     = (char*)(IOP13XX_UART1_VIRT),
  98       .mapbase     = (IOP13XX_UART1_PHYS),
  99       .irq         = IRQ_IOP13XX_UART1,
 100       .uartclk     = IOP13XX_UART_XTAL,
 101       .regshift    = 2,
 102       .iotype      = UPIO_MEM,
 103       .flags       = UPF_SKIP_TEST,
 104        },
 105        {  },
 106};
 107
 108/* The ids are fixed up later in iop13xx_platform_init */
 109static struct platform_device iop13xx_uart0 = {
 110       .name = "serial8250",
 111       .id = 0,
 112       .dev.platform_data = iop13xx_uart0_data,
 113       .num_resources = 2,
 114       .resource = iop13xx_uart0_resources,
 115};
 116
 117static struct platform_device iop13xx_uart1 = {
 118       .name = "serial8250",
 119       .id = 0,
 120       .dev.platform_data = iop13xx_uart1_data,
 121       .num_resources = 2,
 122       .resource = iop13xx_uart1_resources
 123};
 124
 125static struct resource iop13xx_i2c_0_resources[] = {
 126        [0] = {
 127                .start = IOP13XX_I2C0_PHYS,
 128                .end = IOP13XX_I2C0_PHYS + 0x18,
 129                .flags = IORESOURCE_MEM,
 130        },
 131        [1] = {
 132                .start = IRQ_IOP13XX_I2C_0,
 133                .end = IRQ_IOP13XX_I2C_0,
 134                .flags = IORESOURCE_IRQ
 135        }
 136};
 137
 138static struct resource iop13xx_i2c_1_resources[] = {
 139        [0] = {
 140                .start = IOP13XX_I2C1_PHYS,
 141                .end = IOP13XX_I2C1_PHYS + 0x18,
 142                .flags = IORESOURCE_MEM,
 143        },
 144        [1] = {
 145                .start = IRQ_IOP13XX_I2C_1,
 146                .end = IRQ_IOP13XX_I2C_1,
 147                .flags = IORESOURCE_IRQ
 148        }
 149};
 150
 151static struct resource iop13xx_i2c_2_resources[] = {
 152        [0] = {
 153                .start = IOP13XX_I2C2_PHYS,
 154                .end = IOP13XX_I2C2_PHYS + 0x18,
 155                .flags = IORESOURCE_MEM,
 156        },
 157        [1] = {
 158                .start = IRQ_IOP13XX_I2C_2,
 159                .end = IRQ_IOP13XX_I2C_2,
 160                .flags = IORESOURCE_IRQ
 161        }
 162};
 163
 164/* I2C controllers. The IOP13XX uses the same block as the IOP3xx, so
 165 * we just use the same device name.
 166 */
 167
 168/* The ids are fixed up later in iop13xx_platform_init */
 169static struct platform_device iop13xx_i2c_0_controller = {
 170        .name = "IOP3xx-I2C",
 171        .id = 0,
 172        .num_resources = 2,
 173        .resource = iop13xx_i2c_0_resources
 174};
 175
 176static struct platform_device iop13xx_i2c_1_controller = {
 177        .name = "IOP3xx-I2C",
 178        .id = 0,
 179        .num_resources = 2,
 180        .resource = iop13xx_i2c_1_resources
 181};
 182
 183static struct platform_device iop13xx_i2c_2_controller = {
 184        .name = "IOP3xx-I2C",
 185        .id = 0,
 186        .num_resources = 2,
 187        .resource = iop13xx_i2c_2_resources
 188};
 189
 190#ifdef CONFIG_MTD_PHYSMAP
 191/* PBI Flash Device
 192 */
 193static struct physmap_flash_data iq8134x_flash_data = {
 194        .width = 2,
 195};
 196
 197static struct resource iq8134x_flash_resource = {
 198        .start = IQ81340_FLASHBASE,
 199        .end   = 0,
 200        .flags = IORESOURCE_MEM,
 201};
 202
 203static struct platform_device iq8134x_flash = {
 204        .name           = "physmap-flash",
 205        .id             = 0,
 206        .dev            = { .platform_data  = &iq8134x_flash_data, },
 207        .num_resources  = 1,
 208        .resource       = &iq8134x_flash_resource,
 209};
 210
 211static unsigned long iq8134x_probe_flash_size(void)
 212{
 213        uint8_t __iomem *flash_addr = ioremap(IQ81340_FLASHBASE, PAGE_SIZE);
 214        int i;
 215        char query[3];
 216        unsigned long size = 0;
 217        int width = iq8134x_flash_data.width;
 218
 219        if (flash_addr) {
 220                /* send CFI 'query' command */
 221                writew(0x98, flash_addr);
 222
 223                /* check for CFI compliance */
 224                for (i = 0; i < 3 * width; i += width)
 225                        query[i / width] = readb(flash_addr + (0x10 * width) + i);
 226
 227                /* read the size */
 228                if (memcmp(query, "QRY", 3) == 0)
 229                        size = 1 << readb(flash_addr + (0x27 * width));
 230
 231                /* send CFI 'read array' command */
 232                writew(0xff, flash_addr);
 233
 234                iounmap(flash_addr);
 235        }
 236
 237        return size;
 238}
 239#endif
 240
 241/* ADMA Channels */
 242static struct resource iop13xx_adma_0_resources[] = {
 243        [0] = {
 244                .start = IOP13XX_ADMA_PHYS_BASE(0),
 245                .end = IOP13XX_ADMA_UPPER_PA(0),
 246                .flags = IORESOURCE_MEM,
 247        },
 248        [1] = {
 249                .start = IRQ_IOP13XX_ADMA0_EOT,
 250                .end = IRQ_IOP13XX_ADMA0_EOT,
 251                .flags = IORESOURCE_IRQ
 252        },
 253        [2] = {
 254                .start = IRQ_IOP13XX_ADMA0_EOC,
 255                .end = IRQ_IOP13XX_ADMA0_EOC,
 256                .flags = IORESOURCE_IRQ
 257        },
 258        [3] = {
 259                .start = IRQ_IOP13XX_ADMA0_ERR,
 260                .end = IRQ_IOP13XX_ADMA0_ERR,
 261                .flags = IORESOURCE_IRQ
 262        }
 263};
 264
 265static struct resource iop13xx_adma_1_resources[] = {
 266        [0] = {
 267                .start = IOP13XX_ADMA_PHYS_BASE(1),
 268                .end = IOP13XX_ADMA_UPPER_PA(1),
 269                .flags = IORESOURCE_MEM,
 270        },
 271        [1] = {
 272                .start = IRQ_IOP13XX_ADMA1_EOT,
 273                .end = IRQ_IOP13XX_ADMA1_EOT,
 274                .flags = IORESOURCE_IRQ
 275        },
 276        [2] = {
 277                .start = IRQ_IOP13XX_ADMA1_EOC,
 278                .end = IRQ_IOP13XX_ADMA1_EOC,
 279                .flags = IORESOURCE_IRQ
 280        },
 281        [3] = {
 282                .start = IRQ_IOP13XX_ADMA1_ERR,
 283                .end = IRQ_IOP13XX_ADMA1_ERR,
 284                .flags = IORESOURCE_IRQ
 285        }
 286};
 287
 288static struct resource iop13xx_adma_2_resources[] = {
 289        [0] = {
 290                .start = IOP13XX_ADMA_PHYS_BASE(2),
 291                .end = IOP13XX_ADMA_UPPER_PA(2),
 292                .flags = IORESOURCE_MEM,
 293        },
 294        [1] = {
 295                .start = IRQ_IOP13XX_ADMA2_EOT,
 296                .end = IRQ_IOP13XX_ADMA2_EOT,
 297                .flags = IORESOURCE_IRQ
 298        },
 299        [2] = {
 300                .start = IRQ_IOP13XX_ADMA2_EOC,
 301                .end = IRQ_IOP13XX_ADMA2_EOC,
 302                .flags = IORESOURCE_IRQ
 303        },
 304        [3] = {
 305                .start = IRQ_IOP13XX_ADMA2_ERR,
 306                .end = IRQ_IOP13XX_ADMA2_ERR,
 307                .flags = IORESOURCE_IRQ
 308        }
 309};
 310
 311static u64 iop13xx_adma_dmamask = DMA_BIT_MASK(64);
 312static struct iop_adma_platform_data iop13xx_adma_0_data = {
 313        .hw_id = 0,
 314        .pool_size = PAGE_SIZE,
 315};
 316
 317static struct iop_adma_platform_data iop13xx_adma_1_data = {
 318        .hw_id = 1,
 319        .pool_size = PAGE_SIZE,
 320};
 321
 322static struct iop_adma_platform_data iop13xx_adma_2_data = {
 323        .hw_id = 2,
 324        .pool_size = PAGE_SIZE,
 325};
 326
 327/* The ids are fixed up later in iop13xx_platform_init */
 328static struct platform_device iop13xx_adma_0_channel = {
 329        .name = "iop-adma",
 330        .id = 0,
 331        .num_resources = 4,
 332        .resource = iop13xx_adma_0_resources,
 333        .dev = {
 334                .dma_mask = &iop13xx_adma_dmamask,
 335                .coherent_dma_mask = DMA_BIT_MASK(64),
 336                .platform_data = (void *) &iop13xx_adma_0_data,
 337        },
 338};
 339
 340static struct platform_device iop13xx_adma_1_channel = {
 341        .name = "iop-adma",
 342        .id = 0,
 343        .num_resources = 4,
 344        .resource = iop13xx_adma_1_resources,
 345        .dev = {
 346                .dma_mask = &iop13xx_adma_dmamask,
 347                .coherent_dma_mask = DMA_BIT_MASK(64),
 348                .platform_data = (void *) &iop13xx_adma_1_data,
 349        },
 350};
 351
 352static struct platform_device iop13xx_adma_2_channel = {
 353        .name = "iop-adma",
 354        .id = 0,
 355        .num_resources = 4,
 356        .resource = iop13xx_adma_2_resources,
 357        .dev = {
 358                .dma_mask = &iop13xx_adma_dmamask,
 359                .coherent_dma_mask = DMA_BIT_MASK(64),
 360                .platform_data = (void *) &iop13xx_adma_2_data,
 361        },
 362};
 363
 364void __init iop13xx_map_io(void)
 365{
 366        /* Initialize the Static Page Table maps */
 367        iotable_init(iop13xx_std_desc, ARRAY_SIZE(iop13xx_std_desc));
 368}
 369
 370static int init_uart;
 371static int init_i2c;
 372static int init_adma;
 373
 374void __init iop13xx_platform_init(void)
 375{
 376        int i;
 377        u32 uart_idx, i2c_idx, adma_idx, plat_idx;
 378        struct platform_device *iop13xx_devices[IQ81340_MAX_PLAT_DEVICES];
 379
 380        /* set the bases so we can read the device id */
 381        iop13xx_set_atu_mmr_bases();
 382
 383        memset(iop13xx_devices, 0, sizeof(iop13xx_devices));
 384
 385        if (init_uart == IOP13XX_INIT_UART_DEFAULT) {
 386                switch (iop13xx_dev_id()) {
 387                /* enable both uarts on iop341 */
 388                case 0x3380:
 389                case 0x3384:
 390                case 0x3388:
 391                case 0x338c:
 392                        init_uart |= IOP13XX_INIT_UART_0;
 393                        init_uart |= IOP13XX_INIT_UART_1;
 394                        break;
 395                /* only enable uart 1 */
 396                default:
 397                        init_uart |= IOP13XX_INIT_UART_1;
 398                }
 399        }
 400
 401        if (init_i2c == IOP13XX_INIT_I2C_DEFAULT) {
 402                switch (iop13xx_dev_id()) {
 403                /* enable all i2c units on iop341 and iop342 */
 404                case 0x3380:
 405                case 0x3384:
 406                case 0x3388:
 407                case 0x338c:
 408                case 0x3382:
 409                case 0x3386:
 410                case 0x338a:
 411                case 0x338e:
 412                        init_i2c |= IOP13XX_INIT_I2C_0;
 413                        init_i2c |= IOP13XX_INIT_I2C_1;
 414                        init_i2c |= IOP13XX_INIT_I2C_2;
 415                        break;
 416                /* only enable i2c 1 and 2 */
 417                default:
 418                        init_i2c |= IOP13XX_INIT_I2C_1;
 419                        init_i2c |= IOP13XX_INIT_I2C_2;
 420                }
 421        }
 422
 423        if (init_adma == IOP13XX_INIT_ADMA_DEFAULT) {
 424                init_adma |= IOP13XX_INIT_ADMA_0;
 425                init_adma |= IOP13XX_INIT_ADMA_1;
 426                init_adma |= IOP13XX_INIT_ADMA_2;
 427        }
 428
 429        plat_idx = 0;
 430        uart_idx = 0;
 431        i2c_idx = 0;
 432
 433        /* uart 1 (if enabled) is ttyS0 */
 434        if (init_uart & IOP13XX_INIT_UART_1) {
 435                PRINTK("Adding uart1 to platform device list\n");
 436                iop13xx_uart1.id = uart_idx++;
 437                iop13xx_devices[plat_idx++] = &iop13xx_uart1;
 438        }
 439        if (init_uart & IOP13XX_INIT_UART_0) {
 440                PRINTK("Adding uart0 to platform device list\n");
 441                iop13xx_uart0.id = uart_idx++;
 442                iop13xx_devices[plat_idx++] = &iop13xx_uart0;
 443        }
 444
 445        for(i = 0; i < IQ81340_NUM_I2C; i++) {
 446                if ((init_i2c & (1 << i)) && IOP13XX_SETUP_DEBUG)
 447                        printk("Adding i2c%d to platform device list\n", i);
 448                switch(init_i2c & (1 << i)) {
 449                case IOP13XX_INIT_I2C_0:
 450                        iop13xx_i2c_0_controller.id = i2c_idx++;
 451                        iop13xx_devices[plat_idx++] =
 452                                &iop13xx_i2c_0_controller;
 453                        break;
 454                case IOP13XX_INIT_I2C_1:
 455                        iop13xx_i2c_1_controller.id = i2c_idx++;
 456                        iop13xx_devices[plat_idx++] =
 457                                &iop13xx_i2c_1_controller;
 458                        break;
 459                case IOP13XX_INIT_I2C_2:
 460                        iop13xx_i2c_2_controller.id = i2c_idx++;
 461                        iop13xx_devices[plat_idx++] =
 462                                &iop13xx_i2c_2_controller;
 463                        break;
 464                }
 465        }
 466
 467        /* initialize adma channel ids and capabilities */
 468        adma_idx = 0;
 469        for (i = 0; i < IQ81340_NUM_ADMA; i++) {
 470                struct iop_adma_platform_data *plat_data;
 471                if ((init_adma & (1 << i)) && IOP13XX_SETUP_DEBUG)
 472                        printk(KERN_INFO
 473                                "Adding adma%d to platform device list\n", i);
 474                switch (init_adma & (1 << i)) {
 475                case IOP13XX_INIT_ADMA_0:
 476                        iop13xx_adma_0_channel.id = adma_idx++;
 477                        iop13xx_devices[plat_idx++] = &iop13xx_adma_0_channel;
 478                        plat_data = &iop13xx_adma_0_data;
 479                        dma_cap_set(DMA_MEMCPY, plat_data->cap_mask);
 480                        dma_cap_set(DMA_XOR, plat_data->cap_mask);
 481                        dma_cap_set(DMA_XOR_VAL, plat_data->cap_mask);
 482                        dma_cap_set(DMA_MEMSET, plat_data->cap_mask);
 483                        dma_cap_set(DMA_INTERRUPT, plat_data->cap_mask);
 484                        break;
 485                case IOP13XX_INIT_ADMA_1:
 486                        iop13xx_adma_1_channel.id = adma_idx++;
 487                        iop13xx_devices[plat_idx++] = &iop13xx_adma_1_channel;
 488                        plat_data = &iop13xx_adma_1_data;
 489                        dma_cap_set(DMA_MEMCPY, plat_data->cap_mask);
 490                        dma_cap_set(DMA_XOR, plat_data->cap_mask);
 491                        dma_cap_set(DMA_XOR_VAL, plat_data->cap_mask);
 492                        dma_cap_set(DMA_MEMSET, plat_data->cap_mask);
 493                        dma_cap_set(DMA_INTERRUPT, plat_data->cap_mask);
 494                        break;
 495                case IOP13XX_INIT_ADMA_2:
 496                        iop13xx_adma_2_channel.id = adma_idx++;
 497                        iop13xx_devices[plat_idx++] = &iop13xx_adma_2_channel;
 498                        plat_data = &iop13xx_adma_2_data;
 499                        dma_cap_set(DMA_MEMCPY, plat_data->cap_mask);
 500                        dma_cap_set(DMA_XOR, plat_data->cap_mask);
 501                        dma_cap_set(DMA_XOR_VAL, plat_data->cap_mask);
 502                        dma_cap_set(DMA_MEMSET, plat_data->cap_mask);
 503                        dma_cap_set(DMA_INTERRUPT, plat_data->cap_mask);
 504                        dma_cap_set(DMA_PQ, plat_data->cap_mask);
 505                        dma_cap_set(DMA_PQ_VAL, plat_data->cap_mask);
 506                        break;
 507                }
 508        }
 509
 510#ifdef CONFIG_MTD_PHYSMAP
 511        iq8134x_flash_resource.end = iq8134x_flash_resource.start +
 512                                iq8134x_probe_flash_size() - 1;
 513        if (iq8134x_flash_resource.end > iq8134x_flash_resource.start)
 514                iop13xx_devices[plat_idx++] = &iq8134x_flash;
 515        else
 516                printk(KERN_ERR "%s: Failed to probe flash size\n", __func__);
 517#endif
 518
 519        platform_add_devices(iop13xx_devices, plat_idx);
 520}
 521
 522static int __init iop13xx_init_uart_setup(char *str)
 523{
 524        if (str) {
 525                while (*str != '\0') {
 526                        switch(*str) {
 527                        case '0':
 528                                init_uart |= IOP13XX_INIT_UART_0;
 529                                break;
 530                        case '1':
 531                                init_uart |= IOP13XX_INIT_UART_1;
 532                                break;
 533                        case ',':
 534                        case '=':
 535                                break;
 536                        default:
 537                                PRINTK("\"iop13xx_init_uart\" malformed"
 538                                            " at character: \'%c\'", *str);
 539                                *(str + 1) = '\0';
 540                                init_uart = IOP13XX_INIT_UART_DEFAULT;
 541                        }
 542                        str++;
 543                }
 544        }
 545        return 1;
 546}
 547
 548static int __init iop13xx_init_i2c_setup(char *str)
 549{
 550        if (str) {
 551                while (*str != '\0') {
 552                        switch(*str) {
 553                        case '0':
 554                                init_i2c |= IOP13XX_INIT_I2C_0;
 555                                break;
 556                        case '1':
 557                                init_i2c |= IOP13XX_INIT_I2C_1;
 558                                break;
 559                        case '2':
 560                                init_i2c |= IOP13XX_INIT_I2C_2;
 561                                break;
 562                        case ',':
 563                        case '=':
 564                                break;
 565                        default:
 566                                PRINTK("\"iop13xx_init_i2c\" malformed"
 567                                            " at character: \'%c\'", *str);
 568                                *(str + 1) = '\0';
 569                                init_i2c = IOP13XX_INIT_I2C_DEFAULT;
 570                        }
 571                        str++;
 572                }
 573        }
 574        return 1;
 575}
 576
 577static int __init iop13xx_init_adma_setup(char *str)
 578{
 579        if (str)        {
 580                while (*str != '\0') {
 581                        switch (*str) {
 582                        case '0':
 583                                init_adma |= IOP13XX_INIT_ADMA_0;
 584                                break;
 585                        case '1':
 586                                init_adma |= IOP13XX_INIT_ADMA_1;
 587                                break;
 588                        case '2':
 589                                init_adma |= IOP13XX_INIT_ADMA_2;
 590                                break;
 591                        case ',':
 592                        case '=':
 593                                break;
 594                        default:
 595                                PRINTK("\"iop13xx_init_adma\" malformed"
 596                                            " at character: \'%c\'", *str);
 597                                *(str + 1) = '\0';
 598                                init_adma = IOP13XX_INIT_ADMA_DEFAULT;
 599                        }
 600                        str++;
 601                }
 602        }
 603        return 1;
 604}
 605
 606__setup("iop13xx_init_adma", iop13xx_init_adma_setup);
 607__setup("iop13xx_init_uart", iop13xx_init_uart_setup);
 608__setup("iop13xx_init_i2c", iop13xx_init_i2c_setup);
 609
 610void iop13xx_restart(char mode, const char *cmd)
 611{
 612        /*
 613         * Reset the internal bus (warning both cores are reset)
 614         */
 615        write_wdtcr(IOP_WDTCR_EN_ARM);
 616        write_wdtcr(IOP_WDTCR_EN);
 617        write_wdtsr(IOP13XX_WDTSR_WRITE_EN | IOP13XX_WDTCR_IB_RESET);
 618        write_wdtcr(0x1000);
 619}
 620