SD slot 0: Enable card detectionhexrel-4.1

1 files changed, 11 insertions, 6 deletions

diff --git a/avr/mmc.c b/avr/mmc.c
index 12f58f3..80152f8 100644
--- a/avr/mmc.c
+++ b/avr/mmc.c
@@ -131,11 +131,12 @@ void deselect(BYTE drv)
 	SPI_OFF();
 
 	if (drv == 0) {
-#ifndef SD_CD_0
-		// SD_CS_0 = 1;
+#ifdef SD_CS_0_IN
+		SD_CS_0_DDR = 0;
+		SD_CS_0 = 0;
 #endif
 	} else {
-#ifndef SD_CD_1
+#ifdef SD_CS_1_IN
 		SD_CS_1_DDR = 0;
 		SD_CS_1 = 0;
 #endif
@@ -151,10 +152,14 @@ static
 int select(BYTE drv)	/* 1:Successful, 0:Timeout */
 {
 	//debug("*** enter select()\n");
-	if (drv == 0)
+	if (drv == 0) {
+#ifdef SD_CS_0_IN
+		SD_CS_0 = 1;
+		SD_CS_0_DDR = 1;
+#endif
 		SD_CS_0 = 0;
-	else {
-#ifndef SD_CD_1
+	} else {
+#ifdef SD_CS_1_IN
 		SD_CS_1 = 1;
 		SD_CS_1_DDR = 1;
 #endif