board/bf533-stamp/ide-cf.c

   1 /*
   2  * CF IDE addon card code
   3  *
   4  * Enter bugs at http://blackfin.uclinux.org/
   5  *
   6  * Copyright (c) 2005-2009 Analog Devices Inc.
   7  *
   8  * Licensed under the GPL-2 or later.
   9  */
  10
  11 #include <common.h>
  12 #include <config.h>
  13 #include <asm/blackfin.h>
  14 #include "bf533-stamp.h"
  15
  16 void cf_outb(unsigned char val, volatile unsigned char *addr)
  17 {
  18         /* "ETHERNET" means the expansion memory banks */
  19         swap_to(ETHERNET);
  20
  21         *addr = val;
  22         SSYNC();
  23
  24         swap_to(FLASH);
  25 }
  26
  27 unsigned char cf_inb(volatile unsigned char *addr)
  28 {
  29         unsigned char c;
  30
  31         swap_to(ETHERNET);
  32
  33         c = *addr;
  34         SSYNC();
  35
  36         swap_to(FLASH);
  37
  38         return c;
  39 }
  40
  41 void cf_insw(unsigned short *sect_buf, unsigned short *addr, int words)
  42 {
  43         int i;
  44
  45         swap_to(ETHERNET);
  46
  47         for (i = 0; i < words; i++) {
  48                 *(sect_buf + i) = *addr;
  49                 SSYNC();
  50         }
  51
  52         swap_to(FLASH);
  53 }
  54
  55 void cf_outsw(unsigned short *addr, unsigned short *sect_buf, int words)
  56 {
  57         int i;
  58
  59         swap_to(ETHERNET);
  60
  61         for (i = 0; i < words; i++) {
  62                 *addr = *(sect_buf + i);
  63                 SSYNC();
  64         }
  65
  66         swap_to(FLASH);
  67 }
  68
  69 void cf_ide_init(void)
  70 {
  71         int i, cf_stat;
  72
  73         /* Check whether CF card is inserted */
  74         bfin_write_FIO_EDGE(FIO_EDGE_CF_BITS);
  75         bfin_write_FIO_POLAR(FIO_POLAR_CF_BITS);
  76         for (i = 0; i < 0x300; i++)
  77                 asm volatile("nop;");
  78
  79         cf_stat = bfin_read_FIO_FLAG_S() & CF_STAT_BITS;
  80
  81         bfin_write_FIO_EDGE(FIO_EDGE_BITS);
  82         bfin_write_FIO_POLAR(FIO_POLAR_BITS);
  83
  84         if (!cf_stat) {
  85                 for (i = 0; i < 0x3000; i++)
  86                         asm volatile("nop;");
  87
  88                 ide_init();
  89         }
  90 }