Pileus Git - ~andy/linux/blob - arch/arm/mach-orion5x/ts78xx-setup.c

   1 /*
   2  * arch/arm/mach-orion5x/ts78xx-setup.c
   3  *
   4  * Maintainer: Alexander Clouter <alex@digriz.org.uk>
   5  *
   6  * This file is licensed under the terms of the GNU General Public
   7  * License version 2.  This program is licensed "as is" without any
   8  * warranty of any kind, whether express or implied.
   9  */
  10
  11 #include <linux/kernel.h>
  12 #include <linux/init.h>
  13 #include <linux/sysfs.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/mv643xx_eth.h>
  16 #include <linux/ata_platform.h>
  17 #include <linux/m48t86.h>
  18 #include <linux/mtd/nand.h>
  19 #include <linux/mtd/partitions.h>
  20 #include <linux/timeriomem-rng.h>
  21 #include <asm/mach-types.h>
  22 #include <asm/mach/arch.h>
  23 #include <asm/mach/map.h>
  24 #include <mach/orion5x.h>
  25 #include "common.h"
  26 #include "mpp.h"
  27 #include "ts78xx-fpga.h"
  28
  29 /*****************************************************************************
  30  * TS-78xx Info
  31  ****************************************************************************/
  32
  33 /*
  34  * FPGA - lives where the PCI bus would be at ORION5X_PCI_MEM_PHYS_BASE
  35  */
  36 #define TS78XX_FPGA_REGS_PHYS_BASE      0xe8000000
  37 #define TS78XX_FPGA_REGS_VIRT_BASE      0xff900000
  38 #define TS78XX_FPGA_REGS_SIZE           SZ_1M
  39
  40 static struct ts78xx_fpga_data ts78xx_fpga = {
  41         .id             = 0,
  42         .state          = 1,
  43 /*      .supports       = ... - populated by ts78xx_fpga_supports() */
  44 };
  45
  46 /*****************************************************************************
  47  * I/O Address Mapping
  48  ****************************************************************************/
  49 static struct map_desc ts78xx_io_desc[] __initdata = {
  50         {
  51                 .virtual        = TS78XX_FPGA_REGS_VIRT_BASE,
  52                 .pfn            = __phys_to_pfn(TS78XX_FPGA_REGS_PHYS_BASE),
  53                 .length         = TS78XX_FPGA_REGS_SIZE,
  54                 .type           = MT_DEVICE,
  55         },
  56 };
  57
  58 void __init ts78xx_map_io(void)
  59 {
  60         orion5x_map_io();
  61         iotable_init(ts78xx_io_desc, ARRAY_SIZE(ts78xx_io_desc));
  62 }
  63
  64 /*****************************************************************************
  65  * Ethernet
  66  ****************************************************************************/
  67 static struct mv643xx_eth_platform_data ts78xx_eth_data = {
  68         .phy_addr       = MV643XX_ETH_PHY_ADDR(0),
  69 };
  70
  71 /*****************************************************************************
  72  * SATA
  73  ****************************************************************************/
  74 static struct mv_sata_platform_data ts78xx_sata_data = {
  75         .n_ports        = 2,
  76 };
  77
  78 /*****************************************************************************
  79  * RTC M48T86 - nicked^Wborrowed from arch/arm/mach-ep93xx/ts72xx.c
  80  ****************************************************************************/
  81 #define TS_RTC_CTRL     (TS78XX_FPGA_REGS_VIRT_BASE | 0x808)
  82 #define TS_RTC_DATA     (TS78XX_FPGA_REGS_VIRT_BASE | 0x80c)
  83
  84 static unsigned char ts78xx_ts_rtc_readbyte(unsigned long addr)
  85 {
  86         writeb(addr, TS_RTC_CTRL);
  87         return readb(TS_RTC_DATA);
  88 }
  89
  90 static void ts78xx_ts_rtc_writebyte(unsigned char value, unsigned long addr)
  91 {
  92         writeb(addr, TS_RTC_CTRL);
  93         writeb(value, TS_RTC_DATA);
  94 }
  95
  96 static struct m48t86_ops ts78xx_ts_rtc_ops = {
  97         .readbyte       = ts78xx_ts_rtc_readbyte,
  98         .writebyte      = ts78xx_ts_rtc_writebyte,
  99 };
 100
 101 static struct platform_device ts78xx_ts_rtc_device = {
 102         .name           = "rtc-m48t86",
 103         .id             = -1,
 104         .dev            = {
 105                 .platform_data  = &ts78xx_ts_rtc_ops,
 106         },
 107         .num_resources  = 0,
 108 };
 109
 110 /*
 111  * TS uses some of the user storage space on the RTC chip so see if it is
 112  * present; as it's an optional feature at purchase time and not all boards
 113  * will have it present
 114  *
 115  * I've used the method TS use in their rtc7800.c example for the detection
 116  *
 117  * TODO: track down a guinea pig without an RTC to see if we can work out a
 118  *              better RTC detection routine
 119  */
 120 static int ts78xx_ts_rtc_load(void)
 121 {
 122         int rc;
 123         unsigned char tmp_rtc0, tmp_rtc1;
 124
 125         tmp_rtc0 = ts78xx_ts_rtc_readbyte(126);
 126         tmp_rtc1 = ts78xx_ts_rtc_readbyte(127);
 127
 128         ts78xx_ts_rtc_writebyte(0x00, 126);
 129         ts78xx_ts_rtc_writebyte(0x55, 127);
 130         if (ts78xx_ts_rtc_readbyte(127) == 0x55) {
 131                 ts78xx_ts_rtc_writebyte(0xaa, 127);
 132                 if (ts78xx_ts_rtc_readbyte(127) == 0xaa
 133                                 && ts78xx_ts_rtc_readbyte(126) == 0x00) {
 134                         ts78xx_ts_rtc_writebyte(tmp_rtc0, 126);
 135                         ts78xx_ts_rtc_writebyte(tmp_rtc1, 127);
 136
 137                         if (ts78xx_fpga.supports.ts_rtc.init == 0) {
 138                                 rc = platform_device_register(&ts78xx_ts_rtc_device);
 139                                 if (!rc)
 140                                         ts78xx_fpga.supports.ts_rtc.init = 1;
 141                         } else
 142                                 rc = platform_device_add(&ts78xx_ts_rtc_device);
 143
 144                         return rc;
 145                 }
 146         }
 147
 148         return -ENODEV;
 149 };
 150
 151 static void ts78xx_ts_rtc_unload(void)
 152 {
 153         platform_device_del(&ts78xx_ts_rtc_device);
 154 }
 155
 156 /*****************************************************************************
 157  * NAND Flash
 158  ****************************************************************************/
 159 #define TS_NAND_CTRL    (TS78XX_FPGA_REGS_VIRT_BASE | 0x800)    /* VIRT */
 160 #define TS_NAND_DATA    (TS78XX_FPGA_REGS_PHYS_BASE | 0x804)    /* PHYS */
 161
 162 /*
 163  * hardware specific access to control-lines
 164  *
 165  * ctrl:
 166  * NAND_NCE: bit 0 -> bit 2
 167  * NAND_CLE: bit 1 -> bit 1
 168  * NAND_ALE: bit 2 -> bit 0
 169  */
 170 static void ts78xx_ts_nand_cmd_ctrl(struct mtd_info *mtd, int cmd,
 171                         unsigned int ctrl)
 172 {
 173         struct nand_chip *this = mtd->priv;
 174
 175         if (ctrl & NAND_CTRL_CHANGE) {
 176                 unsigned char bits;
 177
 178                 bits = (ctrl & NAND_NCE) << 2;
 179                 bits |= ctrl & NAND_CLE;
 180                 bits |= (ctrl & NAND_ALE) >> 2;
 181
 182                 writeb((readb(TS_NAND_CTRL) & ~0x7) | bits, TS_NAND_CTRL);
 183         }
 184
 185         if (cmd != NAND_CMD_NONE)
 186                 writeb(cmd, this->IO_ADDR_W);
 187 }
 188
 189 static int ts78xx_ts_nand_dev_ready(struct mtd_info *mtd)
 190 {
 191         return readb(TS_NAND_CTRL) & 0x20;
 192 }
 193
 194 static void ts78xx_ts_nand_write_buf(struct mtd_info *mtd,
 195                         const uint8_t *buf, int len)
 196 {
 197         struct nand_chip *chip = mtd->priv;
 198         void __iomem *io_base = chip->IO_ADDR_W;
 199         unsigned long off = ((unsigned long)buf & 3);
 200         int sz;
 201
 202         if (off) {
 203                 sz = min_t(int, 4 - off, len);
 204                 writesb(io_base, buf, sz);
 205                 buf += sz;
 206                 len -= sz;
 207         }
 208
 209         sz = len >> 2;
 210         if (sz) {
 211                 u32 *buf32 = (u32 *)buf;
 212                 writesl(io_base, buf32, sz);
 213                 buf += sz << 2;
 214                 len -= sz << 2;
 215         }
 216
 217         if (len)
 218                 writesb(io_base, buf, len);
 219 }
 220
 221 static void ts78xx_ts_nand_read_buf(struct mtd_info *mtd,
 222                         uint8_t *buf, int len)
 223 {
 224         struct nand_chip *chip = mtd->priv;
 225         void __iomem *io_base = chip->IO_ADDR_R;
 226         unsigned long off = ((unsigned long)buf & 3);
 227         int sz;
 228
 229         if (off) {
 230                 sz = min_t(int, 4 - off, len);
 231                 readsb(io_base, buf, sz);
 232                 buf += sz;
 233                 len -= sz;
 234         }
 235
 236         sz = len >> 2;
 237         if (sz) {
 238                 u32 *buf32 = (u32 *)buf;
 239                 readsl(io_base, buf32, sz);
 240                 buf += sz << 2;
 241                 len -= sz << 2;
 242         }
 243
 244         if (len)
 245                 readsb(io_base, buf, len);
 246 }
 247
 248 const char *ts_nand_part_probes[] = { "cmdlinepart", NULL };
 249
 250 static struct mtd_partition ts78xx_ts_nand_parts[] = {
 251         {
 252                 .name           = "mbr",
 253                 .offset         = 0,
 254                 .size           = SZ_128K,
 255                 .mask_flags     = MTD_WRITEABLE,
 256         }, {
 257                 .name           = "kernel",
 258                 .offset         = MTDPART_OFS_APPEND,
 259                 .size           = SZ_4M,
 260         }, {
 261                 .name           = "initrd",
 262                 .offset         = MTDPART_OFS_APPEND,
 263                 .size           = SZ_4M,
 264         }, {
 265                 .name           = "rootfs",
 266                 .offset         = MTDPART_OFS_APPEND,
 267                 .size           = MTDPART_SIZ_FULL,
 268         }
 269 };
 270
 271 static struct platform_nand_data ts78xx_ts_nand_data = {
 272         .chip   = {
 273                 .nr_chips               = 1,
 274                 .part_probe_types       = ts_nand_part_probes,
 275                 .partitions             = ts78xx_ts_nand_parts,
 276                 .nr_partitions          = ARRAY_SIZE(ts78xx_ts_nand_parts),
 277                 .chip_delay             = 15,
 278                 .bbt_options            = NAND_BBT_USE_FLASH,
 279         },
 280         .ctrl   = {
 281                 /*
 282                  * The HW ECC offloading functions, used to give about a 9%
 283                  * performance increase for 'dd if=/dev/mtdblockX' and 5% for
 284                  * nanddump.  This all however was changed by git commit
 285                  * e6cf5df1838c28bb060ac45b5585e48e71bbc740 so now there is
 286                  * no performance advantage to be had so we no longer bother
 287                  */
 288                 .cmd_ctrl               = ts78xx_ts_nand_cmd_ctrl,
 289                 .dev_ready              = ts78xx_ts_nand_dev_ready,
 290                 .write_buf              = ts78xx_ts_nand_write_buf,
 291                 .read_buf               = ts78xx_ts_nand_read_buf,
 292         },
 293 };
 294
 295 static struct resource ts78xx_ts_nand_resources
 296                         = DEFINE_RES_MEM(TS_NAND_DATA, 4);
 297
 298 static struct platform_device ts78xx_ts_nand_device = {
 299         .name           = "gen_nand",
 300         .id             = -1,
 301         .dev            = {
 302                 .platform_data  = &ts78xx_ts_nand_data,
 303         },
 304         .resource       = &ts78xx_ts_nand_resources,
 305         .num_resources  = 1,
 306 };
 307
 308 static int ts78xx_ts_nand_load(void)
 309 {
 310         int rc;
 311
 312         if (ts78xx_fpga.supports.ts_nand.init == 0) {
 313                 rc = platform_device_register(&ts78xx_ts_nand_device);
 314                 if (!rc)
 315                         ts78xx_fpga.supports.ts_nand.init = 1;
 316         } else
 317                 rc = platform_device_add(&ts78xx_ts_nand_device);
 318
 319         return rc;
 320 };
 321
 322 static void ts78xx_ts_nand_unload(void)
 323 {
 324         platform_device_del(&ts78xx_ts_nand_device);
 325 }
 326
 327 /*****************************************************************************
 328  * HW RNG
 329  ****************************************************************************/
 330 #define TS_RNG_DATA     (TS78XX_FPGA_REGS_PHYS_BASE | 0x044)
 331
 332 static struct resource ts78xx_ts_rng_resource
 333                         = DEFINE_RES_MEM(TS_RNG_DATA, 4);
 334
 335 static struct timeriomem_rng_data ts78xx_ts_rng_data = {
 336         .period         = 1000000, /* one second */
 337 };
 338
 339 static struct platform_device ts78xx_ts_rng_device = {
 340         .name           = "timeriomem_rng",
 341         .id             = -1,
 342         .dev            = {
 343                 .platform_data  = &ts78xx_ts_rng_data,
 344         },
 345         .resource       = &ts78xx_ts_rng_resource,
 346         .num_resources  = 1,
 347 };
 348
 349 static int ts78xx_ts_rng_load(void)
 350 {
 351         int rc;
 352
 353         if (ts78xx_fpga.supports.ts_rng.init == 0) {
 354                 rc = platform_device_register(&ts78xx_ts_rng_device);
 355                 if (!rc)
 356                         ts78xx_fpga.supports.ts_rng.init = 1;
 357         } else
 358                 rc = platform_device_add(&ts78xx_ts_rng_device);
 359
 360         return rc;
 361 };
 362
 363 static void ts78xx_ts_rng_unload(void)
 364 {
 365         platform_device_del(&ts78xx_ts_rng_device);
 366 }
 367
 368 /*****************************************************************************
 369  * FPGA 'hotplug' support code
 370  ****************************************************************************/
 371 static void ts78xx_fpga_devices_zero_init(void)
 372 {
 373         ts78xx_fpga.supports.ts_rtc.init = 0;
 374         ts78xx_fpga.supports.ts_nand.init = 0;
 375         ts78xx_fpga.supports.ts_rng.init = 0;
 376 }
 377
 378 static void ts78xx_fpga_supports(void)
 379 {
 380         /* TODO: put this 'table' into ts78xx-fpga.h */
 381         switch (ts78xx_fpga.id) {
 382         case TS7800_REV_1:
 383         case TS7800_REV_2:
 384         case TS7800_REV_3:
 385         case TS7800_REV_4:
 386         case TS7800_REV_5:
 387         case TS7800_REV_6:
 388         case TS7800_REV_7:
 389         case TS7800_REV_8:
 390         case TS7800_REV_9:
 391                 ts78xx_fpga.supports.ts_rtc.present = 1;
 392                 ts78xx_fpga.supports.ts_nand.present = 1;
 393                 ts78xx_fpga.supports.ts_rng.present = 1;
 394                 break;
 395         default:
 396                 /* enable devices if magic matches */
 397                 switch ((ts78xx_fpga.id >> 8) & 0xffffff) {
 398                 case TS7800_FPGA_MAGIC:
 399                         pr_warning("TS-7800 FPGA: unrecognized revision 0x%.2x\n",
 400                                         ts78xx_fpga.id & 0xff);
 401                         ts78xx_fpga.supports.ts_rtc.present = 1;
 402                         ts78xx_fpga.supports.ts_nand.present = 1;
 403                         ts78xx_fpga.supports.ts_rng.present = 1;
 404                         break;
 405                 default:
 406                         ts78xx_fpga.supports.ts_rtc.present = 0;
 407                         ts78xx_fpga.supports.ts_nand.present = 0;
 408                         ts78xx_fpga.supports.ts_rng.present = 0;
 409                 }
 410         }
 411 }
 412
 413 static int ts78xx_fpga_load_devices(void)
 414 {
 415         int tmp, ret = 0;
 416
 417         if (ts78xx_fpga.supports.ts_rtc.present == 1) {
 418                 tmp = ts78xx_ts_rtc_load();
 419                 if (tmp) {
 420                         pr_info("TS-78xx: RTC not registered\n");
 421                         ts78xx_fpga.supports.ts_rtc.present = 0;
 422                 }
 423                 ret |= tmp;
 424         }
 425         if (ts78xx_fpga.supports.ts_nand.present == 1) {
 426                 tmp = ts78xx_ts_nand_load();
 427                 if (tmp) {
 428                         pr_info("TS-78xx: NAND not registered\n");
 429                         ts78xx_fpga.supports.ts_nand.present = 0;
 430                 }
 431                 ret |= tmp;
 432         }
 433         if (ts78xx_fpga.supports.ts_rng.present == 1) {
 434                 tmp = ts78xx_ts_rng_load();
 435                 if (tmp) {
 436                         pr_info("TS-78xx: RNG not registered\n");
 437                         ts78xx_fpga.supports.ts_rng.present = 0;
 438                 }
 439                 ret |= tmp;
 440         }
 441
 442         return ret;
 443 }
 444
 445 static int ts78xx_fpga_unload_devices(void)
 446 {
 447         int ret = 0;
 448
 449         if (ts78xx_fpga.supports.ts_rtc.present == 1)
 450                 ts78xx_ts_rtc_unload();
 451         if (ts78xx_fpga.supports.ts_nand.present == 1)
 452                 ts78xx_ts_nand_unload();
 453         if (ts78xx_fpga.supports.ts_rng.present == 1)
 454                 ts78xx_ts_rng_unload();
 455
 456         return ret;
 457 }
 458
 459 static int ts78xx_fpga_load(void)
 460 {
 461         ts78xx_fpga.id = readl(TS78XX_FPGA_REGS_VIRT_BASE);
 462
 463         pr_info("TS-78xx FPGA: magic=0x%.6x, rev=0x%.2x\n",
 464                         (ts78xx_fpga.id >> 8) & 0xffffff,
 465                         ts78xx_fpga.id & 0xff);
 466
 467         ts78xx_fpga_supports();
 468
 469         if (ts78xx_fpga_load_devices()) {
 470                 ts78xx_fpga.state = -1;
 471                 return -EBUSY;
 472         }
 473
 474         return 0;
 475 };
 476
 477 static int ts78xx_fpga_unload(void)
 478 {
 479         unsigned int fpga_id;
 480
 481         fpga_id = readl(TS78XX_FPGA_REGS_VIRT_BASE);
 482
 483         /*
 484          * There does not seem to be a feasible way to block access to the GPIO
 485          * pins from userspace (/dev/mem).  This if clause should hopefully warn
 486          * those foolish enough not to follow 'policy' :)
 487          *
 488          * UrJTAG SVN since r1381 can be used to reprogram the FPGA
 489          */
 490         if (ts78xx_fpga.id != fpga_id) {
 491                 pr_err("TS-78xx FPGA: magic/rev mismatch\n"
 492                         "TS-78xx FPGA: was 0x%.6x/%.2x but now 0x%.6x/%.2x\n",
 493                         (ts78xx_fpga.id >> 8) & 0xffffff, ts78xx_fpga.id & 0xff,
 494                         (fpga_id >> 8) & 0xffffff, fpga_id & 0xff);
 495                 ts78xx_fpga.state = -1;
 496                 return -EBUSY;
 497         }
 498
 499         if (ts78xx_fpga_unload_devices()) {
 500                 ts78xx_fpga.state = -1;
 501                 return -EBUSY;
 502         }
 503
 504         return 0;
 505 };
 506
 507 static ssize_t ts78xx_fpga_show(struct kobject *kobj,
 508                         struct kobj_attribute *attr, char *buf)
 509 {
 510         if (ts78xx_fpga.state < 0)
 511                 return sprintf(buf, "borked\n");
 512
 513         return sprintf(buf, "%s\n", (ts78xx_fpga.state) ? "online" : "offline");
 514 }
 515
 516 static ssize_t ts78xx_fpga_store(struct kobject *kobj,
 517                         struct kobj_attribute *attr, const char *buf, size_t n)
 518 {
 519         int value, ret;
 520
 521         if (ts78xx_fpga.state < 0) {
 522                 pr_err("TS-78xx FPGA: borked, you must powercycle asap\n");
 523                 return -EBUSY;
 524         }
 525
 526         if (strncmp(buf, "online", sizeof("online") - 1) == 0)
 527                 value = 1;
 528         else if (strncmp(buf, "offline", sizeof("offline") - 1) == 0)
 529                 value = 0;
 530         else {
 531                 pr_err("ts78xx_fpga_store: Invalid value\n");
 532                 return -EINVAL;
 533         }
 534
 535         if (ts78xx_fpga.state == value)
 536                 return n;
 537
 538         ret = (ts78xx_fpga.state == 0)
 539                 ? ts78xx_fpga_load()
 540                 : ts78xx_fpga_unload();
 541
 542         if (!(ret < 0))
 543                 ts78xx_fpga.state = value;
 544
 545         return n;
 546 }
 547
 548 static struct kobj_attribute ts78xx_fpga_attr =
 549         __ATTR(ts78xx_fpga, 0644, ts78xx_fpga_show, ts78xx_fpga_store);
 550
 551 /*****************************************************************************
 552  * General Setup
 553  ****************************************************************************/
 554 static unsigned int ts78xx_mpp_modes[] __initdata = {
 555         MPP0_UNUSED,
 556         MPP1_GPIO,              /* JTAG Clock */
 557         MPP2_GPIO,              /* JTAG Data In */
 558         MPP3_GPIO,              /* Lat ECP2 256 FPGA - PB2B */
 559         MPP4_GPIO,              /* JTAG Data Out */
 560         MPP5_GPIO,              /* JTAG TMS */
 561         MPP6_GPIO,              /* Lat ECP2 256 FPGA - PB31A_CLK4+ */
 562         MPP7_GPIO,              /* Lat ECP2 256 FPGA - PB22B */
 563         MPP8_UNUSED,
 564         MPP9_UNUSED,
 565         MPP10_UNUSED,
 566         MPP11_UNUSED,
 567         MPP12_UNUSED,
 568         MPP13_UNUSED,
 569         MPP14_UNUSED,
 570         MPP15_UNUSED,
 571         MPP16_UART,
 572         MPP17_UART,
 573         MPP18_UART,
 574         MPP19_UART,
 575         /*
 576          * MPP[20] PCI Clock Out 1
 577          * MPP[21] PCI Clock Out 0
 578          * MPP[22] Unused
 579          * MPP[23] Unused
 580          * MPP[24] Unused
 581          * MPP[25] Unused
 582          */
 583         0,
 584 };
 585
 586 static void __init ts78xx_init(void)
 587 {
 588         int ret;
 589
 590         /*
 591          * Setup basic Orion functions. Need to be called early.
 592          */
 593         orion5x_init();
 594
 595         orion5x_mpp_conf(ts78xx_mpp_modes);
 596
 597         /*
 598          * Configure peripherals.
 599          */
 600         orion5x_ehci0_init();
 601         orion5x_ehci1_init();
 602         orion5x_eth_init(&ts78xx_eth_data);
 603         orion5x_sata_init(&ts78xx_sata_data);
 604         orion5x_uart0_init();
 605         orion5x_uart1_init();
 606         orion5x_xor_init();
 607
 608         /* FPGA init */
 609         ts78xx_fpga_devices_zero_init();
 610         ret = ts78xx_fpga_load();
 611         ret = sysfs_create_file(firmware_kobj, &ts78xx_fpga_attr.attr);
 612         if (ret)
 613                 pr_err("sysfs_create_file failed: %d\n", ret);
 614 }
 615
 616 MACHINE_START(TS78XX, "Technologic Systems TS-78xx SBC")
 617         /* Maintainer: Alexander Clouter <alex@digriz.org.uk> */
 618         .atag_offset    = 0x100,
 619         .init_machine   = ts78xx_init,
 620         .map_io         = ts78xx_map_io,
 621         .init_early     = orion5x_init_early,
 622         .init_irq       = orion5x_init_irq,
 623         .timer          = &orion5x_timer,
 624         .restart        = orion5x_restart,
 625 MACHINE_END