Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040 #include "libstoragemedia.h"
00041
00042 #if defined(AT91C_EBI_SDRAM)
00043
00044
00045
00046
00047
00048
00049 typedef void copyFunction(uint8_t **, uint8_t **, uint32_t);
00050
00051
00052
00053
00054
00055
00056
00057
00058 static void AlignedCopy(uint8_t * *src,
00059 uint8_t * *dst,
00060 uint32_t len)
00061 {
00062 uint32_t *src32, *dst32;
00063 src32 = (uint32_t*)*src;
00064 dst32 = (uint32_t*)*dst;
00065 for (;len > 0; len -= 8) {
00066 *dst32 ++ = *src32 ++;
00067 *dst32 ++ = *src32 ++;
00068 }
00069 *src = (uint8_t*)src32;
00070 *dst = (uint8_t*)dst32;
00071 }
00072
00073
00074
00075
00076 static void UnalignedCopy(uint8_t * *src,
00077 uint8_t * *dst,
00078 uint32_t len)
00079 {
00080 for (;len > 0; len --) {
00081 *(*dst) ++ = *(*src) ++;
00082 }
00083 }
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093
00094
00095
00096
00097 static uint8_t MEDSdram_Read(Media *media,
00098 uint32_t address,
00099 void *data,
00100 uint32_t length,
00101 MediaCallback callback,
00102 void *argument)
00103 {
00104 uint8_t *source;
00105 uint8_t *dest;
00106 copyFunction *pCpy;
00107
00108
00109 if (media->state != MED_STATE_READY) {
00110
00111 TRACE_INFO("SDRAM busy\n\r");
00112 return MED_STATUS_BUSY;
00113 }
00114
00115
00116 if ((length + address) > media->size) {
00117
00118 TRACE_WARNING("SdRamD_Read: Data too big: %u, 0x%08X\n\r",
00119 length, address);
00120 return MED_STATUS_ERROR;
00121 }
00122
00123
00124 media->state = MED_STATE_BUSY;
00125
00126
00127 source = (uint8_t *)(media->blockSize
00128 * (address + media->baseAddress));
00129 dest = (uint8_t *)data;
00130
00131
00132 pCpy = (((uint32_t)source%4) == 0 && (media->blockSize%8) == 0)
00133 ? AlignedCopy : UnalignedCopy;
00134
00135 for (; length > 0; length --) {
00136 pCpy(&source, &dest, media->blockSize);
00137 }
00138
00139
00140 media->state = MED_STATE_READY;
00141
00142
00143 if (callback != 0) {
00144 callback(argument, MED_STATUS_SUCCESS, 0, 0);
00145 }
00146
00147 return MED_STATUS_SUCCESS;
00148 }
00149
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160
00161
00162
00163 static uint8_t MEDSdram_Write(Media *media,
00164 uint32_t address,
00165 void *data,
00166 uint32_t length,
00167 MediaCallback callback,
00168 void *argument)
00169 {
00170 uint8_t *source;
00171 uint8_t *dest;
00172 copyFunction *pCpy;
00173
00174
00175
00176
00177 if (media->state != MED_STATE_READY) {
00178
00179 TRACE_WARNING("SdRamD_Write: Media is busy\n\r");
00180 return MED_STATUS_BUSY;
00181 }
00182
00183
00184 if ((length + address) > media->size) {
00185
00186 TRACE_WARNING("SdRamD_Write: Data too big\n\r");
00187 return MED_STATUS_ERROR;
00188 }
00189
00190
00191 source = (uint8_t *) data;
00192 dest = (uint8_t *) (media->blockSize *
00193 (media->baseAddress + address));
00194
00195
00196 pCpy = (((uint32_t)source%4) == 0 && (media->blockSize%8) == 0)
00197 ? AlignedCopy : UnalignedCopy;
00198
00199 for (; length > 0; length --) {
00200 pCpy(&source, &dest, media->blockSize);
00201 }
00202
00203
00204 media->state = MED_STATE_READY;
00205
00206
00207 if (callback != 0) {
00208
00209 callback(argument, MED_STATUS_SUCCESS, 0, 0);
00210 }
00211
00212 return MED_STATUS_SUCCESS;
00213 }
00214
00215
00216
00217
00218
00219
00220
00221
00222
00223 void MEDSdram_Initialize(Media *media,
00224 uint32_t blockSize,
00225 uint32_t baseAddress,
00226 uint32_t size)
00227 {
00228 uint32_t value;
00229
00230 TRACE_INFO("MEDSdram init\n\r");
00231
00232
00233 value = *((volatile uint32_t *) AT91C_EBI_SDRAM);
00234 *((volatile uint32_t *) AT91C_EBI_SDRAM) = 0xDEADBEEF;
00235
00236 if (*((volatile uint32_t *) AT91C_EBI_SDRAM) == 0xDEADBEEF) {
00237
00238 *((volatile uint32_t *) AT91C_EBI_SDRAM) = value;
00239 TRACE_INFO("SDRAM already initialized\n\r");
00240 }
00241 else {
00242 TRACE_INFO("Initializing the SDRAM ...\n\r");
00243 BOARD_ConfigureSdram(BOARD_SDRAM_BUSWIDTH);
00244 }
00245
00246
00247 media->write = MEDSdram_Write;
00248 media->read = MEDSdram_Read;
00249 media->lock = 0;
00250 media->unlock = 0;
00251 media->handler = 0;
00252 media->flush = 0;
00253
00254 media->blockSize = blockSize;
00255 media->baseAddress = baseAddress;
00256 media->size = size;
00257
00258 media->mappedRD = 1;
00259 media->mappedWR = 1;
00260 media->protected = 0;
00261 media->removable = 0;
00262 media->state = MED_STATE_READY;
00263
00264 media->transfer.data = 0;
00265 media->transfer.address = 0;
00266 media->transfer.length = 0;
00267 media->transfer.callback = 0;
00268 media->transfer.argument = 0;
00269 }
00270 #endif //#if defined(AT91C_EBI_SDRAM)
00271