arch/arm/cpu/arm920t/a320/ftsmc020.c

   1 /*
   2  * (C) Copyright 2009 Faraday Technology
   3  * Po-Yu Chuang <ratbert@faraday-tech.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 #include <config.h>
  21 #include <common.h>
  22 #include <asm/io.h>
  23 #include <asm/arch/ftsmc020.h>
  24
  25 struct ftsmc020_config {
  26         unsigned int    config;
  27         unsigned int    timing;
  28 };
  29
  30 static struct ftsmc020_config config[] = CONFIG_SYS_FTSMC020_CONFIGS;
  31
  32 static struct ftsmc020 *smc = (struct ftsmc020 *)CONFIG_FTSMC020_BASE;
  33
  34 static void ftsmc020_setup_bank(unsigned int bank, struct ftsmc020_config *cfg)
  35 {
  36         if (bank > 3) {
  37                 printf("bank # %u invalid\n", bank);
  38                 return;
  39         }
  40
  41         writel(cfg->config, &smc->bank[bank].cr);
  42         writel(cfg->timing, &smc->bank[bank].tpr);
  43 }
  44
  45 void ftsmc020_init(void)
  46 {
  47         int i;
  48
  49         for (i = 0; i < ARRAY_SIZE(config); i++)
  50                 ftsmc020_setup_bank(i, &config[i]);
  51 }