ChibiOS 2.6.8, until I can figure out where to get it from git.

2026-09-11 09:09:29 +00:00 · 2015-07-08 08:40:23 -07:00
parent dc6fee8370
commit e1eea8e08a
1929 changed files with 575326 additions and 0 deletions
@@ -0,0 +1,121 @@
+/*
+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
+                 2011,2012,2013 Giovanni Di Sirio.
+
+    This file is part of ChibiOS/RT.
+
+    ChibiOS/RT is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 3 of the License, or
+    (at your option) any later version.
+
+    ChibiOS/RT is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http://www.gnu.org/licenses/>.
+
+                                      ---
+
+    A special exception to the GPL can be applied should you wish to distribute
+    a combined work that includes ChibiOS/RT, without being obliged to provide
+    the source code for any proprietary components. See the file exception.txt
+    for full details of how and when the exception can be applied.
+*/
+
+/**
+ * @file    mmcsd.c
+ * @brief   MMC/SD cards common code.
+ *
+ * @addtogroup MMCSD
+ * @{
+ */
+
+#include "ch.h"
+#include "hal.h"
+
+#if HAL_USE_MMC_SPI || HAL_USE_SDC || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver local definitions.                                                 */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported variables.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local variables and types.                                         */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local functions.                                                   */
+/*===========================================================================*/
+
+/**
+ * @brief   Gets a bit field from a words array.
+ * @note    The bit zero is the LSb of the first word.
+ *
+ * @param[in] data      pointer to the words array
+ * @param[in] end       bit offset of the last bit of the field, inclusive
+ * @param[in] start     bit offset of the first bit of the field, inclusive
+ *
+ * @return              The bits field value, left aligned.
+ *
+ * @notapi
+ */
+static uint32_t mmcsd_get_slice(uint32_t *data, uint32_t end, uint32_t start) {
+  unsigned startidx, endidx, startoff;
+  uint32_t endmask;
+
+  chDbgCheck((end >= start) && ((end - start) < 32), "mmcsd_get_slice");
+
+  startidx = start / 32;
+  startoff = start % 32;
+  endidx   = end / 32;
+  endmask  = (1 << ((end % 32) + 1)) - 1;
+
+  /* One or two pieces?*/
+  if (startidx < endidx)
+    return (data[startidx] >> startoff) |               /* Two pieces case. */
+           ((data[endidx] & endmask) << (32 - startoff));
+  return (data[startidx] & endmask) >> startoff;        /* One piece case.  */
+}
+
+/*===========================================================================*/
+/* Driver exported functions.                                                */
+/*===========================================================================*/
+
+/**
+ * @brief   Extract card capacity from a CSD.
+ * @details The capacity is returned as number of available blocks.
+ *
+ * @param[in] csd       the CSD record
+ *
+ * @return              The card capacity.
+ * @retval 0            CSD format error
+ */
+uint32_t mmcsdGetCapacity(uint32_t csd[4]) {
+
+  switch (csd[3] >> 30) {
+  uint32_t a, b, c;
+  case 0:
+    /* CSD version 1.0 */
+    a = mmcsd_get_slice(csd, MMCSD_CSD_10_C_SIZE_SLICE);
+    b = mmcsd_get_slice(csd, MMCSD_CSD_10_C_SIZE_MULT_SLICE);
+    c = mmcsd_get_slice(csd, MMCSD_CSD_10_READ_BL_LEN_SLICE);
+    return (a + 1) << (b + 2) << (c - 9);       /* 2^9 == MMCSD_BLOCK_SIZE. */
+  case 1:
+    /* CSD version 2.0.*/
+    return 1024 * (mmcsd_get_slice(csd, MMCSD_CSD_20_C_SIZE_SLICE) + 1);
+  default:
+    /* Reserved value detected.*/
+    return 0;
+  }
+}
+
+#endif /* HAL_USE_MMC_SPI || HAL_USE_SDC */
+
+/** @} */