aboutsummaryrefslogtreecommitdiff
path: root/board/bf533-stamp/ide-cf.c
blob: 23e786b5b88c9bb4eaf8aec7aa9166ec059b65b2 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
/*
 * CF IDE addon card code
 *
 * Enter bugs at http://blackfin.uclinux.org/
 *
 * Copyright (c) 2005-2009 Analog Devices Inc.
 *
 * Licensed under the GPL-2 or later.
 */

#include <common.h>
#include <config.h>
#include <asm/blackfin.h>
#include "bf533-stamp.h"

void cf_outb(unsigned char val, volatile unsigned char *addr)
{
	/* "ETHERNET" means the expansion memory banks */
	swap_to(ETHERNET);

	*addr = val;
	SSYNC();

	swap_to(FLASH);
}

unsigned char cf_inb(volatile unsigned char *addr)
{
	unsigned char c;

	swap_to(ETHERNET);

	c = *addr;
	SSYNC();

	swap_to(FLASH);

	return c;
}

void cf_insw(unsigned short *sect_buf, unsigned short *addr, int words)
{
	int i;

	swap_to(ETHERNET);

	for (i = 0; i < words; i++) {
		*(sect_buf + i) = *addr;
		SSYNC();
	}

	swap_to(FLASH);
}

void cf_outsw(unsigned short *addr, unsigned short *sect_buf, int words)
{
	int i;

	swap_to(ETHERNET);

	for (i = 0; i < words; i++) {
		*addr = *(sect_buf + i);
		SSYNC();
	}

	swap_to(FLASH);
}

void cf_ide_init(void)
{
	int i, cf_stat;

	/* Check whether CF card is inserted */
	bfin_write_FIO_EDGE(FIO_EDGE_CF_BITS);
	bfin_write_FIO_POLAR(FIO_POLAR_CF_BITS);
	for (i = 0; i < 0x300; i++)
		asm volatile("nop;");

	cf_stat = bfin_read_FIO_FLAG_S() & CF_STAT_BITS;

	bfin_write_FIO_EDGE(FIO_EDGE_BITS);
	bfin_write_FIO_POLAR(FIO_POLAR_BITS);

	if (!cf_stat) {
		for (i = 0; i < 0x3000; i++)
			asm volatile("nop;");

		ide_init();
	}
}