source: trunk/boot/tsar_mips32/boot_bdv_driver.c

Last change on this file was 474, checked in by viala@…, 8 years ago

[boot] Add void type to function prototypes with no parameter
File size: 4.9 KB
Line 
1///////////////////////////////////////////////////////////////////////////////////
2// File : boot_bdv_driver.c
3// Date : 18/01/2017
4// Author : Alain Greiner / Vu Son
5// Copyright (c) UPMC-LIP6
6///////////////////////////////////////////////////////////////////////////////////
7
8#include <boot_config.h>
9#include <boot_bdv_driver.h>
10#include <boot_mmc_driver.h>
11#include <boot_utils.h>
12
13#ifndef SEG_IOC_BASE
14# error "The SEG_IOC_BASE value should be defined in the 'hard_config.h' file"
15#endif
16
17#ifndef X_IO
18# error "The X_IO value should be defined in the 'hard_config.h' file"
19#endif
20
21#ifndef Y_IO
22# error "The Y_IO value should be defined in the 'hard_config.h' file"
23#endif
24
25#ifndef Y_WIDTH
26# error "The Y_WIDTH value should be defined in the 'hard_config.h' file"
27#endif
28
29
30/****************************************************************************
31 * Internal functions. *
32 ****************************************************************************/
33
34/****************************************************************************
35 * This function returns the value of a BDV register. *
36 * @ reg : BDV register to be read. *
37 * @ returns the value stored in 'reg'. *
38 ****************************************************************************/
39static uint32_t boot_bdv_get_register( uint32_t reg )
40{
41 cxy_t cxy = (X_IO << Y_WIDTH) + Y_IO;
42 uint32_t * ptr = (uint32_t *)SEG_IOC_BASE + reg;
43
44 return boot_remote_lw( XPTR( cxy , ptr ) );
45
46} // boot_bdv_get_register()
47
48/****************************************************************************
49 * This function set a new value to a BDV register. *
50 * @ reg : BDV register to be configured. *
51 * @ val : new value to be written. *
52 ****************************************************************************/
53static void boot_bdv_set_register( uint32_t reg,
54 uint32_t val )
55{
56 cxy_t cxy = (X_IO << Y_WIDTH) + Y_IO;
57 uint32_t * ptr = (uint32_t *)SEG_IOC_BASE + reg;
58
59 boot_remote_sw( XPTR( cxy , ptr ) , val );
60
61} // boot_bdv_set_register()
62
63/****************************************************************************
64 * Driver API functions. *
65 ****************************************************************************/
66
67///////////////////
68int boot_bdv_init( void )
69{
70 // Check block size
71 if (boot_bdv_get_register(BDV_BLOCK_SIZE) != 512)
72 {
73 boot_puts("\n[BOOT ERROR] boot_bdv_init(): "
74 "Block size must be 512 bytes\n");
75 return -1;
76 }
77
78 // Disable IRQq
79 boot_bdv_set_register(BDV_IRQ_ENABLE, 0);
80
81 return 0;
82
83} // boot_bdv_init()
84
85////////////////////////////////////
86int boot_bdv_access( uint32_t lba,
87 xptr_t buf_paddr,
88 uint32_t count)
89{
90 uint32_t error;
91 uint32_t status;
92
93 // get target buffer cluster and pointer
94 cxy_t buf_cxy = GET_CXY( buf_paddr );
95 uint32_t buf_ptr = (uint32_t)GET_PTR( buf_paddr );
96
97 // Check buffer address alignment
98 if (buf_ptr & 0x3F)
99 {
100 boot_puts("\n[BOOT ERROR] boot_bdv_access(): "
101 "Buffer address is not cache-line-size-aligned\n");
102 return -1;
103 }
104
105 // Set BDV device registers
106 boot_bdv_set_register(BDV_BUFFER , buf_ptr );
107 boot_bdv_set_register(BDV_BUFFER_EXT, buf_cxy );
108 boot_bdv_set_register(BDV_COUNT , count );
109 boot_bdv_set_register(BDV_LBA , lba );
110
111#if USE_IOB // software L2/L3 cache coherence
112 if( boot_mmc_inval( buf_paddr, count<<9 ) ) return -1;
113#endif
114
115 // Launch data transfer
116 boot_bdv_set_register(BDV_OPERATION, BDV_READ);
117
118#if DEBUG_BOOT_IOC
119boot_printf("\n[BOOT] boot_bdv_access(): Transfer launched at cycle %d\n"
120 " lba = %d / buf = %l / nblocks = %d\n",
121 boot_get_proctime() , lba , buf_paddr , count );
122#endif
123
124 // Wait transfer completion
125 do
126 {
127 status = boot_bdv_get_register(BDV_STATUS);
128
129 } while ((status != BDV_READ_SUCC ) &&
130 (status != BDV_READ_ERR ) &&
131 (status != BDV_WRITE_SUCC) &&
132 (status != BDV_WRITE_ERR ));
133
134#if DEBUG_BOOT_IOC
135boot_printf("\n[BOOT] boot_bdv_access(): Transfer terminated at cycle %d\n",
136 boot_get_proctime() );
137
138// uint32_t * data = (uint32_t *)(uint32_t)buf_paddr;
139// uint32_t line;
140// uint32_t word;
141// boot_printf("\n");
142// for( line = 0 ; line < 16 ; line++ )
143// {
144// for( word = 0 ; word < 8 ; word++ )
145// {
146// boot_printf(" | %x", data[line*8+word] );
147// }
148// boot_printf(" |\n");
149// }
150
151#endif
152
153 // Check error
154 error = ((status == BDV_READ_ERR) ||
155 (status == BDV_WRITE_ERR));
156
157 return error;
158
159} // boot_bdv_access()
Note: See TracBrowser for help on using the repository browser.