Mbed project to control a hoverboard

Dependencies:   mbed wave_player Servo 4DGL-uLCD-SE LSM9DS1_Library_cal HC_SR04_Ultrasonic_Library

Committer:
msafwan3
Date:
Wed Apr 29 22:42:25 2020 +0000
Revision:
3:bf0c46975248
Parent:
0:808403b99108
removed rtos

Who changed what in which revision?

UserRevisionLine numberNew contents of line
msafwan3 0:808403b99108 1 /* mbed Microcontroller Library
msafwan3 0:808403b99108 2 * Copyright (c) 2006-2012 ARM Limited
msafwan3 0:808403b99108 3 *
msafwan3 0:808403b99108 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
msafwan3 0:808403b99108 5 * of this software and associated documentation files (the "Software"), to deal
msafwan3 0:808403b99108 6 * in the Software without restriction, including without limitation the rights
msafwan3 0:808403b99108 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
msafwan3 0:808403b99108 8 * copies of the Software, and to permit persons to whom the Software is
msafwan3 0:808403b99108 9 * furnished to do so, subject to the following conditions:
msafwan3 0:808403b99108 10 *
msafwan3 0:808403b99108 11 * The above copyright notice and this permission notice shall be included in
msafwan3 0:808403b99108 12 * all copies or substantial portions of the Software.
msafwan3 0:808403b99108 13 *
msafwan3 0:808403b99108 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
msafwan3 0:808403b99108 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
msafwan3 0:808403b99108 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
msafwan3 0:808403b99108 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
msafwan3 0:808403b99108 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
msafwan3 0:808403b99108 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
msafwan3 0:808403b99108 20 * SOFTWARE.
msafwan3 0:808403b99108 21 */
msafwan3 0:808403b99108 22 #include "mbed.h"
msafwan3 0:808403b99108 23
msafwan3 0:808403b99108 24 #include "ffconf.h"
msafwan3 0:808403b99108 25 #include "mbed_debug.h"
msafwan3 0:808403b99108 26
msafwan3 0:808403b99108 27 #include "FATFileSystem.h"
msafwan3 0:808403b99108 28 #include "FATFileHandle.h"
msafwan3 0:808403b99108 29 #include "FATDirHandle.h"
msafwan3 0:808403b99108 30
msafwan3 0:808403b99108 31 DWORD get_fattime(void) {
msafwan3 0:808403b99108 32 time_t rawtime;
msafwan3 0:808403b99108 33 time(&rawtime);
msafwan3 0:808403b99108 34 struct tm *ptm = localtime(&rawtime);
msafwan3 0:808403b99108 35 return (DWORD)(ptm->tm_year - 80) << 25
msafwan3 0:808403b99108 36 | (DWORD)(ptm->tm_mon + 1 ) << 21
msafwan3 0:808403b99108 37 | (DWORD)(ptm->tm_mday ) << 16
msafwan3 0:808403b99108 38 | (DWORD)(ptm->tm_hour ) << 11
msafwan3 0:808403b99108 39 | (DWORD)(ptm->tm_min ) << 5
msafwan3 0:808403b99108 40 | (DWORD)(ptm->tm_sec/2 );
msafwan3 0:808403b99108 41 }
msafwan3 0:808403b99108 42
msafwan3 0:808403b99108 43 FATFileSystem *FATFileSystem::_ffs[_VOLUMES] = {0};
msafwan3 0:808403b99108 44
msafwan3 0:808403b99108 45 FATFileSystem::FATFileSystem(const char* n) : FileSystemLike(n) {
msafwan3 0:808403b99108 46 debug_if(FFS_DBG, "FATFileSystem(%s)\n", n);
msafwan3 0:808403b99108 47 for(int i=0; i<_VOLUMES; i++) {
msafwan3 0:808403b99108 48 if(_ffs[i] == 0) {
msafwan3 0:808403b99108 49 _ffs[i] = this;
msafwan3 0:808403b99108 50 _fsid = i;
msafwan3 0:808403b99108 51 debug_if(FFS_DBG, "Mounting [%s] on ffs drive [%d]\n", _name, _fsid);
msafwan3 0:808403b99108 52 f_mount(i, &_fs);
msafwan3 0:808403b99108 53 return;
msafwan3 0:808403b99108 54 }
msafwan3 0:808403b99108 55 }
msafwan3 0:808403b99108 56 error("Couldn't create %s in FATFileSystem::FATFileSystem\n", n);
msafwan3 0:808403b99108 57 }
msafwan3 0:808403b99108 58
msafwan3 0:808403b99108 59 FATFileSystem::~FATFileSystem() {
msafwan3 0:808403b99108 60 for (int i=0; i<_VOLUMES; i++) {
msafwan3 0:808403b99108 61 if (_ffs[i] == this) {
msafwan3 0:808403b99108 62 _ffs[i] = 0;
msafwan3 0:808403b99108 63 f_mount(i, NULL);
msafwan3 0:808403b99108 64 }
msafwan3 0:808403b99108 65 }
msafwan3 0:808403b99108 66 }
msafwan3 0:808403b99108 67
msafwan3 0:808403b99108 68 FileHandle *FATFileSystem::open(const char* name, int flags) {
msafwan3 0:808403b99108 69 debug_if(FFS_DBG, "open(%s) on filesystem [%s], drv [%d]\n", name, _name, _fsid);
msafwan3 0:808403b99108 70 char n[64];
msafwan3 0:808403b99108 71 sprintf(n, "%d:/%s", _fsid, name);
msafwan3 0:808403b99108 72
msafwan3 0:808403b99108 73 /* POSIX flags -> FatFS open mode */
msafwan3 0:808403b99108 74 BYTE openmode;
msafwan3 0:808403b99108 75 if (flags & O_RDWR) {
msafwan3 0:808403b99108 76 openmode = FA_READ|FA_WRITE;
msafwan3 0:808403b99108 77 } else if(flags & O_WRONLY) {
msafwan3 0:808403b99108 78 openmode = FA_WRITE;
msafwan3 0:808403b99108 79 } else {
msafwan3 0:808403b99108 80 openmode = FA_READ;
msafwan3 0:808403b99108 81 }
msafwan3 0:808403b99108 82 if(flags & O_CREAT) {
msafwan3 0:808403b99108 83 if(flags & O_TRUNC) {
msafwan3 0:808403b99108 84 openmode |= FA_CREATE_ALWAYS;
msafwan3 0:808403b99108 85 } else {
msafwan3 0:808403b99108 86 openmode |= FA_OPEN_ALWAYS;
msafwan3 0:808403b99108 87 }
msafwan3 0:808403b99108 88 }
msafwan3 0:808403b99108 89
msafwan3 0:808403b99108 90 FIL fh;
msafwan3 0:808403b99108 91 FRESULT res = f_open(&fh, n, openmode);
msafwan3 0:808403b99108 92 if (res) {
msafwan3 0:808403b99108 93 debug_if(FFS_DBG, "f_open('w') failed: %d\n", res);
msafwan3 0:808403b99108 94 return NULL;
msafwan3 0:808403b99108 95 }
msafwan3 0:808403b99108 96 if (flags & O_APPEND) {
msafwan3 0:808403b99108 97 f_lseek(&fh, fh.fsize);
msafwan3 0:808403b99108 98 }
msafwan3 0:808403b99108 99 return new FATFileHandle(fh);
msafwan3 0:808403b99108 100 }
msafwan3 0:808403b99108 101
msafwan3 0:808403b99108 102 int FATFileSystem::remove(const char *filename) {
msafwan3 0:808403b99108 103 FRESULT res = f_unlink(filename);
msafwan3 0:808403b99108 104 if (res) {
msafwan3 0:808403b99108 105 debug_if(FFS_DBG, "f_unlink() failed: %d\n", res);
msafwan3 0:808403b99108 106 return -1;
msafwan3 0:808403b99108 107 }
msafwan3 0:808403b99108 108 return 0;
msafwan3 0:808403b99108 109 }
msafwan3 0:808403b99108 110
msafwan3 0:808403b99108 111 int FATFileSystem::format() {
msafwan3 0:808403b99108 112 FRESULT res = f_mkfs(_fsid, 0, 512); // Logical drive number, Partitioning rule, Allocation unit size (bytes per cluster)
msafwan3 0:808403b99108 113 if (res) {
msafwan3 0:808403b99108 114 debug_if(FFS_DBG, "f_mkfs() failed: %d\n", res);
msafwan3 0:808403b99108 115 return -1;
msafwan3 0:808403b99108 116 }
msafwan3 0:808403b99108 117 return 0;
msafwan3 0:808403b99108 118 }
msafwan3 0:808403b99108 119
msafwan3 0:808403b99108 120 DirHandle *FATFileSystem::opendir(const char *name) {
msafwan3 0:808403b99108 121 FATFS_DIR dir;
msafwan3 0:808403b99108 122 FRESULT res = f_opendir(&dir, name);
msafwan3 0:808403b99108 123 if (res != 0) {
msafwan3 0:808403b99108 124 return NULL;
msafwan3 0:808403b99108 125 }
msafwan3 0:808403b99108 126 return new FATDirHandle(dir);
msafwan3 0:808403b99108 127 }
msafwan3 0:808403b99108 128
msafwan3 0:808403b99108 129 int FATFileSystem::mkdir(const char *name, mode_t mode) {
msafwan3 0:808403b99108 130 FRESULT res = f_mkdir(name);
msafwan3 0:808403b99108 131 return res == 0 ? 0 : -1;
msafwan3 0:808403b99108 132 }