cpu/mpc512x/iopin.c

   1 /*
   2  * (C) Copyright 2008
   3  * Martha J Marx, Silicon Turnkey Express, mmarx@silicontkx.com
   4  * mpc512x I/O pin/pad initialization for the ADS5121 board
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 #include <common.h>
  25 #include <linux/types.h>
  26 #include <mpc512x.h>
  27
  28 void iopin_initialize(iopin_t *ioregs_init, int len)
  29 {
  30         short i, j, p;
  31         u_long *reg;
  32         immap_t *im = (immap_t *)CONFIG_SYS_IMMR;
  33
  34         reg = (u_long *)&(im->io_ctrl.regs[0]);
  35
  36         if (sizeof(ioregs_init) == 0)
  37                 return;
  38
  39         for (i = 0; i < len; i++) {
  40                 for (p = 0, j = ioregs_init[i].p_offset / sizeof(u_long);
  41                         p < ioregs_init[i].nr_pins; p++, j++) {
  42                         if (ioregs_init[i].bit_or)
  43                                 reg[j] |= ioregs_init[i].val;
  44                         else
  45                                 reg[j] = ioregs_init[i].val;
  46                 }
  47         }
  48         return;
  49 }