1 files changed, 93 insertions, 0 deletions
diff --git a/os/fs/fatfs/fatfs_fsimpl.cpp b/os/fs/fatfs/fatfs_fsimpl.cpp
new file mode 100644
index 000000000..8c9fd73c7
--- /dev/null
+++ b/os/fs/fatfs/fatfs_fsimpl.cpp
@@ -0,0 +1,93 @@
+/*
+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
+                 2011,2012 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/>.
+*/
+/**
+ * @file    fs_fatfs_impl.cpp
+ * @brief   FatFS file system wrapper.
+ *
+ * @addtogroup fs_fatfs_wrapper
+ * @{
+ */
+
+#include "ch.hpp"
+#include "fs.hpp"
+#include "fatfs_fsimpl.hpp"
+#include "hal.h"
+
+#define MSG_TERMINATE                   (msg_t)0
+
+#define ERR_OK                          (msg_t)0
+#define ERR_TERMINATING                 (msg_t)1
+#define ERR_UNKNOWN_MSG                 (msg_t)2
+
+/**
+ * @brief   FatFS wrapper-related classes and interfaces.
+ */
+namespace chibios_fatfs {
+
+  /*------------------------------------------------------------------------*
+   * chibios_fatfs::FatFSWrapper::FatFSServerThread                         *
+   *------------------------------------------------------------------------*/
+  FatFSWrapper::FatFSServerThread::FatFSServerThread(::BaseBlockDevice *blkdev) :
+      BaseStaticThread<FATFS_THREAD_STACK_SIZE>(),
+      blkdev(blkdev) {
+
+    start(FATFS_THREAD_PRIORITY);
+  }
+
+  FatFSWrapper::FatFSServerThread::~FatFSServerThread() {
+
+    sendMessage(MSG_TERMINATE);
+    wait();
+  }
+
+  msg_t FatFSWrapper::FatFSServerThread::main() {
+    msg_t sts;
+
+    /* Synchronous messages processing loop.*/
+    while (true) {
+      ThreadReference tr = waitMessage();
+      msg_t msg = tr.getMessage();
+      switch (msg) {
+      case MSG_TERMINATE:
+        /* The server object is being destroyed, terminating.*/
+        tr.releaseMessage(ERR_TERMINATING);
+        return 0;
+      default:
+        sts = ERR_UNKNOWN_MSG;
+      }
+      tr.releaseMessage(sts);
+    }
+  }
+
+  /*------------------------------------------------------------------------*
+   * chibios_fatfs::FatFSWrapper                                           *
+   *------------------------------------------------------------------------*/
+  FatFSWrapper::FatFSWrapper(::BaseBlockDevice *blkdev) : server(blkdev) {
+
+    server.start(FATFS_THREAD_PRIORITY);
+  }
+
+  FatFSWrapper::~FatFSWrapper() {
+
+    server.~FatFSServerThread();
+  }
+}
+
+/** @} */