lfs.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879
  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_create(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) + 2*sizeof(struct lfs_disk_entry) + 3;
  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. return lfs_pair_commit(lfs, dir->pair,
  273. 5, (struct lfs_commit_region[]){
  274. {0, sizeof(dir->d), &dir->d},
  275. {sizeof(dir->d), sizeof(struct lfs_disk_entry),
  276. &(struct lfs_disk_entry){
  277. .type = LFS_TYPE_DIR,
  278. .len = sizeof(struct lfs_disk_entry)+1,
  279. .u.dir[0] = dir->pair[0],
  280. .u.dir[1] = dir->pair[1],
  281. }},
  282. {sizeof(dir->d)+sizeof(struct lfs_disk_entry), 1, "."},
  283. {sizeof(dir->d)+sizeof(struct lfs_disk_entry)+1,
  284. sizeof(struct lfs_disk_entry),
  285. &(struct lfs_disk_entry){
  286. .type = LFS_TYPE_DIR,
  287. .len = sizeof(struct lfs_disk_entry)+2,
  288. .u.dir[0] = parent ? parent[0] : dir->pair[0],
  289. .u.dir[1] = parent ? parent[1] : dir->pair[1],
  290. }},
  291. {sizeof(dir->d)+2*sizeof(struct lfs_disk_entry)+1, 2, ".."},
  292. });
  293. }
  294. static int lfs_dir_fetch(lfs_t *lfs, lfs_dir_t *dir, lfs_block_t pair[2]) {
  295. dir->pair[0] = pair[0];
  296. dir->pair[1] = pair[1];
  297. dir->off = sizeof(dir->d);
  298. return lfs_pair_fetch(lfs, dir->pair,
  299. 1, (struct lfs_fetch_region[1]) {
  300. {0, sizeof(dir->d), &dir->d}
  301. });
  302. }
  303. static int lfs_dir_next(lfs_t *lfs, lfs_dir_t *dir, lfs_entry_t *entry) {
  304. while (true) {
  305. // TODO iterate down list
  306. entry->dir[0] = dir->pair[0];
  307. entry->dir[1] = dir->pair[1];
  308. entry->off = dir->off;
  309. if (dir->d.size - dir->off < sizeof(entry->d)) {
  310. return LFS_ERROR_NO_ENTRY;
  311. }
  312. int err = lfs_bd_read(lfs, dir->pair[0], dir->off,
  313. sizeof(entry->d), &entry->d);
  314. if (err) {
  315. return err;
  316. }
  317. dir->off += entry->d.len;
  318. // Skip any unknown entries
  319. if ((entry->d.type & 0xf) == 1 || (entry->d.type & 0xf) == 2) {
  320. return 0;
  321. }
  322. }
  323. }
  324. static int lfs_dir_find(lfs_t *lfs, lfs_dir_t *dir,
  325. const char *path, lfs_entry_t *entry) {
  326. // TODO follow directories
  327. lfs_size_t pathlen = strcspn(path, "/");
  328. while (true) {
  329. int err = lfs_dir_next(lfs, dir, entry);
  330. if (err) {
  331. return err;
  332. }
  333. if (entry->d.len - sizeof(entry->d) != pathlen) {
  334. continue;
  335. }
  336. int ret = lfs_bd_cmp(lfs, entry->dir[0],
  337. entry->off + sizeof(entry->d), pathlen, path);
  338. if (ret < 0) {
  339. return ret;
  340. }
  341. // Found match
  342. if (ret == true) {
  343. return 0;
  344. }
  345. }
  346. }
  347. static int lfs_dir_append(lfs_t *lfs, lfs_dir_t *dir,
  348. const char *path, lfs_entry_t *entry) {
  349. int err = lfs_dir_find(lfs, dir, path, entry);
  350. if (err != LFS_ERROR_NO_ENTRY) {
  351. return err ? err : LFS_ERROR_EXISTS;
  352. }
  353. // Check if we fit
  354. if (dir->d.size + strlen(path) > lfs->block_size - 4) {
  355. return -1; // TODO make fit
  356. }
  357. return 0;
  358. }
  359. int lfs_mkdir(lfs_t *lfs, const char *path) {
  360. // Allocate entry for directory
  361. lfs_dir_t cwd;
  362. int err = lfs_dir_fetch(lfs, &cwd, lfs->cwd);
  363. if (err) {
  364. return err;
  365. }
  366. lfs_entry_t entry;
  367. err = lfs_dir_append(lfs, &cwd, path, &entry);
  368. if (err) {
  369. return err;
  370. }
  371. // Build up new directory
  372. lfs_dir_t dir;
  373. err = lfs_dir_create(lfs, &dir, cwd.pair);
  374. if (err) {
  375. return err;
  376. }
  377. entry.d.type = LFS_TYPE_DIR;
  378. entry.d.len = sizeof(entry.d) + strlen(path);
  379. entry.d.u.dir[0] = dir.pair[0];
  380. entry.d.u.dir[1] = dir.pair[1];
  381. cwd.d.rev += 1;
  382. cwd.d.size += entry.d.len;
  383. cwd.d.free = lfs->free;
  384. return lfs_pair_commit(lfs, entry.dir,
  385. 3, (struct lfs_commit_region[3]) {
  386. {0, sizeof(cwd.d), &cwd.d},
  387. {entry.off, sizeof(entry.d), &entry.d},
  388. {entry.off+sizeof(entry.d), entry.d.len - sizeof(entry.d), path}
  389. });
  390. }
  391. int lfs_dir_open(lfs_t *lfs, lfs_dir_t *dir, const char *path) {
  392. if (path[0] == '/') {
  393. dir->pair[0] = lfs->root[0];
  394. dir->pair[1] = lfs->root[1];
  395. } else {
  396. dir->pair[0] = lfs->cwd[0];
  397. dir->pair[1] = lfs->cwd[1];
  398. }
  399. int err = lfs_dir_fetch(lfs, dir, dir->pair);
  400. if (err) {
  401. return err;
  402. } else if (strcmp(path, "/") == 0) {
  403. return 0;
  404. }
  405. lfs_entry_t entry;
  406. err = lfs_dir_find(lfs, dir, path, &entry);
  407. if (err) {
  408. return err;
  409. } else if (entry.d.type != LFS_TYPE_DIR) {
  410. return LFS_ERROR_NOT_DIR;
  411. }
  412. return lfs_dir_fetch(lfs, dir, entry.d.u.dir);
  413. }
  414. int lfs_dir_close(lfs_t *lfs, lfs_dir_t *dir) {
  415. // Do nothing, dir is always synchronized
  416. return 0;
  417. }
  418. int lfs_dir_read(lfs_t *lfs, lfs_dir_t *dir, struct lfs_info *info) {
  419. memset(info, 0, sizeof(*info));
  420. lfs_entry_t entry;
  421. int err = lfs_dir_next(lfs, dir, &entry);
  422. if (err) {
  423. return (err == LFS_ERROR_NO_ENTRY) ? 0 : err;
  424. }
  425. info->type = entry.d.type & 0xff;
  426. if (info->type == LFS_TYPE_REG) {
  427. info->size = entry.d.u.file.size;
  428. }
  429. err = lfs_bd_read(lfs, entry.dir[0], entry.off + sizeof(entry.d),
  430. entry.d.len - sizeof(entry.d), info->name);
  431. if (err) {
  432. return err;
  433. }
  434. return 1;
  435. }
  436. /// File operations ///
  437. int lfs_file_open(lfs_t *lfs, lfs_file_t *file,
  438. const char *path, int flags) {
  439. // Allocate entry for file if it doesn't exist
  440. // TODO check open files
  441. lfs_dir_t cwd;
  442. int err = lfs_dir_fetch(lfs, &cwd, lfs->cwd);
  443. if (err) {
  444. return err;
  445. }
  446. if (flags & LFS_O_CREAT) {
  447. err = lfs_dir_append(lfs, &cwd, path, &file->entry);
  448. if (err && err != LFS_ERROR_EXISTS) {
  449. return err;
  450. }
  451. } else {
  452. err = lfs_dir_find(lfs, &cwd, path, &file->entry);
  453. if (err) {
  454. return err;
  455. }
  456. }
  457. if ((flags & LFS_O_CREAT) && err != LFS_ERROR_EXISTS) {
  458. // Store file
  459. file->head = 0;
  460. file->size = 0;
  461. file->wblock = 0;
  462. file->windex = 0;
  463. file->rblock = 0;
  464. file->rindex = 0;
  465. file->roff = 0;
  466. file->entry.d.type = 1;
  467. file->entry.d.len = sizeof(file->entry.d) + strlen(path);
  468. file->entry.d.u.file.head = file->head;
  469. file->entry.d.u.file.size = file->size;
  470. cwd.d.rev += 1;
  471. cwd.d.size += file->entry.d.len;
  472. cwd.d.free = lfs->free;
  473. return lfs_pair_commit(lfs, file->entry.dir,
  474. 3, (struct lfs_commit_region[3]) {
  475. {0, sizeof(cwd.d), &cwd.d},
  476. {file->entry.off,
  477. sizeof(file->entry.d),
  478. &file->entry.d},
  479. {file->entry.off+sizeof(file->entry.d),
  480. file->entry.d.len-sizeof(file->entry.d),
  481. path}
  482. });
  483. } else if (file->entry.d.type == LFS_TYPE_DIR) {
  484. return LFS_ERROR_IS_DIR;
  485. } else {
  486. file->head = file->entry.d.u.file.head;
  487. file->size = file->entry.d.u.file.size;
  488. file->windex = lfs_toindex(lfs, file->size);
  489. file->rblock = 0;
  490. file->rindex = 0;
  491. file->roff = 0;
  492. // TODO do this lazily in write?
  493. // TODO cow the head i/d block
  494. if (file->size < lfs->block_size) {
  495. file->wblock = file->head;
  496. } else {
  497. int err = lfs_index_find(lfs, file->head, file->windex,
  498. file->windex, &file->wblock);
  499. if (err) {
  500. return err;
  501. }
  502. }
  503. return 0;
  504. }
  505. }
  506. int lfs_file_close(lfs_t *lfs, lfs_file_t *file) {
  507. // Store file
  508. lfs_dir_t cwd;
  509. int err = lfs_dir_fetch(lfs, &cwd, file->entry.dir);
  510. if (err) {
  511. return err;
  512. }
  513. file->entry.d.u.file.head = file->head;
  514. file->entry.d.u.file.size = file->size;
  515. cwd.d.rev += 1;
  516. cwd.d.free = lfs->free;
  517. return lfs_pair_commit(lfs, file->entry.dir,
  518. 3, (struct lfs_commit_region[3]) {
  519. {0, sizeof(cwd.d), &cwd.d},
  520. {file->entry.off, sizeof(file->entry.d), &file->entry.d},
  521. });
  522. }
  523. lfs_ssize_t lfs_file_write(lfs_t *lfs, lfs_file_t *file,
  524. const void *buffer, lfs_size_t size) {
  525. const uint8_t *data = buffer;
  526. lfs_size_t nsize = size;
  527. while (nsize > 0) {
  528. lfs_off_t woff = file->size % lfs->block_size;
  529. if (file->size == 0) {
  530. int err = lfs_alloc_erased(lfs, &file->wblock);
  531. if (err) {
  532. return err;
  533. }
  534. file->head = file->wblock;
  535. file->windex = 0;
  536. } else if (woff == 0) {
  537. int err = lfs_alloc_erased(lfs, &file->wblock);
  538. if (err) {
  539. return err;
  540. }
  541. err = lfs_index_append(lfs, &file->head,
  542. &file->windex, file->wblock);
  543. if (err) {
  544. return err;
  545. }
  546. }
  547. lfs_size_t diff = lfs_min(nsize, lfs->block_size - woff);
  548. int err = lfs_bd_prog(lfs, file->wblock, woff, diff, data);
  549. if (err) {
  550. return err;
  551. }
  552. file->size += diff;
  553. data += diff;
  554. nsize -= diff;
  555. }
  556. return size;
  557. }
  558. lfs_ssize_t lfs_file_read(lfs_t *lfs, lfs_file_t *file,
  559. void *buffer, lfs_size_t size) {
  560. uint8_t *data = buffer;
  561. lfs_size_t nsize = size;
  562. while (nsize > 0 && file->roff < file->size) {
  563. lfs_off_t roff = file->roff % lfs->block_size;
  564. // TODO cache index blocks
  565. if (file->size < lfs->block_size) {
  566. file->rblock = file->head;
  567. } else if (roff == 0) {
  568. int err = lfs_index_find(lfs, file->head, file->windex,
  569. file->rindex, &file->rblock);
  570. if (err) {
  571. return err;
  572. }
  573. file->rindex = lfs_index_next(lfs, file->rindex);
  574. }
  575. lfs_size_t diff = lfs_min(
  576. lfs_min(nsize, file->size-file->roff),
  577. lfs->block_size - roff);
  578. int err = lfs_bd_read(lfs, file->rblock, roff, diff, data);
  579. if (err) {
  580. return err;
  581. }
  582. file->roff += diff;
  583. data += diff;
  584. nsize -= diff;
  585. }
  586. return size - nsize;
  587. }
  588. /// Generic filesystem operations ///
  589. static int lfs_configure(lfs_t *lfs, const struct lfs_config *config) {
  590. lfs->bd = config->bd;
  591. lfs->bd_ops = config->bd_ops;
  592. struct lfs_bd_info info;
  593. int err = lfs_bd_info(lfs, &info);
  594. if (err) {
  595. return err;
  596. }
  597. if (config->read_size) {
  598. if (config->read_size < info.read_size ||
  599. config->read_size % info.read_size != 0) {
  600. LFS_ERROR("Invalid read size %u, device has %u\n",
  601. config->read_size, info.read_size);
  602. return LFS_ERROR_INVALID;
  603. }
  604. lfs->read_size = config->read_size;
  605. } else {
  606. lfs->read_size = info.read_size;
  607. }
  608. if (config->prog_size) {
  609. if (config->prog_size < info.prog_size ||
  610. config->prog_size % info.prog_size != 0) {
  611. LFS_ERROR("Invalid prog size %u, device has %u\n",
  612. config->prog_size, info.prog_size);
  613. return LFS_ERROR_INVALID;
  614. }
  615. lfs->prog_size = config->prog_size;
  616. } else {
  617. lfs->prog_size = info.prog_size;
  618. }
  619. if (config->block_size) {
  620. if (config->block_size < info.erase_size ||
  621. config->block_size % info.erase_size != 0) {
  622. LFS_ERROR("Invalid block size %u, device has %u\n",
  623. config->prog_size, info.prog_size);
  624. return LFS_ERROR_INVALID;
  625. }
  626. lfs->block_size = config->block_size;
  627. } else {
  628. lfs->block_size = lfs_min(512, info.erase_size);
  629. }
  630. if (config->block_count) {
  631. if (config->block_count > info.total_size/info.erase_size) {
  632. LFS_ERROR("Invalid block size %u, device has %u\n",
  633. config->block_size,
  634. (uint32_t)(info.total_size/info.erase_size));
  635. return LFS_ERROR_INVALID;
  636. }
  637. lfs->block_count = config->block_count;
  638. } else {
  639. lfs->block_count = info.total_size / info.erase_size;
  640. }
  641. lfs->words = lfs->block_size / sizeof(uint32_t);
  642. return 0;
  643. }
  644. int lfs_format(lfs_t *lfs, const struct lfs_config *config) {
  645. int err = lfs_configure(lfs, config);
  646. if (err) {
  647. return err;
  648. }
  649. // Create free list
  650. lfs->free.begin = 2;
  651. lfs->free.end = lfs->block_count;
  652. // Write root directory
  653. lfs_dir_t root;
  654. err = lfs_dir_create(lfs, &root, 0);
  655. if (err) {
  656. return err;
  657. }
  658. lfs->root[0] = root.pair[0];
  659. lfs->root[1] = root.pair[1];
  660. lfs->cwd[0] = root.pair[0];
  661. lfs->cwd[1] = root.pair[1];
  662. // Write superblocks
  663. lfs_superblock_t superblock = {
  664. .pair = {0, 1},
  665. .d.rev = 1,
  666. .d.size = sizeof(superblock),
  667. .d.root = {lfs->cwd[0], lfs->cwd[1]},
  668. .d.magic = {"littlefs"},
  669. .d.block_size = lfs->block_size,
  670. .d.block_count = lfs->block_count,
  671. };
  672. for (int i = 0; i < 2; i++) {
  673. int err = lfs_pair_commit(lfs, superblock.pair,
  674. 1, (struct lfs_commit_region[]){
  675. {0, sizeof(superblock.d), &superblock.d}
  676. });
  677. if (err) {
  678. LFS_ERROR("Failed to write superblock at %d", superblock.pair[1]);
  679. return err;
  680. }
  681. uint32_t crc = 0xffffffff;
  682. err = lfs_bd_crc(lfs, superblock.pair[0], 0, lfs->block_size, &crc);
  683. if (err || crc != 0) {
  684. LFS_ERROR("Failed to write superblock at %d", superblock.pair[0]);
  685. return err ? err : LFS_ERROR_CORRUPT;
  686. }
  687. }
  688. return 0;
  689. }
  690. int lfs_mount(lfs_t *lfs, const struct lfs_config *config) {
  691. int err = lfs_configure(lfs, config);
  692. if (err) {
  693. return err;
  694. }
  695. lfs_superblock_t superblock = {
  696. .pair = {0, 1},
  697. };
  698. err = lfs_pair_fetch(lfs, superblock.pair,
  699. 1, (struct lfs_fetch_region[]){
  700. {0, sizeof(superblock.d), &superblock.d}
  701. });
  702. if ((err == LFS_ERROR_CORRUPT ||
  703. memcmp(superblock.d.magic, "littlefs", 8) != 0)) {
  704. LFS_ERROR("Invalid superblock at %d %d",
  705. superblock.pair[0], superblock.pair[1]);
  706. return LFS_ERROR_CORRUPT;
  707. }
  708. lfs->root[0] = superblock.d.root[0];
  709. lfs->root[1] = superblock.d.root[1];
  710. lfs->cwd[0] = superblock.d.root[0];
  711. lfs->cwd[1] = superblock.d.root[1];
  712. // TODO this is wrong, needs to check all dirs
  713. lfs_dir_t dir;
  714. err = lfs_dir_fetch(lfs, &dir, lfs->cwd);
  715. if (err) {
  716. return err;
  717. }
  718. lfs->free.begin = dir.d.free.begin;
  719. lfs->free.end = dir.d.free.end;
  720. return err;
  721. }
  722. int lfs_unmount(lfs_t *lfs) {
  723. // No nothing for now
  724. return 0;
  725. }