Start to extract generic interface from the sd driver implementation.
[bertos.git] / bertos / drv / sd.c
1 /**
2  * \file
3  * <!--
4  * This file is part of BeRTOS.
5  *
6  * Bertos is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  * As a special exception, you may use this file as part of a free software
21  * library without restriction.  Specifically, if other files instantiate
22  * templates or use macros or inline functions from this file, or you compile
23  * this file and link it with other files to produce an executable, this
24  * file does not by itself cause the resulting executable to be covered by
25  * the GNU General Public License.  This exception does not however
26  * invalidate any other reasons why the executable file might be covered by
27  * the GNU General Public License.
28  *
29  * Copyright 2007 Develer S.r.l. (http://www.develer.com/)
30  * -->
31  *
32  * \brief Function library for secure digital memory.
33  *
34  * \author Francesco Sacchi <batt@develer.com>
35  */
36
37
38 #include "sd.h"
39 #include "hw/hw_sd.h"
40 #include "cfg/cfg_sd.h"
41
42 #define LOG_LEVEL  SD_LOG_LEVEL
43 #define LOG_FORMAT SD_LOG_FORMAT
44 #include <cfg/log.h>
45
46 #include <io/kblock.h>
47
48 #include <string.h>
49
50 void sd_writeTest(Sd *sd)
51 {
52         uint8_t buf[SD_DEFAULT_BLOCKLEN];
53         memset(buf, 0, sizeof(buf));
54
55         for (block_idx_t i = 0; i < sd->b.blk_cnt; i++)
56         {
57                 LOG_INFO("writing block %ld: %s\n", i, (kblock_read(&sd->b, i, buf, 0, SD_DEFAULT_BLOCKLEN) == SD_DEFAULT_BLOCKLEN) ? "OK" : "FAIL");
58         }
59 }
60
61 bool sd_test(Sd *sd)
62 {
63         uint8_t buf[SD_DEFAULT_BLOCKLEN];
64
65         if (kblock_read(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
66                 return false;
67
68         kputchar('\n');
69         for (int i = 0; i < SD_DEFAULT_BLOCKLEN; i++)
70         {
71                 kprintf("%02X ", buf[i]);
72                 buf[i] = i;
73                 if (!((i+1) % 16))
74                         kputchar('\n');
75         }
76
77         if (kblock_write(&sd->b, 0, buf, 0, SD_DEFAULT_BLOCKLEN) != SD_DEFAULT_BLOCKLEN)
78                 return false;
79
80         memset(buf, 0, sizeof(buf));
81         if (kblock_read(&sd->b, 0, buf, 0, sd->b.blk_size) != sd->b.blk_size)
82                 return false;
83
84         kputchar('\n');
85         for (block_idx_t i = 0; i < sd->b.blk_size; i++)
86         {
87                 kprintf("%02X ", buf[i]);
88                 buf[i] = i;
89                 if (!((i+1) % 16))
90                         kputchar('\n');
91         }
92
93         return true;
94 }
95
96
97