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
00041 #include "libstoragemedia.h"
00042
00043 #if defined(AT91C_BASE_DDR2C) || defined(AT91C_BASE_SDDRC)
00044
00045 #if defined(AT91C_DDR2)
00046 #define AT91C_BASE_ADDRESS_DDR AT91C_DDR2
00047 #endif
00048
00049 #if defined(AT91C_EBI_DDRAM)
00050 #define AT91C_BASE_ADDRESS_DDR AT91C_EBI_DDRAM
00051 #endif
00052
00053
00054
00055
00056
00057
00058 typedef void copyFunction(uint8_t **, uint8_t **, uint32_t);
00059
00060
00061
00062
00063
00064
00065
00066
00067 static void AlignedCopy(uint8_t * *src,
00068 uint8_t * *dst,
00069 uint32_t len)
00070 {
00071 uint32_t *src32, *dst32;
00072 src32 = (uint32_t *)*src;
00073 dst32 = (uint32_t *)*dst;
00074
00075 for (; len > 0; len -= 8) {
00076 *dst32 ++ = *src32 ++;
00077 *dst32 ++ = *src32 ++;
00078 }
00079
00080 *src = (uint8_t *)src32;
00081 *dst = (uint8_t *)dst32;
00082 }
00083
00084
00085
00086
00087 static void UnalignedCopy(uint8_t * *src,
00088 uint8_t * *dst,
00089 uint32_t len)
00090 {
00091 for (; len > 0; len --)
00092 *(*dst) ++ = *(*src) ++;
00093 }
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107 static uint8_t MEDDdram_Read(Media *media,
00108 uint32_t address,
00109 void *data,
00110 uint32_t length,
00111 MediaCallback callback,
00112 void *argument)
00113 {
00114 uint8_t *source;
00115 uint8_t *dest;
00116 copyFunction *pCpy;
00117
00118
00119 if (media->state != MED_STATE_READY) {
00120
00121 TRACE_INFO("Media busy\n\r");
00122 return MED_STATUS_BUSY;
00123 }
00124
00125
00126 if ((length + address) > media->size) {
00127
00128 TRACE_WARNING("MEDDdram_Read: Data too big: %u, 0x%08X\n\r",
00129 length, address);
00130 return MED_STATUS_ERROR;
00131 }
00132
00133
00134 media->state = MED_STATE_BUSY;
00135
00136
00137 source = (uint8_t *)(media->blockSize
00138 * (address + media->baseAddress));
00139 dest = (uint8_t *)data;
00140
00141
00142 pCpy = (((uint32_t)source % 4) == 0 && (media->blockSize % 8) == 0)
00143 ? AlignedCopy : UnalignedCopy;
00144
00145 for (; length > 0; length --)
00146 pCpy(&source, &dest, media->blockSize);
00147
00148
00149 media->state = MED_STATE_READY;
00150
00151
00152 if (callback != 0)
00153 callback(argument, MED_STATUS_SUCCESS, 0, 0);
00154
00155 return MED_STATUS_SUCCESS;
00156 }
00157
00158
00159
00160
00161
00162
00163
00164
00165
00166
00167
00168
00169
00170
00171 static uint8_t MEDDdram_Write(Media *media,
00172 uint32_t address,
00173 void *data,
00174 uint32_t length,
00175 MediaCallback callback,
00176 void *argument)
00177 {
00178 uint8_t *source;
00179 uint8_t *dest;
00180 copyFunction *pCpy;
00181
00182
00183
00184
00185 if (media->state != MED_STATE_READY) {
00186
00187 TRACE_INFO("MEDDdram_Write: Busy\n\r");
00188 return MED_STATUS_BUSY;
00189 }
00190
00191
00192 if ((length + address) > media->size) {
00193
00194 TRACE_WARNING("MEDDdram_Write: Data too big\n\r");
00195 return MED_STATUS_ERROR;
00196 }
00197
00198
00199 media->state = MED_STATE_BUSY;
00200
00201
00202 source = (uint8_t *) data;
00203 dest = (uint8_t *) (media->blockSize *
00204 (media->baseAddress + address));
00205
00206
00207 pCpy = (((uint32_t)source % 4) == 0 && (media->blockSize % 8) == 0)
00208 ? AlignedCopy : UnalignedCopy;
00209
00210 for (; length > 0; length --)
00211 pCpy(&source, &dest, media->blockSize);
00212
00213
00214 media->state = MED_STATE_READY;
00215
00216
00217 if (callback != 0)
00218
00219 callback(argument, MED_STATUS_SUCCESS, 0, 0);
00220
00221 return MED_STATUS_SUCCESS;
00222 }
00223
00224
00225
00226
00227
00228
00229
00230
00231
00232
00233
00234
00235 void MEDDdram_Initialize(Media *media,
00236 uint32_t blockSize,
00237 uint32_t baseAddress,
00238 uint32_t size)
00239 {
00240 uint32_t value;
00241
00242 TRACE_INFO("MEDDdram init\n\r");
00243
00244
00245
00246 value = *((volatile uint32_t *) AT91C_BASE_ADDRESS_DDR);
00247 *((volatile uint32_t *) AT91C_BASE_ADDRESS_DDR) = 0xDEADBEEF;
00248
00249 if (*((volatile uint32_t *) AT91C_BASE_ADDRESS_DDR) == 0xDEADBEEF) {
00250
00251 *((volatile uint32_t *) AT91C_BASE_ADDRESS_DDR) = value;
00252 TRACE_INFO("DDRAM initialized\n\r");
00253 } else {
00254
00255 *((volatile uint32_t *) AT91C_BASE_ADDRESS_DDR) = value;
00256 TRACE_INFO("Initialize DDRAM ...\n\r");
00257 BOARD_ConfigureDdram(0, BOARD_DDRAM_BUSWIDTH);
00258 }
00259
00260
00261
00262 media->write = MEDDdram_Write;
00263 media->read = MEDDdram_Read;
00264 media->lock = 0;
00265 media->unlock = 0;
00266 media->handler = 0;
00267 media->flush = 0;
00268
00269 media->blockSize = blockSize;
00270 media->baseAddress = baseAddress;
00271 media->size = size;
00272
00273 media->mappedRD = 1;
00274 media->mappedWR = 1;
00275 media->protected = 0;
00276 media->removable = 0;
00277 media->state = MED_STATE_READY;
00278
00279 media->transfer.data = 0;
00280 media->transfer.address = 0;
00281 media->transfer.length = 0;
00282 media->transfer.callback = 0;
00283 media->transfer.argument = 0;
00284 }
00285 #endif //#if defined(AT91C_BASE_DDR2C)
00286