lfs.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935
  1. /*
  2. * The little filesystem
  3. *
  4. * Copyright (c) 2017 Christopher Haster
  5. * Distributed under the MIT license
  6. */
  7. #include "lfs.h"
  8. #include "lfs_util.h"
  9. #include <string.h>
  10. #include <stdbool.h>
  11. /// Block device operations ///
  12. static int lfs_bd_info(lfs_t *lfs, struct lfs_bd_info *info) {
  13. return lfs->bd_ops->info(lfs->bd, info);
  14. }
  15. static int lfs_bd_read(lfs_t *lfs, lfs_block_t block,
  16. lfs_off_t off, lfs_size_t size, void *buffer) {
  17. return lfs->bd_ops->read(lfs->bd, block, off, size, buffer);
  18. }
  19. static int lfs_bd_prog(lfs_t *lfs, lfs_block_t block,
  20. lfs_off_t off, lfs_size_t size, const void *buffer) {
  21. return lfs->bd_ops->prog(lfs->bd, block, off, size, buffer);
  22. }
  23. static int lfs_bd_erase(lfs_t *lfs, lfs_block_t block,
  24. lfs_off_t off, lfs_size_t size) {
  25. return lfs->bd_ops->erase(lfs->bd, block, off, size);
  26. }
  27. static int lfs_bd_sync(lfs_t *lfs) {
  28. return lfs->bd_ops->sync(lfs->bd);
  29. }
  30. static int lfs_bd_cmp(lfs_t *lfs, lfs_block_t block,
  31. lfs_off_t off, lfs_size_t size, const void *buffer) {
  32. const uint8_t *data = buffer;
  33. for (lfs_off_t i = 0; i < size; i++) {
  34. uint8_t c;
  35. int err = lfs_bd_read(lfs, block, off+i, 1, &c);
  36. if (err) {
  37. return err;
  38. }
  39. if (c != *data) {
  40. return false;
  41. }
  42. data += 1;
  43. }
  44. return true;
  45. }
  46. static int lfs_bd_crc(lfs_t *lfs, lfs_block_t block,
  47. lfs_off_t off, lfs_size_t size, uint32_t *crc) {
  48. while (off < size) {
  49. uint8_t c;
  50. int err = lfs_bd_read(lfs, block, off, 1, &c);
  51. if (err) {
  52. return err;
  53. }
  54. *crc = lfs_crc(&c, 1, *crc);
  55. off += 1;
  56. }
  57. return 0;
  58. }
  59. /// Block allocator ///
  60. static int lfs_alloc(lfs_t *lfs, lfs_block_t *block) {
  61. if (lfs->free.begin != lfs->free.end) {
  62. *block = lfs->free.begin;
  63. lfs->free.begin += 1;
  64. return 0;
  65. }
  66. // TODO find next stride of free blocks
  67. // TODO verify no strides exist where begin > current begin
  68. // note: begin = 0 is invalid (superblock)
  69. return LFS_ERROR_NO_SPACE;
  70. }
  71. static int lfs_alloc_erased(lfs_t *lfs, lfs_block_t *block) {
  72. int err = lfs_alloc(lfs, block);
  73. if (err) {
  74. return err;
  75. }
  76. return lfs_bd_erase(lfs, *block, 0, lfs->block_size);
  77. }
  78. /// Index list operations ///
  79. // Next index offset
  80. static lfs_off_t lfs_index_next(lfs_t *lfs, lfs_off_t ioff) {
  81. ioff += 1;
  82. while (ioff % lfs->words == 0) {
  83. ioff += lfs_min(lfs_ctz(ioff/lfs->words + 1), lfs->words-1) + 1;
  84. }
  85. return ioff;
  86. }
  87. static lfs_off_t lfs_toindex(lfs_t *lfs, lfs_off_t off) {
  88. lfs_off_t i = 0;
  89. while (off > lfs->block_size) {
  90. i = lfs_index_next(lfs, i);
  91. off -= lfs->block_size;
  92. }
  93. return i;
  94. }
  95. // Find index in index chain given its index offset
  96. static int lfs_index_find(lfs_t *lfs, lfs_block_t head,
  97. lfs_size_t icount, lfs_off_t ioff, lfs_block_t *block) {
  98. lfs_off_t iitarget = ioff / lfs->words;
  99. lfs_off_t iicurrent = (icount-1) / lfs->words;
  100. while (iitarget != iicurrent) {
  101. lfs_size_t skip = lfs_min(
  102. lfs_min(lfs_ctz(iicurrent+1), lfs->words-1),
  103. lfs_npw2((iitarget ^ iicurrent)+1)-1);
  104. int err = lfs_bd_read(lfs, head, 4*skip, 4, &head);
  105. if (err) {
  106. return err;
  107. }
  108. iicurrent -= 1 << skip;
  109. }
  110. return lfs_bd_read(lfs, head, 4*(ioff % lfs->words), 4, block);
  111. }
  112. // Append index to index chain, updates head and icount
  113. static int lfs_index_append(lfs_t *lfs, lfs_block_t *headp,
  114. lfs_size_t *icountp, lfs_block_t block) {
  115. lfs_block_t head = *headp;
  116. lfs_size_t ioff = *icountp - 1;
  117. ioff += 1;
  118. while (ioff % lfs->words == 0) {
  119. lfs_block_t nhead;
  120. int err = lfs_alloc_erased(lfs, &nhead);
  121. if (err) {
  122. return err;
  123. }
  124. lfs_off_t skips = lfs_min(
  125. lfs_ctz(ioff/lfs->words + 1), lfs->words-2) + 1;
  126. for (lfs_off_t i = 0; i < skips; i++) {
  127. err = lfs_bd_prog(lfs, nhead, 4*i, 4, &head);
  128. if (err) {
  129. return err;
  130. }
  131. if (head && i != skips-1) {
  132. err = lfs_bd_read(lfs, head, 4*i, 4, &head);
  133. if (err) {
  134. return err;
  135. }
  136. }
  137. }
  138. ioff += skips;
  139. head = nhead;
  140. }
  141. int err = lfs_bd_prog(lfs, head, 4*(ioff % lfs->words), 4, &block);
  142. if (err) {
  143. return err;
  144. }
  145. *headp = head;
  146. *icountp = ioff + 1;
  147. return 0;
  148. }
  149. /// Metadata pair operations ///
  150. static inline void lfs_swap(lfs_block_t pair[2]) {
  151. lfs_block_t t = pair[0];
  152. pair[0] = pair[1];
  153. pair[1] = t;
  154. }
  155. struct lfs_fetch_region {
  156. lfs_off_t off;
  157. lfs_size_t size;
  158. void *data;
  159. };
  160. static int lfs_pair_fetch(lfs_t *lfs, lfs_block_t pair[2],
  161. int count, const struct lfs_fetch_region *regions) {
  162. int checked = 0;
  163. int rev = 0;
  164. for (int i = 0; i < 2; i++) {
  165. uint32_t nrev;
  166. int err = lfs_bd_read(lfs, pair[1], 0, 4, &nrev);
  167. if (err) {
  168. return err;
  169. }
  170. if (checked > 0 && lfs_scmp(nrev, rev) < 0) {
  171. continue;
  172. }
  173. uint32_t crc = 0xffffffff;
  174. err = lfs_bd_crc(lfs, pair[1], 0, lfs->block_size, &crc);
  175. if (err) {
  176. return err;
  177. }
  178. if (crc != 0) {
  179. lfs_swap(pair);
  180. }
  181. checked += 1;
  182. rev = nrev;
  183. lfs_swap(pair);
  184. }
  185. if (checked == 0) {
  186. LFS_ERROR("Corrupted metadata pair at %d %d", pair[0], pair[1]);
  187. return LFS_ERROR_CORRUPT;
  188. }
  189. for (int i = 0; i < count; i++) {
  190. int err = lfs_bd_read(lfs, pair[0],
  191. regions[i].off, regions[i].size, regions[i].data);
  192. if (err) {
  193. return err;
  194. }
  195. }
  196. return 0;
  197. }
  198. struct lfs_commit_region {
  199. lfs_off_t off;
  200. lfs_size_t size;
  201. const void *data;
  202. };
  203. static int lfs_pair_commit(lfs_t *lfs, lfs_block_t pair[2],
  204. int count, const struct lfs_commit_region *regions) {
  205. uint32_t crc = 0xffffffff;
  206. int err = lfs_bd_erase(lfs, pair[1], 0, lfs->block_size);
  207. if (err) {
  208. return err;
  209. }
  210. lfs_off_t off = 0;
  211. while (off < lfs->block_size - 4) {
  212. if (count > 0 && regions[0].off == off) {
  213. crc = lfs_crc(regions[0].data, regions[0].size, crc);
  214. int err = lfs_bd_prog(lfs, pair[1],
  215. off, regions[0].size, regions[0].data);
  216. if (err) {
  217. return err;
  218. }
  219. off += regions[0].size;
  220. count -= 1;
  221. regions += 1;
  222. } else {
  223. // TODO faster strides?
  224. uint8_t data;
  225. int err = lfs_bd_read(lfs, pair[0], off, 1, &data);
  226. if (err) {
  227. return err;
  228. }
  229. crc = lfs_crc((void*)&data, 1, crc);
  230. err = lfs_bd_prog(lfs, pair[1], off, 1, &data);
  231. if (err) {
  232. return err;
  233. }
  234. off += 1;
  235. }
  236. }
  237. err = lfs_bd_prog(lfs, pair[1], lfs->block_size-4, 4, &crc);
  238. if (err) {
  239. return err;
  240. }
  241. err = lfs_bd_sync(lfs);
  242. if (err) {
  243. return err;
  244. }
  245. lfs_swap(pair);
  246. return 0;
  247. }
  248. /// Directory operations ///
  249. static int lfs_dir_alloc(lfs_t *lfs, lfs_dir_t *dir, lfs_block_t parent[2]) {
  250. // Allocate pair of dir blocks
  251. for (int i = 0; i < 2; i++) {
  252. int err = lfs_alloc(lfs, &dir->pair[i]);
  253. if (err) {
  254. return err;
  255. }
  256. }
  257. // Rather than clobbering one of the blocks we just pretend
  258. // the revision may be valid
  259. int err = lfs_bd_read(lfs, dir->pair[0], 0, 4, &dir->d.rev);
  260. if (err) {
  261. return err;
  262. }
  263. dir->d.rev += 1;
  264. // Calculate total size
  265. dir->d.size = sizeof(dir->d);
  266. dir->off = sizeof(dir->d);
  267. // Other defaults
  268. dir->d.tail[0] = 0;
  269. dir->d.tail[1] = 0;
  270. dir->d.free = lfs->free;
  271. // Write out to memory
  272. if (!parent) {
  273. return lfs_pair_commit(lfs, dir->pair,
  274. 1, (struct lfs_commit_region[]){
  275. {0, sizeof(dir->d), &dir->d}
  276. });
  277. } else {
  278. dir->d.size += 2*sizeof(struct lfs_disk_entry) + 3;
  279. return lfs_pair_commit(lfs, dir->pair,
  280. 5, (struct lfs_commit_region[]){
  281. {0, sizeof(dir->d), &dir->d},
  282. {sizeof(dir->d), sizeof(struct lfs_disk_entry),
  283. &(struct lfs_disk_entry){
  284. .type = LFS_TYPE_DIR,
  285. .len = sizeof(struct lfs_disk_entry)+1,
  286. .u.dir[0] = dir->pair[0],
  287. .u.dir[1] = dir->pair[1],
  288. }},
  289. {sizeof(dir->d)+sizeof(struct lfs_disk_entry), 1, "."},
  290. {sizeof(dir->d)+sizeof(struct lfs_disk_entry)+1,
  291. sizeof(struct lfs_disk_entry),
  292. &(struct lfs_disk_entry){
  293. .type = LFS_TYPE_DIR,
  294. .len = sizeof(struct lfs_disk_entry)+2,
  295. .u.dir[0] = parent[0] ? parent[0] : dir->pair[0],
  296. .u.dir[1] = parent[1] ? parent[1] : dir->pair[1],
  297. }},
  298. {sizeof(dir->d)+2*sizeof(struct lfs_disk_entry)+1, 2, ".."},
  299. });
  300. }
  301. }
  302. static int lfs_dir_fetch(lfs_t *lfs, lfs_dir_t *dir, lfs_block_t pair[2]) {
  303. dir->pair[0] = pair[0];
  304. dir->pair[1] = pair[1];
  305. dir->off = sizeof(dir->d);
  306. return lfs_pair_fetch(lfs, dir->pair,
  307. 1, (struct lfs_fetch_region[1]) {
  308. {0, sizeof(dir->d), &dir->d}
  309. });
  310. }
  311. static int lfs_dir_next(lfs_t *lfs, lfs_dir_t *dir, lfs_entry_t *entry) {
  312. while (true) {
  313. if (dir->d.size - dir->off < sizeof(entry->d)) {
  314. if (!dir->d.tail[0]) {
  315. entry->dir[0] = dir->pair[0];
  316. entry->dir[1] = dir->pair[1];
  317. entry->off = dir->off;
  318. return LFS_ERROR_NO_ENTRY;
  319. }
  320. int err = lfs_dir_fetch(lfs, dir, dir->d.tail);
  321. if (err) {
  322. return err;
  323. }
  324. dir->off = sizeof(dir->d);
  325. }
  326. int err = lfs_bd_read(lfs, dir->pair[0], dir->off,
  327. sizeof(entry->d), &entry->d);
  328. if (err) {
  329. return err;
  330. }
  331. dir->off += entry->d.len;
  332. if (entry->d.type == LFS_TYPE_REG || entry->d.type == LFS_TYPE_DIR) {
  333. entry->dir[0] = dir->pair[0];
  334. entry->dir[1] = dir->pair[1];
  335. entry->off = dir->off - entry->d.len;
  336. return 0;
  337. }
  338. }
  339. }
  340. static int lfs_dir_find(lfs_t *lfs, lfs_dir_t *dir,
  341. const char **path, lfs_entry_t *entry) {
  342. while (true) {
  343. const char *pathname = *path;
  344. lfs_size_t pathlen = strcspn(pathname, "/");
  345. while (true) {
  346. int err = lfs_dir_next(lfs, dir, entry);
  347. if (err) {
  348. return err;
  349. }
  350. if (entry->d.len - sizeof(entry->d) != pathlen) {
  351. continue;
  352. }
  353. int ret = lfs_bd_cmp(lfs, entry->dir[0],
  354. entry->off + sizeof(entry->d), pathlen, pathname);
  355. if (ret < 0) {
  356. return ret;
  357. }
  358. // Found match
  359. if (ret == true) {
  360. break;
  361. }
  362. }
  363. pathname += pathlen;
  364. pathname += strspn(pathname, "/");
  365. if (pathname[0] == '\0') {
  366. return 0;
  367. }
  368. if (entry->d.type != LFS_TYPE_DIR) {
  369. return LFS_ERROR_NOT_DIR;
  370. }
  371. int err = lfs_dir_fetch(lfs, dir, entry->d.u.dir);
  372. if (err) {
  373. return err;
  374. }
  375. *path = pathname;
  376. }
  377. return 0;
  378. }
  379. static int lfs_dir_append(lfs_t *lfs, lfs_dir_t *dir,
  380. const char **path, lfs_entry_t *entry) {
  381. int err = lfs_dir_find(lfs, dir, path, entry);
  382. if (err != LFS_ERROR_NO_ENTRY) {
  383. return err ? err : LFS_ERROR_EXISTS;
  384. }
  385. // Check if we fit
  386. if (dir->d.size + sizeof(entry->d) + strlen(*path) > lfs->block_size - 4) {
  387. lfs_dir_t olddir;
  388. memcpy(&olddir, dir, sizeof(olddir));
  389. int err = lfs_dir_alloc(lfs, dir, 0);
  390. if (err) {
  391. return err;
  392. }
  393. entry->dir[0] = dir->pair[0];
  394. entry->dir[1] = dir->pair[1];
  395. entry->off = dir->off;
  396. olddir.d.rev += 1;
  397. olddir.d.tail[0] = dir->pair[0];
  398. olddir.d.tail[1] = dir->pair[1];
  399. olddir.d.free = lfs->free;
  400. return lfs_pair_commit(lfs, olddir.pair,
  401. 1, (struct lfs_commit_region[]){
  402. {0, sizeof(olddir.d), &olddir.d}
  403. });
  404. }
  405. return 0;
  406. }
  407. int lfs_mkdir(lfs_t *lfs, const char *path) {
  408. // Allocate entry for directory
  409. lfs_dir_t cwd;
  410. int err = lfs_dir_fetch(lfs, &cwd, lfs->cwd);
  411. if (err) {
  412. return err;
  413. }
  414. lfs_entry_t entry;
  415. err = lfs_dir_append(lfs, &cwd, &path, &entry);
  416. if (err) {
  417. return err;
  418. }
  419. // Build up new directory
  420. lfs_dir_t dir;
  421. err = lfs_dir_alloc(lfs, &dir, cwd.pair);
  422. if (err) {
  423. return err;
  424. }
  425. entry.d.type = LFS_TYPE_DIR;
  426. entry.d.len = sizeof(entry.d) + strlen(path);
  427. entry.d.u.dir[0] = dir.pair[0];
  428. entry.d.u.dir[1] = dir.pair[1];
  429. cwd.d.rev += 1;
  430. cwd.d.size += entry.d.len;
  431. cwd.d.free = lfs->free;
  432. return lfs_pair_commit(lfs, entry.dir,
  433. 3, (struct lfs_commit_region[3]) {
  434. {0, sizeof(cwd.d), &cwd.d},
  435. {entry.off, sizeof(entry.d), &entry.d},
  436. {entry.off+sizeof(entry.d), entry.d.len - sizeof(entry.d), path}
  437. });
  438. }
  439. int lfs_dir_open(lfs_t *lfs, lfs_dir_t *dir, const char *path) {
  440. if (path[0] == '/') {
  441. dir->pair[0] = lfs->root[0];
  442. dir->pair[1] = lfs->root[1];
  443. } else {
  444. dir->pair[0] = lfs->cwd[0];
  445. dir->pair[1] = lfs->cwd[1];
  446. }
  447. int err = lfs_dir_fetch(lfs, dir, dir->pair);
  448. if (err) {
  449. return err;
  450. } else if (strcmp(path, "/") == 0) {
  451. return 0;
  452. }
  453. lfs_entry_t entry;
  454. err = lfs_dir_find(lfs, dir, &path, &entry);
  455. if (err) {
  456. return err;
  457. } else if (entry.d.type != LFS_TYPE_DIR) {
  458. return LFS_ERROR_NOT_DIR;
  459. }
  460. return lfs_dir_fetch(lfs, dir, entry.d.u.dir);
  461. }
  462. int lfs_dir_close(lfs_t *lfs, lfs_dir_t *dir) {
  463. // Do nothing, dir is always synchronized
  464. return 0;
  465. }
  466. int lfs_dir_read(lfs_t *lfs, lfs_dir_t *dir, struct lfs_info *info) {
  467. memset(info, 0, sizeof(*info));
  468. lfs_entry_t entry;
  469. int err = lfs_dir_next(lfs, dir, &entry);
  470. if (err) {
  471. return (err == LFS_ERROR_NO_ENTRY) ? 0 : err;
  472. }
  473. info->type = entry.d.type & 0xff;
  474. if (info->type == LFS_TYPE_REG) {
  475. info->size = entry.d.u.file.size;
  476. }
  477. err = lfs_bd_read(lfs, entry.dir[0], entry.off + sizeof(entry.d),
  478. entry.d.len - sizeof(entry.d), info->name);
  479. if (err) {
  480. return err;
  481. }
  482. return 1;
  483. }
  484. /// File operations ///
  485. int lfs_file_open(lfs_t *lfs, lfs_file_t *file,
  486. const char *path, int flags) {
  487. // Allocate entry for file if it doesn't exist
  488. // TODO check open files
  489. lfs_dir_t cwd;
  490. int err = lfs_dir_fetch(lfs, &cwd, lfs->cwd);
  491. if (err) {
  492. return err;
  493. }
  494. if (flags & LFS_O_CREAT) {
  495. err = lfs_dir_append(lfs, &cwd, &path, &file->entry);
  496. if (err && err != LFS_ERROR_EXISTS) {
  497. return err;
  498. }
  499. } else {
  500. err = lfs_dir_find(lfs, &cwd, &path, &file->entry);
  501. if (err) {
  502. return err;
  503. }
  504. }
  505. if ((flags & LFS_O_CREAT) && err != LFS_ERROR_EXISTS) {
  506. // Store file
  507. file->head = 0;
  508. file->size = 0;
  509. file->wblock = 0;
  510. file->windex = 0;
  511. file->rblock = 0;
  512. file->rindex = 0;
  513. file->roff = 0;
  514. file->entry.d.type = 1;
  515. file->entry.d.len = sizeof(file->entry.d) + strlen(path);
  516. file->entry.d.u.file.head = file->head;
  517. file->entry.d.u.file.size = file->size;
  518. cwd.d.rev += 1;
  519. cwd.d.size += file->entry.d.len;
  520. cwd.d.free = lfs->free;
  521. return lfs_pair_commit(lfs, file->entry.dir,
  522. 3, (struct lfs_commit_region[3]) {
  523. {0, sizeof(cwd.d), &cwd.d},
  524. {file->entry.off,
  525. sizeof(file->entry.d),
  526. &file->entry.d},
  527. {file->entry.off+sizeof(file->entry.d),
  528. file->entry.d.len-sizeof(file->entry.d),
  529. path}
  530. });
  531. } else if (file->entry.d.type == LFS_TYPE_DIR) {
  532. return LFS_ERROR_IS_DIR;
  533. } else {
  534. file->head = file->entry.d.u.file.head;
  535. file->size = file->entry.d.u.file.size;
  536. file->windex = lfs_toindex(lfs, file->size);
  537. file->rblock = 0;
  538. file->rindex = 0;
  539. file->roff = 0;
  540. // TODO do this lazily in write?
  541. // TODO cow the head i/d block
  542. if (file->size < lfs->block_size) {
  543. file->wblock = file->head;
  544. } else {
  545. int err = lfs_index_find(lfs, file->head, file->windex,
  546. file->windex, &file->wblock);
  547. if (err) {
  548. return err;
  549. }
  550. }
  551. return 0;
  552. }
  553. }
  554. int lfs_file_close(lfs_t *lfs, lfs_file_t *file) {
  555. // Store file
  556. lfs_dir_t cwd;
  557. int err = lfs_dir_fetch(lfs, &cwd, file->entry.dir);
  558. if (err) {
  559. return err;
  560. }
  561. file->entry.d.u.file.head = file->head;
  562. file->entry.d.u.file.size = file->size;
  563. cwd.d.rev += 1;
  564. cwd.d.free = lfs->free;
  565. return lfs_pair_commit(lfs, file->entry.dir,
  566. 3, (struct lfs_commit_region[3]) {
  567. {0, sizeof(cwd.d), &cwd.d},
  568. {file->entry.off, sizeof(file->entry.d), &file->entry.d},
  569. });
  570. }
  571. lfs_ssize_t lfs_file_write(lfs_t *lfs, lfs_file_t *file,
  572. const void *buffer, lfs_size_t size) {
  573. const uint8_t *data = buffer;
  574. lfs_size_t nsize = size;
  575. while (nsize > 0) {
  576. lfs_off_t woff = file->size % lfs->block_size;
  577. if (file->size == 0) {
  578. int err = lfs_alloc_erased(lfs, &file->wblock);
  579. if (err) {
  580. return err;
  581. }
  582. file->head = file->wblock;
  583. file->windex = 0;
  584. } else if (woff == 0) {
  585. int err = lfs_alloc_erased(lfs, &file->wblock);
  586. if (err) {
  587. return err;
  588. }
  589. err = lfs_index_append(lfs, &file->head,
  590. &file->windex, file->wblock);
  591. if (err) {
  592. return err;
  593. }
  594. }
  595. lfs_size_t diff = lfs_min(nsize, lfs->block_size - woff);
  596. int err = lfs_bd_prog(lfs, file->wblock, woff, diff, data);
  597. if (err) {
  598. return err;
  599. }
  600. file->size += diff;
  601. data += diff;
  602. nsize -= diff;
  603. }
  604. return size;
  605. }
  606. lfs_ssize_t lfs_file_read(lfs_t *lfs, lfs_file_t *file,
  607. void *buffer, lfs_size_t size) {
  608. uint8_t *data = buffer;
  609. lfs_size_t nsize = size;
  610. while (nsize > 0 && file->roff < file->size) {
  611. lfs_off_t roff = file->roff % lfs->block_size;
  612. // TODO cache index blocks
  613. if (file->size < lfs->block_size) {
  614. file->rblock = file->head;
  615. } else if (roff == 0) {
  616. int err = lfs_index_find(lfs, file->head, file->windex,
  617. file->rindex, &file->rblock);
  618. if (err) {
  619. return err;
  620. }
  621. file->rindex = lfs_index_next(lfs, file->rindex);
  622. }
  623. lfs_size_t diff = lfs_min(
  624. lfs_min(nsize, file->size-file->roff),
  625. lfs->block_size - roff);
  626. int err = lfs_bd_read(lfs, file->rblock, roff, diff, data);
  627. if (err) {
  628. return err;
  629. }
  630. file->roff += diff;
  631. data += diff;
  632. nsize -= diff;
  633. }
  634. return size - nsize;
  635. }
  636. /// Generic filesystem operations ///
  637. static int lfs_configure(lfs_t *lfs, const struct lfs_config *config) {
  638. lfs->bd = config->bd;
  639. lfs->bd_ops = config->bd_ops;
  640. struct lfs_bd_info info;
  641. int err = lfs_bd_info(lfs, &info);
  642. if (err) {
  643. return err;
  644. }
  645. if (config->read_size) {
  646. if (config->read_size < info.read_size ||
  647. config->read_size % info.read_size != 0) {
  648. LFS_ERROR("Invalid read size %u, device has %u\n",
  649. config->read_size, info.read_size);
  650. return LFS_ERROR_INVALID;
  651. }
  652. lfs->read_size = config->read_size;
  653. } else {
  654. lfs->read_size = info.read_size;
  655. }
  656. if (config->prog_size) {
  657. if (config->prog_size < info.prog_size ||
  658. config->prog_size % info.prog_size != 0) {
  659. LFS_ERROR("Invalid prog size %u, device has %u\n",
  660. config->prog_size, info.prog_size);
  661. return LFS_ERROR_INVALID;
  662. }
  663. lfs->prog_size = config->prog_size;
  664. } else {
  665. lfs->prog_size = info.prog_size;
  666. }
  667. if (config->block_size) {
  668. if (config->block_size < info.erase_size ||
  669. config->block_size % info.erase_size != 0) {
  670. LFS_ERROR("Invalid block size %u, device has %u\n",
  671. config->prog_size, info.prog_size);
  672. return LFS_ERROR_INVALID;
  673. }
  674. lfs->block_size = config->block_size;
  675. } else {
  676. lfs->block_size = lfs_min(512, info.erase_size);
  677. }
  678. if (config->block_count) {
  679. if (config->block_count > info.total_size/info.erase_size) {
  680. LFS_ERROR("Invalid block size %u, device has %u\n",
  681. config->block_size,
  682. (uint32_t)(info.total_size/info.erase_size));
  683. return LFS_ERROR_INVALID;
  684. }
  685. lfs->block_count = config->block_count;
  686. } else {
  687. lfs->block_count = info.total_size / info.erase_size;
  688. }
  689. lfs->words = lfs->block_size / sizeof(uint32_t);
  690. return 0;
  691. }
  692. int lfs_format(lfs_t *lfs, const struct lfs_config *config) {
  693. int err = lfs_configure(lfs, config);
  694. if (err) {
  695. return err;
  696. }
  697. // Create free list
  698. lfs->free.begin = 2;
  699. lfs->free.end = lfs->block_count-1;
  700. // Write root directory
  701. lfs_dir_t root;
  702. err = lfs_dir_alloc(lfs, &root, (lfs_block_t[2]){0, 0});
  703. if (err) {
  704. return err;
  705. }
  706. lfs->root[0] = root.pair[0];
  707. lfs->root[1] = root.pair[1];
  708. lfs->cwd[0] = root.pair[0];
  709. lfs->cwd[1] = root.pair[1];
  710. // Write superblocks
  711. lfs_superblock_t superblock = {
  712. .pair = {0, 1},
  713. .d.rev = 1,
  714. .d.size = sizeof(superblock),
  715. .d.root = {lfs->cwd[0], lfs->cwd[1]},
  716. .d.magic = {"littlefs"},
  717. .d.block_size = lfs->block_size,
  718. .d.block_count = lfs->block_count,
  719. };
  720. for (int i = 0; i < 2; i++) {
  721. int err = lfs_pair_commit(lfs, superblock.pair,
  722. 1, (struct lfs_commit_region[]){
  723. {0, sizeof(superblock.d), &superblock.d}
  724. });
  725. if (err) {
  726. LFS_ERROR("Failed to write superblock at %d", superblock.pair[1]);
  727. return err;
  728. }
  729. uint32_t crc = 0xffffffff;
  730. err = lfs_bd_crc(lfs, superblock.pair[0], 0, lfs->block_size, &crc);
  731. if (err || crc != 0) {
  732. LFS_ERROR("Failed to write superblock at %d", superblock.pair[0]);
  733. return err ? err : LFS_ERROR_CORRUPT;
  734. }
  735. }
  736. return 0;
  737. }
  738. int lfs_mount(lfs_t *lfs, const struct lfs_config *config) {
  739. int err = lfs_configure(lfs, config);
  740. if (err) {
  741. return err;
  742. }
  743. lfs_superblock_t superblock = {
  744. .pair = {0, 1},
  745. };
  746. err = lfs_pair_fetch(lfs, superblock.pair,
  747. 1, (struct lfs_fetch_region[]){
  748. {0, sizeof(superblock.d), &superblock.d}
  749. });
  750. if ((err == LFS_ERROR_CORRUPT ||
  751. memcmp(superblock.d.magic, "littlefs", 8) != 0)) {
  752. LFS_ERROR("Invalid superblock at %d %d",
  753. superblock.pair[0], superblock.pair[1]);
  754. return LFS_ERROR_CORRUPT;
  755. }
  756. lfs->root[0] = superblock.d.root[0];
  757. lfs->root[1] = superblock.d.root[1];
  758. lfs->cwd[0] = superblock.d.root[0];
  759. lfs->cwd[1] = superblock.d.root[1];
  760. // TODO this is wrong, needs to check all dirs
  761. lfs_dir_t dir;
  762. err = lfs_dir_fetch(lfs, &dir, lfs->cwd);
  763. if (err) {
  764. return err;
  765. }
  766. lfs->free.begin = dir.d.free.begin;
  767. lfs->free.end = dir.d.free.end;
  768. return err;
  769. }
  770. int lfs_unmount(lfs_t *lfs) {
  771. // No nothing for now
  772. return 0;
  773. }