LXR uboot/board/bc3450/cmd

   1/*
   2 * (C) Copyright 2005
   3 * Stefan Strobl, GERSYS GmbH, stefan.strobl@gersys.de
   4 *
   5 * (C) Copyright 2005
   6 * Martin Krause, TQ-Systems GmbH, martin.krause@tqs.de.
   7 *
   8 * See file CREDITS for list of people who contributed to this
   9 * project.
  10 *
  11 * This program is free software; you can redistribute it and/or
  12 * modify it under the terms of the GNU General Public License as
  13 * published by the Free Software Foundation; either version 2 of
  14 * the License, or (at your option) any later version.
  15 *
  16 * This program is distributed in the hope that it will be useful,
  17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19 * GNU General Public License for more details.
  20 *
  21 * You should have received a copy of the GNU General Public License
  22 * along with this program; if not, write to the Free Software
  23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  24 * MA 02111-1307 USA
  25 */
  26
  27#include <common.h>
  28#include <command.h>
  29
  30/*
  31 * BC3450 specific commands
  32 */
  33#if defined(CONFIG_CMD_BSP)
  34
  35/*
  36 * Definitions for DS1620 chip
  37 */
  38#define THERM_START_CONVERT     0xee
  39#define THERM_RESET             0xaf
  40#define THERM_READ_CONFIG       0xac
  41#define THERM_READ_TEMP         0xaa
  42#define THERM_READ_TL           0xa2
  43#define THERM_READ_TH           0xa1
  44#define THERM_WRITE_CONFIG      0x0c
  45#define THERM_WRITE_TL          0x02
  46#define THERM_WRITE_TH          0x01
  47
  48#define CONFIG_SYS_1SHOT                1
  49#define CONFIG_SYS_STANDALONE           0
  50
  51struct therm {
  52        int hi;
  53        int lo;
  54};
  55
  56/*
  57 * SM501 Register
  58 */
  59#define SM501_GPIO_CTRL_LOW             0x00000008UL    /* gpio pins 0..31  */
  60#define SM501_GPIO_CTRL_HIGH            0x0000000CUL    /* gpio pins 32..63 */
  61#define SM501_POWER_MODE0_GATE          0x00000040UL
  62#define SM501_POWER_MODE1_GATE          0x00000048UL
  63#define POWER_MODE_GATE_GPIO_PWM_I2C    0x00000040UL
  64#define SM501_GPIO_DATA_LOW             0x00010000UL
  65#define SM501_GPIO_DATA_HIGH            0x00010004UL
  66#define SM501_GPIO_DATA_DIR_LOW         0x00010008UL
  67#define SM501_GPIO_DATA_DIR_HIGH        0x0001000CUL
  68#define SM501_PANEL_DISPLAY_CONTROL     0x00080000UL
  69#define SM501_CRT_DISPLAY_CONTROL       0x00080200UL
  70
  71/* SM501 CRT Display Control Bits */
  72#define SM501_CDC_SEL                   (1 << 9)
  73#define SM501_CDC_TE                    (1 << 8)
  74#define SM501_CDC_E                     (1 << 2)
  75
  76/* SM501 Panel Display Control Bits */
  77#define SM501_PDC_FPEN                  (1 << 27)
  78#define SM501_PDC_BIAS                  (1 << 26)
  79#define SM501_PDC_DATA                  (1 << 25)
  80#define SM501_PDC_VDDEN                 (1 << 24)
  81
  82/* SM501 GPIO Data LOW Bits */
  83#define SM501_GPIO24                    0x01000000
  84#define SM501_GPIO25                    0x02000000
  85#define SM501_GPIO26                    0x04000000
  86#define SM501_GPIO27                    0x08000000
  87#define SM501_GPIO28                    0x10000000
  88#define SM501_GPIO29                    0x20000000
  89#define SM501_GPIO30                    0x40000000
  90#define SM501_GPIO31                    0x80000000
  91
  92/* SM501 GPIO Data HIGH Bits */
  93#define SM501_GPIO46                    0x00004000
  94#define SM501_GPIO47                    0x00008000
  95#define SM501_GPIO48                    0x00010000
  96#define SM501_GPIO49                    0x00020000
  97#define SM501_GPIO50                    0x00040000
  98#define SM501_GPIO51                    0x00080000
  99
 100/* BC3450 GPIOs @ SM501 Data LOW */
 101#define DIP                             (SM501_GPIO24 | SM501_GPIO25 | SM501_GPIO26 | SM501_GPIO27)
 102#define DS1620_DQ                       SM501_GPIO29    /* I/O             */
 103#define DS1620_CLK                      SM501_GPIO30    /* High active O/P */
 104#define DS1620_RES                      SM501_GPIO31    /* Low active O/P  */
 105/* BC3450 GPIOs @ SM501 Data HIGH */
 106#define BUZZER                          SM501_GPIO47    /* Low active O/P  */
 107#define DS1620_TLOW                     SM501_GPIO48    /* High active I/P */
 108#define PWR_OFF                         SM501_GPIO49    /* Low active O/P  */
 109#define FP_DATA_TRI                     SM501_GPIO50    /* High active O/P */
 110
 111
 112/*
 113 * Initialise GPIO on SM501
 114 *
 115 * This function may be called from several other functions.
 116 * Yet, the initialisation sequence is executed only the first
 117 * time the function is called.
 118 */
 119int sm501_gpio_init (void)
 120{
 121        static int init_done = 0;
 122
 123        if (init_done) {
 124                debug("sm501_gpio_init: nothing to be done.\n");
 125                return 1;
 126        }
 127
 128        /* enable SM501 GPIO control (in both power modes) */
 129        *(vu_long *) (SM501_MMIO_BASE + SM501_POWER_MODE0_GATE) |=
 130                POWER_MODE_GATE_GPIO_PWM_I2C;
 131        *(vu_long *) (SM501_MMIO_BASE + SM501_POWER_MODE1_GATE) |=
 132                POWER_MODE_GATE_GPIO_PWM_I2C;
 133
 134        /* set up default O/Ps */
 135        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
 136                ~(DS1620_RES | DS1620_CLK);
 137        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |= DS1620_DQ;
 138        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
 139                ~(FP_DATA_TRI);
 140        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) |=
 141                (BUZZER | PWR_OFF);
 142
 143        /* configure directions for SM501 GPIO pins */
 144        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_CTRL_LOW) &= ~(0xFF << 24);
 145        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_CTRL_HIGH) &=
 146                ~(0x3F << 14);
 147        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) &=
 148                ~(DIP | DS1620_DQ);
 149        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) |=
 150                (DS1620_RES | DS1620_CLK);
 151        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_HIGH) &=
 152                ~DS1620_TLOW;
 153        *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_HIGH) |=
 154                (PWR_OFF | BUZZER | FP_DATA_TRI);
 155
 156        init_done = 1;
 157        debug("sm501_gpio_init: done.\n");
 158
 159        return 0;
 160}
 161
 162
 163/*
 164 * dip - read Config Inputs
 165 *
 166 * read and prints the dip switch
 167 * and/or external config inputs (4bits) 0...0x0F
 168 */
 169int cmd_dip (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 170{
 171        vu_long rc = 0;
 172
 173        sm501_gpio_init ();
 174
 175        /* read dip switch */
 176        rc = *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW);
 177        rc = ~rc;
 178        rc &= DIP;
 179        rc = (int) (rc >> 24);
 180
 181        /* plausibility check */
 182        if (rc > 0x0F)
 183                return -1;
 184
 185        printf ("0x%lx\n", rc);
 186        return 0;
 187}
 188
 189U_BOOT_CMD (dip, 1, 1, cmd_dip,
 190            "read dip switch and config inputs",
 191            "\n"
 192            "     - prints the state of the dip switch and/or\n"
 193            "       external configuration inputs as hex value.\n"
 194            "     - \"Config 1\" is the LSB");
 195
 196
 197/*
 198 * buz - turns Buzzer on/off
 199 */
 200#ifdef CONFIG_BC3450_BUZZER
 201static int cmd_buz (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 202{
 203        if (argc != 2) {
 204                printf ("Usage:\nspecify one argument: \"on\" or \"off\"\n");
 205                return 1;
 206        }
 207
 208        sm501_gpio_init ();
 209
 210        if (strncmp (argv[1], "on", 2) == 0) {
 211                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
 212                        ~(BUZZER);
 213                return 0;
 214        } else if (strncmp (argv[1], "off", 3) == 0) {
 215                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) |=
 216                        BUZZER;
 217                return 0;
 218        }
 219        printf ("Usage:\nspecify one argument: \"on\" or \"off\"\n");
 220        return 1;
 221}
 222
 223U_BOOT_CMD (buz, 2, 1, cmd_buz,
 224            "turns buzzer on/off",
 225            "\n" "buz <on/off>\n" "     - turns the buzzer on or off");
 226#endif /* CONFIG_BC3450_BUZZER */
 227
 228
 229/*
 230 * fp - front panel commands
 231 */
 232static int cmd_fp (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 233{
 234        sm501_gpio_init ();
 235
 236        if (strncmp (argv[1], "on", 2) == 0) {
 237                /* turn on VDD first */
 238                *(vu_long *) (SM501_MMIO_BASE +
 239                              SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_VDDEN;
 240                udelay (1000);
 241                /* then put data on */
 242                *(vu_long *) (SM501_MMIO_BASE +
 243                              SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_DATA;
 244                /* wait some time and enable backlight */
 245                udelay (1000);
 246                *(vu_long *) (SM501_MMIO_BASE +
 247                              SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_BIAS;
 248                udelay (1000);
 249                *(vu_long *) (SM501_MMIO_BASE +
 250                              SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_FPEN;
 251                return 0;
 252        } else if (strncmp (argv[1], "off", 3) == 0) {
 253                /* turn off the backlight first */
 254                *(vu_long *) (SM501_MMIO_BASE +
 255                              SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_FPEN;
 256                udelay (1000);
 257                *(vu_long *) (SM501_MMIO_BASE +
 258                              SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_BIAS;
 259                udelay (200000);
 260                /* wait some time, then remove data */
 261                *(vu_long *) (SM501_MMIO_BASE +
 262                              SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_DATA;
 263                udelay (1000);
 264                /* and remove VDD last */
 265                *(vu_long *) (SM501_MMIO_BASE +
 266                              SM501_PANEL_DISPLAY_CONTROL) &=
 267                        ~SM501_PDC_VDDEN;
 268                return 0;
 269        } else if (strncmp (argv[1], "bl", 2) == 0) {
 270                /* turn on/off backlight only */
 271                if (strncmp (argv[2], "on", 2) == 0) {
 272                        *(vu_long *) (SM501_MMIO_BASE +
 273                                      SM501_PANEL_DISPLAY_CONTROL) |=
 274                                SM501_PDC_BIAS;
 275                        udelay (1000);
 276                        *(vu_long *) (SM501_MMIO_BASE +
 277                                      SM501_PANEL_DISPLAY_CONTROL) |=
 278                                SM501_PDC_FPEN;
 279                        return 0;
 280                } else if (strncmp (argv[2], "off", 3) == 0) {
 281                        *(vu_long *) (SM501_MMIO_BASE +
 282                                      SM501_PANEL_DISPLAY_CONTROL) &=
 283                                ~SM501_PDC_FPEN;
 284                        udelay (1000);
 285                        *(vu_long *) (SM501_MMIO_BASE +
 286                                      SM501_PANEL_DISPLAY_CONTROL) &=
 287                                ~SM501_PDC_BIAS;
 288                        return 0;
 289                }
 290        }
 291#ifdef CONFIG_BC3450_CRT
 292        else if (strncmp (argv[1], "crt", 3) == 0) {
 293                /* enables/disables the crt output (debug only) */
 294                if (strncmp (argv[2], "on", 2) == 0) {
 295                        *(vu_long *) (SM501_MMIO_BASE +
 296                                      SM501_CRT_DISPLAY_CONTROL) |=
 297                                (SM501_CDC_TE | SM501_CDC_E);
 298                        *(vu_long *) (SM501_MMIO_BASE +
 299                                      SM501_CRT_DISPLAY_CONTROL) &=
 300                                ~SM501_CDC_SEL;
 301                        return 0;
 302                } else if (strncmp (argv[2], "off", 3) == 0) {
 303                        *(vu_long *) (SM501_MMIO_BASE +
 304                                      SM501_CRT_DISPLAY_CONTROL) &=
 305                                ~(SM501_CDC_TE | SM501_CDC_E);
 306                        *(vu_long *) (SM501_MMIO_BASE +
 307                                      SM501_CRT_DISPLAY_CONTROL) |=
 308                                SM501_CDC_SEL;
 309                        return 0;
 310                }
 311        }
 312#endif /* CONFIG_BC3450_CRT */
 313        printf ("Usage:%s\n", cmdtp->help);
 314        return 1;
 315}
 316
 317U_BOOT_CMD (fp, 3, 1, cmd_fp,
 318            "front panes access functions",
 319            "\n"
 320            "fp bl <on/off>\n"
 321            "     - turns the CCFL backlight of the display on/off\n"
 322            "fp <on/off>\n" "     - turns the whole display on/off"
 323#ifdef CONFIG_BC3450_CRT
 324            "\n"
 325            "fp crt <on/off>\n"
 326            "     - enables/disables the crt output (debug only)"
 327#endif /* CONFIG_BC3450_CRT */
 328        );
 329
 330/*
 331 * temp - DS1620 thermometer
 332 */
 333/* GERSYS BC3450 specific functions */
 334static inline void bc_ds1620_set_clk (int clk)
 335{
 336        if (clk)
 337                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |=
 338                        DS1620_CLK;
 339        else
 340                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
 341                        ~DS1620_CLK;
 342}
 343
 344static inline void bc_ds1620_set_data (int dat)
 345{
 346        if (dat)
 347                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |=
 348                        DS1620_DQ;
 349        else
 350                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
 351                        ~DS1620_DQ;
 352}
 353
 354static inline int bc_ds1620_get_data (void)
 355{
 356        vu_long rc;
 357
 358        rc = *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW);
 359        rc &= DS1620_DQ;
 360        if (rc != 0)
 361                rc = 1;
 362        return (int) rc;
 363}
 364
 365static inline void bc_ds1620_set_data_dir (int dir)
 366{
 367        if (dir)                /* in */
 368                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) &= ~DS1620_DQ;
 369        else                    /* out */
 370                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) |= DS1620_DQ;
 371}
 372
 373static inline void bc_ds1620_set_reset (int res)
 374{
 375        if (res)
 376                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |= DS1620_RES;
 377        else
 378                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &= ~DS1620_RES;
 379}
 380
 381/* hardware independent functions */
 382static void ds1620_send_bits (int nr, int value)
 383{
 384        int i;
 385
 386        for (i = 0; i < nr; i++) {
 387                bc_ds1620_set_data (value & 1);
 388                bc_ds1620_set_clk (0);
 389                udelay (1);
 390                bc_ds1620_set_clk (1);
 391                udelay (1);
 392
 393                value >>= 1;
 394        }
 395}
 396
 397static unsigned int ds1620_recv_bits (int nr)
 398{
 399        unsigned int value = 0, mask = 1;
 400        int i;
 401
 402        bc_ds1620_set_data (0);
 403
 404        for (i = 0; i < nr; i++) {
 405                bc_ds1620_set_clk (0);
 406                udelay (1);
 407
 408                if (bc_ds1620_get_data ())
 409                        value |= mask;
 410
 411                mask <<= 1;
 412
 413                bc_ds1620_set_clk (1);
 414                udelay (1);
 415        }
 416
 417        return value;
 418}
 419
 420static void ds1620_out (int cmd, int bits, int value)
 421{
 422        bc_ds1620_set_clk (1);
 423        bc_ds1620_set_data_dir (0);
 424
 425        bc_ds1620_set_reset (0);
 426        udelay (1);
 427        bc_ds1620_set_reset (1);
 428
 429        udelay (1);
 430
 431        ds1620_send_bits (8, cmd);
 432        if (bits)
 433                ds1620_send_bits (bits, value);
 434
 435        udelay (1);
 436
 437        /* go stand alone */
 438        bc_ds1620_set_data_dir (1);
 439        bc_ds1620_set_reset (0);
 440        bc_ds1620_set_clk (0);
 441
 442        udelay (10000);
 443}
 444
 445static unsigned int ds1620_in (int cmd, int bits)
 446{
 447        unsigned int value;
 448
 449        bc_ds1620_set_clk (1);
 450        bc_ds1620_set_data_dir (0);
 451
 452        bc_ds1620_set_reset (0);
 453        udelay (1);
 454        bc_ds1620_set_reset (1);
 455
 456        udelay (1);
 457
 458        ds1620_send_bits (8, cmd);
 459
 460        bc_ds1620_set_data_dir (1);
 461        value = ds1620_recv_bits (bits);
 462
 463        /* go stand alone */
 464        bc_ds1620_set_data_dir (1);
 465        bc_ds1620_set_reset (0);
 466        bc_ds1620_set_clk (0);
 467
 468        return value;
 469}
 470
 471static int cvt_9_to_int (unsigned int val)
 472{
 473        if (val & 0x100)
 474                val |= 0xfffffe00;
 475
 476        return val;
 477}
 478
 479/* set thermostate thresholds */
 480static void ds1620_write_state (struct therm *therm)
 481{
 482        ds1620_out (THERM_WRITE_TL, 9, therm->lo);
 483        ds1620_out (THERM_WRITE_TH, 9, therm->hi);
 484        ds1620_out (THERM_START_CONVERT, 0, 0);
 485}
 486
 487static int cmd_temp (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 488{
 489        int i;
 490        struct therm therm;
 491
 492        sm501_gpio_init ();
 493
 494        /* print temperature */
 495        if (argc == 1) {
 496                i = cvt_9_to_int (ds1620_in (THERM_READ_TEMP, 9));
 497                printf ("%d.%d C\n", i >> 1, i & 1 ? 5 : 0);
 498                return 0;
 499        }
 500
 501        /* set to default operation */
 502        if (strncmp (argv[1], "set", 3) == 0) {
 503                if (strncmp (argv[2], "default", 3) == 0) {
 504                        therm.hi = +88;
 505                        therm.lo = -20;
 506                        therm.hi <<= 1;
 507                        therm.lo <<= 1;
 508                        ds1620_write_state (&therm);
 509                        ds1620_out (THERM_WRITE_CONFIG, 8, CONFIG_SYS_STANDALONE);
 510                        return 0;
 511                }
 512        }
 513
 514        printf ("Usage:%s\n", cmdtp->help);
 515        return 1;
 516}
 517
 518U_BOOT_CMD (temp, 3, 1, cmd_temp,
 519            "print current temperature",
 520            "\n" "temp\n" "     - print current temperature");
 521
 522#ifdef CONFIG_BC3450_CAN
 523/*
 524 * Initialise CAN interface
 525 *
 526 * return 1 on CAN initialization failure
 527 * return 0 if no failure
 528 */
 529int can_init (void)
 530{
 531        static int init_done = 0;
 532        int i;
 533        struct mpc5xxx_mscan *can1 =
 534                (struct mpc5xxx_mscan *) (CONFIG_SYS_MBAR + 0x0900);
 535        struct mpc5xxx_mscan *can2 =
 536                (struct mpc5xxx_mscan *) (CONFIG_SYS_MBAR + 0x0980);
 537
 538        /* GPIO configuration of the CAN pins is done in BC3450.h */
 539
 540        if (!init_done) {
 541                /* init CAN 1 */
 542                can1->canctl1 |= 0x80;  /* CAN enable */
 543                udelay (100);
 544
 545                i = 0;
 546                can1->canctl0 |= 0x02;  /* sleep mode */
 547                /* wait until sleep mode reached */
 548                while (!(can1->canctl1 & 0x02)) {
 549                        udelay (10);
 550                        i++;
 551                        if (i == 10) {
 552                                printf ("%s: CAN1 initialize error, "
 553                                        "can not enter sleep mode!\n",
 554                                        __FUNCTION__);
 555                                return 1;
 556                        }
 557                }
 558                i = 0;
 559                can1->canctl0 = 0x01;   /* enter init mode */
 560                /* wait until init mode reached */
 561                while (!(can1->canctl1 & 0x01)) {
 562                        udelay (10);
 563                        i++;
 564                        if (i == 10) {
 565                                printf ("%s: CAN1 initialize error, "
 566                                        "can not enter init mode!\n",
 567                                        __FUNCTION__);
 568                                return 1;
 569                        }
 570                }
 571                can1->canctl1 = 0x80;
 572                can1->canctl1 |= 0x40;
 573                can1->canbtr0 = 0x0F;
 574                can1->canbtr1 = 0x7F;
 575                can1->canidac &= ~(0x30);
 576                can1->canidar1 = 0x00;
 577                can1->canidar3 = 0x00;
 578                can1->canidar5 = 0x00;
 579                can1->canidar7 = 0x00;
 580                can1->canidmr0 = 0xFF;
 581                can1->canidmr1 = 0xFF;
 582                can1->canidmr2 = 0xFF;
 583                can1->canidmr3 = 0xFF;
 584                can1->canidmr4 = 0xFF;
 585                can1->canidmr5 = 0xFF;
 586                can1->canidmr6 = 0xFF;
 587                can1->canidmr7 = 0xFF;
 588
 589                i = 0;
 590                can1->canctl0 &= ~(0x01);       /* leave init mode */
 591                can1->canctl0 &= ~(0x02);
 592                /* wait until init and sleep mode left */
 593                while ((can1->canctl1 & 0x01) || (can1->canctl1 & 0x02)) {
 594                        udelay (10);
 595                        i++;
 596                        if (i == 10) {
 597                                printf ("%s: CAN1 initialize error, "
 598                                        "can not leave init/sleep mode!\n",
 599                                        __FUNCTION__);
 600                                return 1;
 601                        }
 602                }
 603
 604                /* init CAN 2 */
 605                can2->canctl1 |= 0x80;  /* CAN enable */
 606                udelay (100);
 607
 608                i = 0;
 609                can2->canctl0 |= 0x02;  /* sleep mode */
 610                /* wait until sleep mode reached */
 611                while (!(can2->canctl1 & 0x02)) {
 612                        udelay (10);
 613                        i++;
 614                        if (i == 10) {
 615                                printf ("%s: CAN2 initialize error, "
 616                                        "can not enter sleep mode!\n",
 617                                        __FUNCTION__);
 618                                return 1;
 619                        }
 620                }
 621                i = 0;
 622                can2->canctl0 = 0x01;   /* enter init mode */
 623                /* wait until init mode reached */
 624                while (!(can2->canctl1 & 0x01)) {
 625                        udelay (10);
 626                        i++;
 627                        if (i == 10) {
 628                                printf ("%s: CAN2 initialize error, "
 629                                        "can not enter init mode!\n",
 630                                        __FUNCTION__);
 631                                return 1;
 632                        }
 633                }
 634                can2->canctl1 = 0x80;
 635                can2->canctl1 |= 0x40;
 636                can2->canbtr0 = 0x0F;
 637                can2->canbtr1 = 0x7F;
 638                can2->canidac &= ~(0x30);
 639                can2->canidar1 = 0x00;
 640                can2->canidar3 = 0x00;
 641                can2->canidar5 = 0x00;
 642                can2->canidar7 = 0x00;
 643                can2->canidmr0 = 0xFF;
 644                can2->canidmr1 = 0xFF;
 645                can2->canidmr2 = 0xFF;
 646                can2->canidmr3 = 0xFF;
 647                can2->canidmr4 = 0xFF;
 648                can2->canidmr5 = 0xFF;
 649                can2->canidmr6 = 0xFF;
 650                can2->canidmr7 = 0xFF;
 651                can2->canctl0 &= ~(0x01);       /* leave init mode */
 652                can2->canctl0 &= ~(0x02);
 653
 654                i = 0;
 655                /* wait until init mode left */
 656                while ((can2->canctl1 & 0x01) || (can2->canctl1 & 0x02)) {
 657                        udelay (10);
 658                        i++;
 659                        if (i == 10) {
 660                                printf ("%s: CAN2 initialize error, "
 661                                        "can not leave init/sleep mode!\n",
 662                                        __FUNCTION__);
 663                                return 1;
 664                        }
 665                }
 666                init_done = 1;
 667        }
 668        return 0;
 669}
 670
 671/*
 672 * Do CAN test
 673 * by sending message between CAN1 and CAN2
 674 *
 675 * return 1 on CAN failure
 676 * return 0 if no failure
 677 */
 678int do_can (char * const argv[])
 679{
 680        int i;
 681        struct mpc5xxx_mscan *can1 =
 682                (struct mpc5xxx_mscan *) (CONFIG_SYS_MBAR + 0x0900);
 683        struct mpc5xxx_mscan *can2 =
 684                (struct mpc5xxx_mscan *) (CONFIG_SYS_MBAR + 0x0980);
 685
 686        /* send a message on CAN1 */
 687        can1->cantbsel = 0x01;
 688        can1->cantxfg.idr[0] = 0x55;
 689        can1->cantxfg.idr[1] = 0x00;
 690        can1->cantxfg.idr[1] &= ~0x8;
 691        can1->cantxfg.idr[1] &= ~0x10;
 692        can1->cantxfg.dsr[0] = 0xCC;
 693        can1->cantxfg.dlr = 1;
 694        can1->cantxfg.tbpr = 0;
 695        can1->cantflg = 0x01;
 696
 697        i = 0;
 698        while ((can1->cantflg & 0x01) == 0) {
 699                i++;
 700                if (i == 10) {
 701                        printf ("%s: CAN1 send timeout, "
 702                                "can not send message!\n", __FUNCTION__);
 703                        return 1;
 704                }
 705                udelay (1000);
 706        }
 707        udelay (1000);
 708
 709        i = 0;
 710        while (!(can2->canrflg & 0x01)) {
 711                i++;
 712                if (i == 10) {
 713                        printf ("%s: CAN2 receive timeout, "
 714                                "no message received!\n", __FUNCTION__);
 715                        return 1;
 716                }
 717                udelay (1000);
 718        }
 719
 720        if (can2->canrxfg.dsr[0] != 0xCC) {
 721                printf ("%s: CAN2 receive error, "
 722                        "data mismatch!\n", __FUNCTION__);
 723                return 1;
 724        }
 725
 726        /* send a message on CAN2 */
 727        can2->cantbsel = 0x01;
 728        can2->cantxfg.idr[0] = 0x55;
 729        can2->cantxfg.idr[1] = 0x00;
 730        can2->cantxfg.idr[1] &= ~0x8;
 731        can2->cantxfg.idr[1] &= ~0x10;
 732        can2->cantxfg.dsr[0] = 0xCC;
 733        can2->cantxfg.dlr = 1;
 734        can2->cantxfg.tbpr = 0;
 735        can2->cantflg = 0x01;
 736
 737        i = 0;
 738        while ((can2->cantflg & 0x01) == 0) {
 739                i++;
 740                if (i == 10) {
 741                        printf ("%s: CAN2 send error, "
 742                                "can not send message!\n", __FUNCTION__);
 743                        return 1;
 744                }
 745                udelay (1000);
 746        }
 747        udelay (1000);
 748
 749        i = 0;
 750        while (!(can1->canrflg & 0x01)) {
 751                i++;
 752                if (i == 10) {
 753                        printf ("%s: CAN1 receive timeout, "
 754                                "no message received!\n", __FUNCTION__);
 755                        return 1;
 756                }
 757                udelay (1000);
 758        }
 759
 760        if (can1->canrxfg.dsr[0] != 0xCC) {
 761                printf ("%s: CAN1 receive error 0x%02x\n",
 762                        __FUNCTION__, (can1->canrxfg.dsr[0]));
 763                return 1;
 764        }
 765
 766        return 0;
 767}
 768#endif /* CONFIG_BC3450_CAN */
 769
 770/*
 771 * test - BC3450 HW test routines
 772 */
 773int cmd_test (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 774{
 775#ifdef CONFIG_BC3450_CAN
 776        int rcode;
 777
 778        can_init ();
 779#endif /* CONFIG_BC3450_CAN */
 780
 781        sm501_gpio_init ();
 782
 783        if (argc != 2) {
 784                printf ("Usage:%s\n", cmdtp->help);
 785                return 1;
 786        }
 787
 788        if (strncmp (argv[1], "unit-off", 8) == 0) {
 789                printf ("waiting 2 seconds...\n");
 790                udelay (2000000);
 791                *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
 792                        ~PWR_OFF;
 793                return 0;
 794        }
 795#ifdef CONFIG_BC3450_CAN
 796        else if (strncmp (argv[1], "can", 2) == 0) {
 797                rcode = do_can (argv);
 798                if (simple_strtoul (argv[2], NULL, 10) == 2) {
 799                        if (rcode == 0)
 800                                printf ("OK\n");
 801                        else
 802                                printf ("Error\n");
 803                }
 804                return rcode;
 805        }
 806#endif /* CONFIG_BC3450_CAN */
 807
 808        printf ("Usage:%s\n", cmdtp->help);
 809        return 1;
 810}
 811
 812U_BOOT_CMD (test, 2, 1, cmd_test, "unit test routines", "\n"
 813#ifdef CONFIG_BC3450_CAN
 814        "test can\n"
 815        "     - connect CAN1 (X8) with CAN2 (X9) for this test\n"
 816#endif /* CONFIG_BC3450_CAN */
 817        "test unit-off\n"
 818        "     - turns off the BC3450 unit\n"
 819        "       WARNING: Unsaved environment variables will be lost!"
 820);
 821#endif
 822