btrfs.c 45 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776
  1. /* btrfs.c - B-tree file system. */
  2. /*
  3. * GRUB -- GRand Unified Bootloader
  4. * Copyright (C) 2010,2011,2012,2013 Free Software Foundation, Inc.
  5. *
  6. * GRUB is free software: you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation, either version 3 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * GRUB is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #include <grub/err.h>
  20. #include <grub/file.h>
  21. #include <grub/mm.h>
  22. #include <grub/misc.h>
  23. #include <grub/disk.h>
  24. #include <grub/dl.h>
  25. #include <grub/types.h>
  26. #include <grub/lib/crc.h>
  27. #include <grub/deflate.h>
  28. #include <minilzo.h>
  29. #include <grub/i18n.h>
  30. #include <grub/btrfs.h>
  31. GRUB_MOD_LICENSE ("GPLv3+");
  32. #define GRUB_BTRFS_SIGNATURE "_BHRfS_M"
  33. /* From http://www.oberhumer.com/opensource/lzo/lzofaq.php
  34. * LZO will expand incompressible data by a little amount. I still haven't
  35. * computed the exact values, but I suggest using these formulas for
  36. * a worst-case expansion calculation:
  37. *
  38. * output_block_size = input_block_size + (input_block_size / 16) + 64 + 3
  39. * */
  40. #define GRUB_BTRFS_LZO_BLOCK_SIZE 4096
  41. #define GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE (GRUB_BTRFS_LZO_BLOCK_SIZE + \
  42. (GRUB_BTRFS_LZO_BLOCK_SIZE / 16) + 64 + 3)
  43. typedef grub_uint8_t grub_btrfs_checksum_t[0x20];
  44. typedef grub_uint16_t grub_btrfs_uuid_t[8];
  45. struct grub_btrfs_device
  46. {
  47. grub_uint64_t device_id;
  48. grub_uint64_t size;
  49. grub_uint8_t dummy[0x62 - 0x10];
  50. } GRUB_PACKED;
  51. struct grub_btrfs_superblock
  52. {
  53. grub_btrfs_checksum_t checksum;
  54. grub_btrfs_uuid_t uuid;
  55. grub_uint8_t dummy[0x10];
  56. grub_uint8_t signature[sizeof (GRUB_BTRFS_SIGNATURE) - 1];
  57. grub_uint64_t generation;
  58. grub_uint64_t root_tree;
  59. grub_uint64_t chunk_tree;
  60. grub_uint8_t dummy2[0x20];
  61. grub_uint64_t root_dir_objectid;
  62. grub_uint8_t dummy3[0x41];
  63. struct grub_btrfs_device this_device;
  64. char label[0x100];
  65. grub_uint8_t dummy4[0x100];
  66. grub_uint8_t bootstrap_mapping[0x800];
  67. } GRUB_PACKED;
  68. struct btrfs_header
  69. {
  70. grub_btrfs_checksum_t checksum;
  71. grub_btrfs_uuid_t uuid;
  72. grub_uint8_t dummy[0x30];
  73. grub_uint32_t nitems;
  74. grub_uint8_t level;
  75. } GRUB_PACKED;
  76. struct grub_btrfs_device_desc
  77. {
  78. grub_device_t dev;
  79. grub_uint64_t id;
  80. };
  81. struct grub_btrfs_data
  82. {
  83. struct grub_btrfs_superblock sblock;
  84. grub_uint64_t tree;
  85. grub_uint64_t inode;
  86. struct grub_btrfs_device_desc *devices_attached;
  87. unsigned n_devices_attached;
  88. unsigned n_devices_allocated;
  89. /* Cached extent data. */
  90. grub_uint64_t extstart;
  91. grub_uint64_t extend;
  92. grub_uint64_t extino;
  93. grub_uint64_t exttree;
  94. grub_size_t extsize;
  95. struct grub_btrfs_extent_data *extent;
  96. };
  97. struct grub_btrfs_chunk_item
  98. {
  99. grub_uint64_t size;
  100. grub_uint64_t dummy;
  101. grub_uint64_t stripe_length;
  102. grub_uint64_t type;
  103. #define GRUB_BTRFS_CHUNK_TYPE_BITS_DONTCARE 0x07
  104. #define GRUB_BTRFS_CHUNK_TYPE_SINGLE 0x00
  105. #define GRUB_BTRFS_CHUNK_TYPE_RAID0 0x08
  106. #define GRUB_BTRFS_CHUNK_TYPE_RAID1 0x10
  107. #define GRUB_BTRFS_CHUNK_TYPE_DUPLICATED 0x20
  108. #define GRUB_BTRFS_CHUNK_TYPE_RAID10 0x40
  109. grub_uint8_t dummy2[0xc];
  110. grub_uint16_t nstripes;
  111. grub_uint16_t nsubstripes;
  112. } GRUB_PACKED;
  113. struct grub_btrfs_chunk_stripe
  114. {
  115. grub_uint64_t device_id;
  116. grub_uint64_t offset;
  117. grub_btrfs_uuid_t device_uuid;
  118. } GRUB_PACKED;
  119. struct grub_btrfs_leaf_node
  120. {
  121. struct grub_btrfs_key key;
  122. grub_uint32_t offset;
  123. grub_uint32_t size;
  124. } GRUB_PACKED;
  125. struct grub_btrfs_internal_node
  126. {
  127. struct grub_btrfs_key key;
  128. grub_uint64_t addr;
  129. grub_uint64_t dummy;
  130. } GRUB_PACKED;
  131. struct grub_btrfs_dir_item
  132. {
  133. struct grub_btrfs_key key;
  134. grub_uint8_t dummy[8];
  135. grub_uint16_t m;
  136. grub_uint16_t n;
  137. #define GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR 1
  138. #define GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY 2
  139. #define GRUB_BTRFS_DIR_ITEM_TYPE_SYMLINK 7
  140. grub_uint8_t type;
  141. char name[0];
  142. } GRUB_PACKED;
  143. struct grub_btrfs_leaf_descriptor
  144. {
  145. unsigned depth;
  146. unsigned allocated;
  147. struct
  148. {
  149. grub_disk_addr_t addr;
  150. unsigned iter;
  151. unsigned maxiter;
  152. int leaf;
  153. } *data;
  154. };
  155. struct grub_btrfs_time
  156. {
  157. grub_int64_t sec;
  158. grub_uint32_t nanosec;
  159. } __attribute__ ((aligned (4)));
  160. struct grub_btrfs_inode
  161. {
  162. grub_uint8_t dummy1[0x10];
  163. grub_uint64_t size;
  164. grub_uint8_t dummy2[0x70];
  165. struct grub_btrfs_time mtime;
  166. } GRUB_PACKED;
  167. struct grub_btrfs_extent_data
  168. {
  169. grub_uint64_t dummy;
  170. grub_uint64_t size;
  171. grub_uint8_t compression;
  172. grub_uint8_t encryption;
  173. grub_uint16_t encoding;
  174. grub_uint8_t type;
  175. union
  176. {
  177. char inl[0];
  178. struct
  179. {
  180. grub_uint64_t laddr;
  181. grub_uint64_t compressed_size;
  182. grub_uint64_t offset;
  183. grub_uint64_t filled;
  184. };
  185. };
  186. } GRUB_PACKED;
  187. #define GRUB_BTRFS_EXTENT_INLINE 0
  188. #define GRUB_BTRFS_EXTENT_REGULAR 1
  189. #define GRUB_BTRFS_COMPRESSION_NONE 0
  190. #define GRUB_BTRFS_COMPRESSION_ZLIB 1
  191. #define GRUB_BTRFS_COMPRESSION_LZO 2
  192. #define GRUB_BTRFS_OBJECT_ID_CHUNK 0x100
  193. static grub_disk_addr_t superblock_sectors[] = { 64 * 2, 64 * 1024 * 2,
  194. 256 * 1048576 * 2, 1048576ULL * 1048576ULL * 2
  195. };
  196. static grub_err_t
  197. grub_btrfs_read_logical (struct grub_btrfs_data *data,
  198. grub_disk_addr_t addr, void *buf, grub_size_t size,
  199. int recursion_depth);
  200. static grub_err_t
  201. read_sblock (grub_disk_t disk, struct grub_btrfs_superblock *sb)
  202. {
  203. unsigned i;
  204. grub_err_t err = GRUB_ERR_NONE;
  205. for (i = 0; i < ARRAY_SIZE (superblock_sectors); i++)
  206. {
  207. struct grub_btrfs_superblock sblock;
  208. /* Don't try additional superblocks beyond device size. */
  209. if (i && (grub_le_to_cpu64 (sblock.this_device.size)
  210. >> GRUB_DISK_SECTOR_BITS) <= superblock_sectors[i])
  211. break;
  212. err = grub_disk_read (disk, superblock_sectors[i], 0,
  213. sizeof (sblock), &sblock);
  214. if (err == GRUB_ERR_OUT_OF_RANGE)
  215. break;
  216. if (grub_memcmp ((char *) sblock.signature, GRUB_BTRFS_SIGNATURE,
  217. sizeof (GRUB_BTRFS_SIGNATURE) - 1) != 0)
  218. break;
  219. if (i == 0 || grub_le_to_cpu64 (sblock.generation)
  220. > grub_le_to_cpu64 (sb->generation))
  221. grub_memcpy (sb, &sblock, sizeof (sblock));
  222. }
  223. if ((err == GRUB_ERR_OUT_OF_RANGE || !err) && i == 0)
  224. return grub_error (GRUB_ERR_BAD_FS, "not a Btrfs filesystem");
  225. if (err == GRUB_ERR_OUT_OF_RANGE)
  226. grub_errno = err = GRUB_ERR_NONE;
  227. return err;
  228. }
  229. static int
  230. key_cmp (const struct grub_btrfs_key *a, const struct grub_btrfs_key *b)
  231. {
  232. if (grub_le_to_cpu64 (a->object_id) < grub_le_to_cpu64 (b->object_id))
  233. return -1;
  234. if (grub_le_to_cpu64 (a->object_id) > grub_le_to_cpu64 (b->object_id))
  235. return +1;
  236. if (a->type < b->type)
  237. return -1;
  238. if (a->type > b->type)
  239. return +1;
  240. if (grub_le_to_cpu64 (a->offset) < grub_le_to_cpu64 (b->offset))
  241. return -1;
  242. if (grub_le_to_cpu64 (a->offset) > grub_le_to_cpu64 (b->offset))
  243. return +1;
  244. return 0;
  245. }
  246. static void
  247. free_iterator (struct grub_btrfs_leaf_descriptor *desc)
  248. {
  249. grub_free (desc->data);
  250. }
  251. static grub_err_t
  252. save_ref (struct grub_btrfs_leaf_descriptor *desc,
  253. grub_disk_addr_t addr, unsigned i, unsigned m, int l)
  254. {
  255. desc->depth++;
  256. if (desc->allocated < desc->depth)
  257. {
  258. void *newdata;
  259. desc->allocated *= 2;
  260. newdata = grub_realloc (desc->data, sizeof (desc->data[0])
  261. * desc->allocated);
  262. if (!newdata)
  263. return grub_errno;
  264. desc->data = newdata;
  265. }
  266. desc->data[desc->depth - 1].addr = addr;
  267. desc->data[desc->depth - 1].iter = i;
  268. desc->data[desc->depth - 1].maxiter = m;
  269. desc->data[desc->depth - 1].leaf = l;
  270. return GRUB_ERR_NONE;
  271. }
  272. static int
  273. next (struct grub_btrfs_data *data,
  274. struct grub_btrfs_leaf_descriptor *desc,
  275. grub_disk_addr_t * outaddr, grub_size_t * outsize,
  276. struct grub_btrfs_key *key_out)
  277. {
  278. grub_err_t err;
  279. struct grub_btrfs_leaf_node leaf;
  280. for (; desc->depth > 0; desc->depth--)
  281. {
  282. desc->data[desc->depth - 1].iter++;
  283. if (desc->data[desc->depth - 1].iter
  284. < desc->data[desc->depth - 1].maxiter)
  285. break;
  286. }
  287. if (desc->depth == 0)
  288. return 0;
  289. while (!desc->data[desc->depth - 1].leaf)
  290. {
  291. struct grub_btrfs_internal_node node;
  292. struct btrfs_header head;
  293. err = grub_btrfs_read_logical (data, desc->data[desc->depth - 1].iter
  294. * sizeof (node)
  295. + sizeof (struct btrfs_header)
  296. + desc->data[desc->depth - 1].addr,
  297. &node, sizeof (node), 0);
  298. if (err)
  299. return -err;
  300. err = grub_btrfs_read_logical (data, grub_le_to_cpu64 (node.addr),
  301. &head, sizeof (head), 0);
  302. if (err)
  303. return -err;
  304. save_ref (desc, grub_le_to_cpu64 (node.addr), 0,
  305. grub_le_to_cpu32 (head.nitems), !head.level);
  306. }
  307. err = grub_btrfs_read_logical (data, desc->data[desc->depth - 1].iter
  308. * sizeof (leaf)
  309. + sizeof (struct btrfs_header)
  310. + desc->data[desc->depth - 1].addr, &leaf,
  311. sizeof (leaf), 0);
  312. if (err)
  313. return -err;
  314. *outsize = grub_le_to_cpu32 (leaf.size);
  315. *outaddr = desc->data[desc->depth - 1].addr + sizeof (struct btrfs_header)
  316. + grub_le_to_cpu32 (leaf.offset);
  317. *key_out = leaf.key;
  318. return 1;
  319. }
  320. static grub_err_t
  321. lower_bound (struct grub_btrfs_data *data,
  322. const struct grub_btrfs_key *key_in,
  323. struct grub_btrfs_key *key_out,
  324. grub_uint64_t root,
  325. grub_disk_addr_t *outaddr, grub_size_t *outsize,
  326. struct grub_btrfs_leaf_descriptor *desc,
  327. int recursion_depth)
  328. {
  329. grub_disk_addr_t addr = grub_le_to_cpu64 (root);
  330. int depth = -1;
  331. if (desc)
  332. {
  333. desc->allocated = 16;
  334. desc->depth = 0;
  335. desc->data = grub_malloc (sizeof (desc->data[0]) * desc->allocated);
  336. if (!desc->data)
  337. return grub_errno;
  338. }
  339. /* > 2 would work as well but be robust and allow a bit more just in case.
  340. */
  341. if (recursion_depth > 10)
  342. return grub_error (GRUB_ERR_BAD_FS, "too deep btrfs virtual nesting");
  343. grub_dprintf ("btrfs",
  344. "retrieving %" PRIxGRUB_UINT64_T
  345. " %x %" PRIxGRUB_UINT64_T "\n",
  346. key_in->object_id, key_in->type, key_in->offset);
  347. while (1)
  348. {
  349. grub_err_t err;
  350. struct btrfs_header head;
  351. reiter:
  352. depth++;
  353. /* FIXME: preread few nodes into buffer. */
  354. err = grub_btrfs_read_logical (data, addr, &head, sizeof (head),
  355. recursion_depth + 1);
  356. if (err)
  357. return err;
  358. addr += sizeof (head);
  359. if (head.level)
  360. {
  361. unsigned i;
  362. struct grub_btrfs_internal_node node, node_last;
  363. int have_last = 0;
  364. grub_memset (&node_last, 0, sizeof (node_last));
  365. for (i = 0; i < grub_le_to_cpu32 (head.nitems); i++)
  366. {
  367. err = grub_btrfs_read_logical (data, addr + i * sizeof (node),
  368. &node, sizeof (node),
  369. recursion_depth + 1);
  370. if (err)
  371. return err;
  372. grub_dprintf ("btrfs",
  373. "internal node (depth %d) %" PRIxGRUB_UINT64_T
  374. " %x %" PRIxGRUB_UINT64_T "\n", depth,
  375. node.key.object_id, node.key.type,
  376. node.key.offset);
  377. if (key_cmp (&node.key, key_in) == 0)
  378. {
  379. err = GRUB_ERR_NONE;
  380. if (desc)
  381. err = save_ref (desc, addr - sizeof (head), i,
  382. grub_le_to_cpu32 (head.nitems), 0);
  383. if (err)
  384. return err;
  385. addr = grub_le_to_cpu64 (node.addr);
  386. goto reiter;
  387. }
  388. if (key_cmp (&node.key, key_in) > 0)
  389. break;
  390. node_last = node;
  391. have_last = 1;
  392. }
  393. if (have_last)
  394. {
  395. err = GRUB_ERR_NONE;
  396. if (desc)
  397. err = save_ref (desc, addr - sizeof (head), i - 1,
  398. grub_le_to_cpu32 (head.nitems), 0);
  399. if (err)
  400. return err;
  401. addr = grub_le_to_cpu64 (node_last.addr);
  402. goto reiter;
  403. }
  404. *outsize = 0;
  405. *outaddr = 0;
  406. grub_memset (key_out, 0, sizeof (*key_out));
  407. if (desc)
  408. return save_ref (desc, addr - sizeof (head), -1,
  409. grub_le_to_cpu32 (head.nitems), 0);
  410. return GRUB_ERR_NONE;
  411. }
  412. {
  413. unsigned i;
  414. struct grub_btrfs_leaf_node leaf, leaf_last;
  415. int have_last = 0;
  416. for (i = 0; i < grub_le_to_cpu32 (head.nitems); i++)
  417. {
  418. err = grub_btrfs_read_logical (data, addr + i * sizeof (leaf),
  419. &leaf, sizeof (leaf),
  420. recursion_depth + 1);
  421. if (err)
  422. return err;
  423. grub_dprintf ("btrfs",
  424. "leaf (depth %d) %" PRIxGRUB_UINT64_T
  425. " %x %" PRIxGRUB_UINT64_T "\n", depth,
  426. leaf.key.object_id, leaf.key.type, leaf.key.offset);
  427. if (key_cmp (&leaf.key, key_in) == 0)
  428. {
  429. grub_memcpy (key_out, &leaf.key, sizeof (*key_out));
  430. *outsize = grub_le_to_cpu32 (leaf.size);
  431. *outaddr = addr + grub_le_to_cpu32 (leaf.offset);
  432. if (desc)
  433. return save_ref (desc, addr - sizeof (head), i,
  434. grub_le_to_cpu32 (head.nitems), 1);
  435. return GRUB_ERR_NONE;
  436. }
  437. if (key_cmp (&leaf.key, key_in) > 0)
  438. break;
  439. have_last = 1;
  440. leaf_last = leaf;
  441. }
  442. if (have_last)
  443. {
  444. grub_memcpy (key_out, &leaf_last.key, sizeof (*key_out));
  445. *outsize = grub_le_to_cpu32 (leaf_last.size);
  446. *outaddr = addr + grub_le_to_cpu32 (leaf_last.offset);
  447. if (desc)
  448. return save_ref (desc, addr - sizeof (head), i - 1,
  449. grub_le_to_cpu32 (head.nitems), 1);
  450. return GRUB_ERR_NONE;
  451. }
  452. *outsize = 0;
  453. *outaddr = 0;
  454. grub_memset (key_out, 0, sizeof (*key_out));
  455. if (desc)
  456. return save_ref (desc, addr - sizeof (head), -1,
  457. grub_le_to_cpu32 (head.nitems), 1);
  458. return GRUB_ERR_NONE;
  459. }
  460. }
  461. }
  462. /* Context for find_device. */
  463. struct find_device_ctx
  464. {
  465. struct grub_btrfs_data *data;
  466. grub_uint64_t id;
  467. grub_device_t dev_found;
  468. };
  469. /* Helper for find_device. */
  470. static int
  471. find_device_iter (const char *name, void *data)
  472. {
  473. struct find_device_ctx *ctx = data;
  474. grub_device_t dev;
  475. grub_err_t err;
  476. struct grub_btrfs_superblock sb;
  477. dev = grub_device_open (name);
  478. if (!dev)
  479. return 0;
  480. if (!dev->disk)
  481. {
  482. grub_device_close (dev);
  483. return 0;
  484. }
  485. err = read_sblock (dev->disk, &sb);
  486. if (err == GRUB_ERR_BAD_FS)
  487. {
  488. grub_device_close (dev);
  489. grub_errno = GRUB_ERR_NONE;
  490. return 0;
  491. }
  492. if (err)
  493. {
  494. grub_device_close (dev);
  495. grub_print_error ();
  496. return 0;
  497. }
  498. if (grub_memcmp (ctx->data->sblock.uuid, sb.uuid, sizeof (sb.uuid)) != 0
  499. || sb.this_device.device_id != ctx->id)
  500. {
  501. grub_device_close (dev);
  502. return 0;
  503. }
  504. ctx->dev_found = dev;
  505. return 1;
  506. }
  507. static grub_device_t
  508. find_device (struct grub_btrfs_data *data, grub_uint64_t id, int do_rescan)
  509. {
  510. struct find_device_ctx ctx = {
  511. .data = data,
  512. .id = id,
  513. .dev_found = NULL
  514. };
  515. unsigned i;
  516. for (i = 0; i < data->n_devices_attached; i++)
  517. if (id == data->devices_attached[i].id)
  518. return data->devices_attached[i].dev;
  519. if (do_rescan)
  520. grub_device_iterate (find_device_iter, &ctx);
  521. if (!ctx.dev_found)
  522. {
  523. grub_error (GRUB_ERR_BAD_FS,
  524. N_("couldn't find a necessary member device "
  525. "of multi-device filesystem"));
  526. return NULL;
  527. }
  528. data->n_devices_attached++;
  529. if (data->n_devices_attached > data->n_devices_allocated)
  530. {
  531. void *tmp;
  532. data->n_devices_allocated = 2 * data->n_devices_attached + 1;
  533. data->devices_attached
  534. = grub_realloc (tmp = data->devices_attached,
  535. data->n_devices_allocated
  536. * sizeof (data->devices_attached[0]));
  537. if (!data->devices_attached)
  538. {
  539. grub_device_close (ctx.dev_found);
  540. data->devices_attached = tmp;
  541. return NULL;
  542. }
  543. }
  544. data->devices_attached[data->n_devices_attached - 1].id = id;
  545. data->devices_attached[data->n_devices_attached - 1].dev = ctx.dev_found;
  546. return ctx.dev_found;
  547. }
  548. static grub_err_t
  549. grub_btrfs_read_logical (struct grub_btrfs_data *data, grub_disk_addr_t addr,
  550. void *buf, grub_size_t size, int recursion_depth)
  551. {
  552. while (size > 0)
  553. {
  554. grub_uint8_t *ptr;
  555. struct grub_btrfs_key *key;
  556. struct grub_btrfs_chunk_item *chunk;
  557. grub_uint64_t csize;
  558. grub_err_t err = 0;
  559. struct grub_btrfs_key key_out;
  560. int challoc = 0;
  561. grub_device_t dev;
  562. struct grub_btrfs_key key_in;
  563. grub_size_t chsize;
  564. grub_disk_addr_t chaddr;
  565. grub_dprintf ("btrfs", "searching for laddr %" PRIxGRUB_UINT64_T "\n",
  566. addr);
  567. for (ptr = data->sblock.bootstrap_mapping;
  568. ptr < data->sblock.bootstrap_mapping
  569. + sizeof (data->sblock.bootstrap_mapping)
  570. - sizeof (struct grub_btrfs_key);)
  571. {
  572. key = (struct grub_btrfs_key *) ptr;
  573. if (key->type != GRUB_BTRFS_ITEM_TYPE_CHUNK)
  574. break;
  575. chunk = (struct grub_btrfs_chunk_item *) (key + 1);
  576. grub_dprintf ("btrfs",
  577. "%" PRIxGRUB_UINT64_T " %" PRIxGRUB_UINT64_T " \n",
  578. grub_le_to_cpu64 (key->offset),
  579. grub_le_to_cpu64 (chunk->size));
  580. if (grub_le_to_cpu64 (key->offset) <= addr
  581. && addr < grub_le_to_cpu64 (key->offset)
  582. + grub_le_to_cpu64 (chunk->size))
  583. goto chunk_found;
  584. ptr += sizeof (*key) + sizeof (*chunk)
  585. + sizeof (struct grub_btrfs_chunk_stripe)
  586. * grub_le_to_cpu16 (chunk->nstripes);
  587. }
  588. key_in.object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  589. key_in.type = GRUB_BTRFS_ITEM_TYPE_CHUNK;
  590. key_in.offset = grub_cpu_to_le64 (addr);
  591. err = lower_bound (data, &key_in, &key_out,
  592. data->sblock.chunk_tree,
  593. &chaddr, &chsize, NULL, recursion_depth);
  594. if (err)
  595. return err;
  596. key = &key_out;
  597. if (key->type != GRUB_BTRFS_ITEM_TYPE_CHUNK
  598. || !(grub_le_to_cpu64 (key->offset) <= addr))
  599. return grub_error (GRUB_ERR_BAD_FS,
  600. "couldn't find the chunk descriptor");
  601. chunk = grub_malloc (chsize);
  602. if (!chunk)
  603. return grub_errno;
  604. challoc = 1;
  605. err = grub_btrfs_read_logical (data, chaddr, chunk, chsize,
  606. recursion_depth);
  607. if (err)
  608. {
  609. grub_free (chunk);
  610. return err;
  611. }
  612. chunk_found:
  613. {
  614. grub_uint64_t stripen;
  615. grub_uint64_t stripe_offset;
  616. grub_uint64_t off = addr - grub_le_to_cpu64 (key->offset);
  617. grub_uint64_t chunk_stripe_length;
  618. grub_uint16_t nstripes;
  619. unsigned redundancy = 1;
  620. unsigned i, j;
  621. if (grub_le_to_cpu64 (chunk->size) <= off)
  622. {
  623. grub_dprintf ("btrfs", "no chunk\n");
  624. return grub_error (GRUB_ERR_BAD_FS,
  625. "couldn't find the chunk descriptor");
  626. }
  627. nstripes = grub_le_to_cpu16 (chunk->nstripes) ? : 1;
  628. chunk_stripe_length = grub_le_to_cpu64 (chunk->stripe_length) ? : 512;
  629. grub_dprintf ("btrfs", "chunk 0x%" PRIxGRUB_UINT64_T
  630. "+0x%" PRIxGRUB_UINT64_T
  631. " (%d stripes (%d substripes) of %"
  632. PRIxGRUB_UINT64_T ")\n",
  633. grub_le_to_cpu64 (key->offset),
  634. grub_le_to_cpu64 (chunk->size),
  635. nstripes,
  636. grub_le_to_cpu16 (chunk->nsubstripes),
  637. chunk_stripe_length);
  638. switch (grub_le_to_cpu64 (chunk->type)
  639. & ~GRUB_BTRFS_CHUNK_TYPE_BITS_DONTCARE)
  640. {
  641. case GRUB_BTRFS_CHUNK_TYPE_SINGLE:
  642. {
  643. grub_uint64_t stripe_length;
  644. grub_dprintf ("btrfs", "single\n");
  645. stripe_length = grub_divmod64 (grub_le_to_cpu64 (chunk->size),
  646. nstripes,
  647. NULL);
  648. if (stripe_length == 0)
  649. stripe_length = 512;
  650. stripen = grub_divmod64 (off, stripe_length, &stripe_offset);
  651. csize = (stripen + 1) * stripe_length - off;
  652. break;
  653. }
  654. case GRUB_BTRFS_CHUNK_TYPE_DUPLICATED:
  655. case GRUB_BTRFS_CHUNK_TYPE_RAID1:
  656. {
  657. grub_dprintf ("btrfs", "RAID1\n");
  658. stripen = 0;
  659. stripe_offset = off;
  660. csize = grub_le_to_cpu64 (chunk->size) - off;
  661. redundancy = 2;
  662. break;
  663. }
  664. case GRUB_BTRFS_CHUNK_TYPE_RAID0:
  665. {
  666. grub_uint64_t middle, high;
  667. grub_uint64_t low;
  668. grub_dprintf ("btrfs", "RAID0\n");
  669. middle = grub_divmod64 (off,
  670. chunk_stripe_length,
  671. &low);
  672. high = grub_divmod64 (middle, nstripes,
  673. &stripen);
  674. stripe_offset =
  675. low + chunk_stripe_length * high;
  676. csize = chunk_stripe_length - low;
  677. break;
  678. }
  679. case GRUB_BTRFS_CHUNK_TYPE_RAID10:
  680. {
  681. grub_uint64_t middle, high;
  682. grub_uint64_t low;
  683. grub_uint16_t nsubstripes;
  684. nsubstripes = grub_le_to_cpu16 (chunk->nsubstripes) ? : 1;
  685. middle = grub_divmod64 (off,
  686. chunk_stripe_length,
  687. &low);
  688. high = grub_divmod64 (middle,
  689. nstripes / nsubstripes ? : 1,
  690. &stripen);
  691. stripen *= nsubstripes;
  692. redundancy = nsubstripes;
  693. stripe_offset = low + chunk_stripe_length
  694. * high;
  695. csize = chunk_stripe_length - low;
  696. break;
  697. }
  698. default:
  699. grub_dprintf ("btrfs", "unsupported RAID\n");
  700. return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  701. "unsupported RAID flags %" PRIxGRUB_UINT64_T,
  702. grub_le_to_cpu64 (chunk->type));
  703. }
  704. if (csize == 0)
  705. return grub_error (GRUB_ERR_BUG,
  706. "couldn't find the chunk descriptor");
  707. if (csize > (grub_uint64_t) size)
  708. csize = size;
  709. for (j = 0; j < 2; j++)
  710. {
  711. for (i = 0; i < redundancy; i++)
  712. {
  713. struct grub_btrfs_chunk_stripe *stripe;
  714. grub_disk_addr_t paddr;
  715. stripe = (struct grub_btrfs_chunk_stripe *) (chunk + 1);
  716. /* Right now the redundancy handling is easy.
  717. With RAID5-like it will be more difficult. */
  718. stripe += stripen + i;
  719. paddr = grub_le_to_cpu64 (stripe->offset) + stripe_offset;
  720. grub_dprintf ("btrfs", "chunk 0x%" PRIxGRUB_UINT64_T
  721. "+0x%" PRIxGRUB_UINT64_T
  722. " (%d stripes (%d substripes) of %"
  723. PRIxGRUB_UINT64_T ") stripe %" PRIxGRUB_UINT64_T
  724. " maps to 0x%" PRIxGRUB_UINT64_T "\n",
  725. grub_le_to_cpu64 (key->offset),
  726. grub_le_to_cpu64 (chunk->size),
  727. grub_le_to_cpu16 (chunk->nstripes),
  728. grub_le_to_cpu16 (chunk->nsubstripes),
  729. grub_le_to_cpu64 (chunk->stripe_length),
  730. stripen, stripe->offset);
  731. grub_dprintf ("btrfs", "reading paddr 0x%" PRIxGRUB_UINT64_T
  732. " for laddr 0x%" PRIxGRUB_UINT64_T "\n", paddr,
  733. addr);
  734. dev = find_device (data, stripe->device_id, j);
  735. if (!dev)
  736. {
  737. err = grub_errno;
  738. grub_errno = GRUB_ERR_NONE;
  739. continue;
  740. }
  741. err = grub_disk_read (dev->disk, paddr >> GRUB_DISK_SECTOR_BITS,
  742. paddr & (GRUB_DISK_SECTOR_SIZE - 1),
  743. csize, buf);
  744. if (!err)
  745. break;
  746. grub_errno = GRUB_ERR_NONE;
  747. }
  748. if (i != redundancy)
  749. break;
  750. }
  751. if (err)
  752. return grub_errno = err;
  753. }
  754. size -= csize;
  755. buf = (grub_uint8_t *) buf + csize;
  756. addr += csize;
  757. if (challoc)
  758. grub_free (chunk);
  759. }
  760. return GRUB_ERR_NONE;
  761. }
  762. static struct grub_btrfs_data *
  763. grub_btrfs_mount (grub_device_t dev)
  764. {
  765. struct grub_btrfs_data *data;
  766. grub_err_t err;
  767. if (!dev->disk)
  768. {
  769. grub_error (GRUB_ERR_BAD_FS, "not BtrFS");
  770. return NULL;
  771. }
  772. data = grub_zalloc (sizeof (*data));
  773. if (!data)
  774. return NULL;
  775. err = read_sblock (dev->disk, &data->sblock);
  776. if (err)
  777. {
  778. grub_free (data);
  779. return NULL;
  780. }
  781. data->n_devices_allocated = 16;
  782. data->devices_attached = grub_malloc (sizeof (data->devices_attached[0])
  783. * data->n_devices_allocated);
  784. if (!data->devices_attached)
  785. {
  786. grub_free (data);
  787. return NULL;
  788. }
  789. data->n_devices_attached = 1;
  790. data->devices_attached[0].dev = dev;
  791. data->devices_attached[0].id = data->sblock.this_device.device_id;
  792. return data;
  793. }
  794. static void
  795. grub_btrfs_unmount (struct grub_btrfs_data *data)
  796. {
  797. unsigned i;
  798. /* The device 0 is closed one layer upper. */
  799. for (i = 1; i < data->n_devices_attached; i++)
  800. grub_device_close (data->devices_attached[i].dev);
  801. grub_free (data->devices_attached);
  802. grub_free (data->extent);
  803. grub_free (data);
  804. }
  805. static grub_err_t
  806. grub_btrfs_read_inode (struct grub_btrfs_data *data,
  807. struct grub_btrfs_inode *inode, grub_uint64_t num,
  808. grub_uint64_t tree)
  809. {
  810. struct grub_btrfs_key key_in, key_out;
  811. grub_disk_addr_t elemaddr;
  812. grub_size_t elemsize;
  813. grub_err_t err;
  814. key_in.object_id = num;
  815. key_in.type = GRUB_BTRFS_ITEM_TYPE_INODE_ITEM;
  816. key_in.offset = 0;
  817. err = lower_bound (data, &key_in, &key_out, tree, &elemaddr, &elemsize, NULL,
  818. 0);
  819. if (err)
  820. return err;
  821. if (num != key_out.object_id
  822. || key_out.type != GRUB_BTRFS_ITEM_TYPE_INODE_ITEM)
  823. return grub_error (GRUB_ERR_BAD_FS, "inode not found");
  824. return grub_btrfs_read_logical (data, elemaddr, inode, sizeof (*inode), 0);
  825. }
  826. static grub_ssize_t
  827. grub_btrfs_lzo_decompress(char *ibuf, grub_size_t isize, grub_off_t off,
  828. char *obuf, grub_size_t osize)
  829. {
  830. grub_uint32_t total_size, cblock_size;
  831. grub_size_t ret = 0;
  832. char *ibuf0 = ibuf;
  833. total_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  834. ibuf += sizeof (total_size);
  835. if (isize < total_size)
  836. return -1;
  837. /* Jump forward to first block with requested data. */
  838. while (off >= GRUB_BTRFS_LZO_BLOCK_SIZE)
  839. {
  840. /* Don't let following uint32_t cross the page boundary. */
  841. if (((ibuf - ibuf0) & 0xffc) == 0xffc)
  842. ibuf = ((ibuf - ibuf0 + 3) & ~3) + ibuf0;
  843. cblock_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  844. ibuf += sizeof (cblock_size);
  845. if (cblock_size > GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE)
  846. return -1;
  847. off -= GRUB_BTRFS_LZO_BLOCK_SIZE;
  848. ibuf += cblock_size;
  849. }
  850. while (osize > 0)
  851. {
  852. lzo_uint usize = GRUB_BTRFS_LZO_BLOCK_SIZE;
  853. /* Don't let following uint32_t cross the page boundary. */
  854. if (((ibuf - ibuf0) & 0xffc) == 0xffc)
  855. ibuf = ((ibuf - ibuf0 + 3) & ~3) + ibuf0;
  856. cblock_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  857. ibuf += sizeof (cblock_size);
  858. if (cblock_size > GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE)
  859. return -1;
  860. /* Block partially filled with requested data. */
  861. if (off > 0 || osize < GRUB_BTRFS_LZO_BLOCK_SIZE)
  862. {
  863. grub_size_t to_copy = GRUB_BTRFS_LZO_BLOCK_SIZE - off;
  864. grub_uint8_t *buf;
  865. if (to_copy > osize)
  866. to_copy = osize;
  867. buf = grub_malloc (GRUB_BTRFS_LZO_BLOCK_SIZE);
  868. if (!buf)
  869. return -1;
  870. if (lzo1x_decompress_safe ((lzo_bytep)ibuf, cblock_size, buf, &usize,
  871. NULL) != LZO_E_OK)
  872. {
  873. grub_free (buf);
  874. return -1;
  875. }
  876. if (to_copy > usize)
  877. to_copy = usize;
  878. grub_memcpy(obuf, buf + off, to_copy);
  879. osize -= to_copy;
  880. ret += to_copy;
  881. obuf += to_copy;
  882. ibuf += cblock_size;
  883. off = 0;
  884. grub_free (buf);
  885. continue;
  886. }
  887. /* Decompress whole block directly to output buffer. */
  888. if (lzo1x_decompress_safe ((lzo_bytep)ibuf, cblock_size, (lzo_bytep)obuf,
  889. &usize, NULL) != LZO_E_OK)
  890. return -1;
  891. osize -= usize;
  892. ret += usize;
  893. obuf += usize;
  894. ibuf += cblock_size;
  895. }
  896. return ret;
  897. }
  898. static grub_ssize_t
  899. grub_btrfs_extent_read (struct grub_btrfs_data *data,
  900. grub_uint64_t ino, grub_uint64_t tree,
  901. grub_off_t pos0, char *buf, grub_size_t len)
  902. {
  903. grub_off_t pos = pos0;
  904. while (len)
  905. {
  906. grub_size_t csize;
  907. grub_err_t err;
  908. grub_off_t extoff;
  909. if (!data->extent || data->extstart > pos || data->extino != ino
  910. || data->exttree != tree || data->extend <= pos)
  911. {
  912. struct grub_btrfs_key key_in, key_out;
  913. grub_disk_addr_t elemaddr;
  914. grub_size_t elemsize;
  915. grub_free (data->extent);
  916. key_in.object_id = ino;
  917. key_in.type = GRUB_BTRFS_ITEM_TYPE_EXTENT_ITEM;
  918. key_in.offset = grub_cpu_to_le64 (pos);
  919. err = lower_bound (data, &key_in, &key_out, tree,
  920. &elemaddr, &elemsize, NULL, 0);
  921. if (err)
  922. return -1;
  923. if (key_out.object_id != ino
  924. || key_out.type != GRUB_BTRFS_ITEM_TYPE_EXTENT_ITEM)
  925. {
  926. grub_error (GRUB_ERR_BAD_FS, "extent not found");
  927. return -1;
  928. }
  929. if ((grub_ssize_t) elemsize < ((char *) &data->extent->inl
  930. - (char *) data->extent))
  931. {
  932. grub_error (GRUB_ERR_BAD_FS, "extent descriptor is too short");
  933. return -1;
  934. }
  935. data->extstart = grub_le_to_cpu64 (key_out.offset);
  936. data->extsize = elemsize;
  937. data->extent = grub_malloc (elemsize);
  938. data->extino = ino;
  939. data->exttree = tree;
  940. if (!data->extent)
  941. return grub_errno;
  942. err = grub_btrfs_read_logical (data, elemaddr, data->extent,
  943. elemsize, 0);
  944. if (err)
  945. return err;
  946. data->extend = data->extstart + grub_le_to_cpu64 (data->extent->size);
  947. if (data->extent->type == GRUB_BTRFS_EXTENT_REGULAR
  948. && (char *) data->extent + elemsize
  949. >= (char *) &data->extent->filled + sizeof (data->extent->filled))
  950. data->extend =
  951. data->extstart + grub_le_to_cpu64 (data->extent->filled);
  952. grub_dprintf ("btrfs", "regular extent 0x%" PRIxGRUB_UINT64_T "+0x%"
  953. PRIxGRUB_UINT64_T "\n",
  954. grub_le_to_cpu64 (key_out.offset),
  955. grub_le_to_cpu64 (data->extent->size));
  956. if (data->extend <= pos)
  957. {
  958. grub_error (GRUB_ERR_BAD_FS, "extent not found");
  959. return -1;
  960. }
  961. }
  962. csize = data->extend - pos;
  963. extoff = pos - data->extstart;
  964. if (csize > len)
  965. csize = len;
  966. if (data->extent->encryption)
  967. {
  968. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  969. "encryption not supported");
  970. return -1;
  971. }
  972. if (data->extent->compression != GRUB_BTRFS_COMPRESSION_NONE
  973. && data->extent->compression != GRUB_BTRFS_COMPRESSION_ZLIB
  974. && data->extent->compression != GRUB_BTRFS_COMPRESSION_LZO)
  975. {
  976. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  977. "compression type 0x%x not supported",
  978. data->extent->compression);
  979. return -1;
  980. }
  981. if (data->extent->encoding)
  982. {
  983. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET, "encoding not supported");
  984. return -1;
  985. }
  986. switch (data->extent->type)
  987. {
  988. case GRUB_BTRFS_EXTENT_INLINE:
  989. if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZLIB)
  990. {
  991. if (grub_zlib_decompress (data->extent->inl, data->extsize -
  992. ((grub_uint8_t *) data->extent->inl
  993. - (grub_uint8_t *) data->extent),
  994. extoff, buf, csize)
  995. != (grub_ssize_t) csize)
  996. {
  997. if (!grub_errno)
  998. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA,
  999. "premature end of compressed");
  1000. return -1;
  1001. }
  1002. }
  1003. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_LZO)
  1004. {
  1005. if (grub_btrfs_lzo_decompress(data->extent->inl, data->extsize -
  1006. ((grub_uint8_t *) data->extent->inl
  1007. - (grub_uint8_t *) data->extent),
  1008. extoff, buf, csize)
  1009. != (grub_ssize_t) csize)
  1010. return -1;
  1011. }
  1012. else
  1013. grub_memcpy (buf, data->extent->inl + extoff, csize);
  1014. break;
  1015. case GRUB_BTRFS_EXTENT_REGULAR:
  1016. if (!data->extent->laddr)
  1017. {
  1018. grub_memset (buf, 0, csize);
  1019. break;
  1020. }
  1021. if (data->extent->compression != GRUB_BTRFS_COMPRESSION_NONE)
  1022. {
  1023. char *tmp;
  1024. grub_uint64_t zsize;
  1025. grub_ssize_t ret;
  1026. zsize = grub_le_to_cpu64 (data->extent->compressed_size);
  1027. tmp = grub_malloc (zsize);
  1028. if (!tmp)
  1029. return -1;
  1030. err = grub_btrfs_read_logical (data,
  1031. grub_le_to_cpu64 (data->extent->laddr),
  1032. tmp, zsize, 0);
  1033. if (err)
  1034. {
  1035. grub_free (tmp);
  1036. return -1;
  1037. }
  1038. if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZLIB)
  1039. ret = grub_zlib_decompress (tmp, zsize, extoff
  1040. + grub_le_to_cpu64 (data->extent->offset),
  1041. buf, csize);
  1042. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_LZO)
  1043. ret = grub_btrfs_lzo_decompress (tmp, zsize, extoff
  1044. + grub_le_to_cpu64 (data->extent->offset),
  1045. buf, csize);
  1046. else
  1047. ret = -1;
  1048. grub_free (tmp);
  1049. if (ret != (grub_ssize_t) csize)
  1050. {
  1051. if (!grub_errno)
  1052. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA,
  1053. "premature end of compressed");
  1054. return -1;
  1055. }
  1056. break;
  1057. }
  1058. err = grub_btrfs_read_logical (data,
  1059. grub_le_to_cpu64 (data->extent->laddr)
  1060. + grub_le_to_cpu64 (data->extent->offset)
  1061. + extoff, buf, csize, 0);
  1062. if (err)
  1063. return -1;
  1064. break;
  1065. default:
  1066. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1067. "unsupported extent type 0x%x", data->extent->type);
  1068. return -1;
  1069. }
  1070. buf += csize;
  1071. pos += csize;
  1072. len -= csize;
  1073. }
  1074. return pos - pos0;
  1075. }
  1076. static grub_err_t
  1077. get_root (struct grub_btrfs_data *data, struct grub_btrfs_key *key,
  1078. grub_uint64_t *tree, grub_uint8_t *type)
  1079. {
  1080. grub_err_t err;
  1081. grub_disk_addr_t elemaddr;
  1082. grub_size_t elemsize;
  1083. struct grub_btrfs_key key_out, key_in;
  1084. struct grub_btrfs_root_item ri;
  1085. key_in.object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_ROOT_VOL_OBJECTID);
  1086. key_in.offset = 0;
  1087. key_in.type = GRUB_BTRFS_ITEM_TYPE_ROOT_ITEM;
  1088. err = lower_bound (data, &key_in, &key_out,
  1089. data->sblock.root_tree,
  1090. &elemaddr, &elemsize, NULL, 0);
  1091. if (err)
  1092. return err;
  1093. if (key_in.object_id != key_out.object_id
  1094. || key_in.type != key_out.type
  1095. || key_in.offset != key_out.offset)
  1096. return grub_error (GRUB_ERR_BAD_FS, "no root");
  1097. err = grub_btrfs_read_logical (data, elemaddr, &ri,
  1098. sizeof (ri), 0);
  1099. if (err)
  1100. return err;
  1101. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1102. key->offset = 0;
  1103. key->object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  1104. *tree = ri.tree;
  1105. *type = GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY;
  1106. return GRUB_ERR_NONE;
  1107. }
  1108. static grub_err_t
  1109. find_path (struct grub_btrfs_data *data,
  1110. const char *path, struct grub_btrfs_key *key,
  1111. grub_uint64_t *tree, grub_uint8_t *type)
  1112. {
  1113. const char *slash = path;
  1114. grub_err_t err;
  1115. grub_disk_addr_t elemaddr;
  1116. grub_size_t elemsize;
  1117. grub_size_t allocated = 0;
  1118. struct grub_btrfs_dir_item *direl = NULL;
  1119. struct grub_btrfs_key key_out;
  1120. const char *ctoken;
  1121. grub_size_t ctokenlen;
  1122. char *path_alloc = NULL;
  1123. char *origpath = NULL;
  1124. unsigned symlinks_max = 32;
  1125. err = get_root (data, key, tree, type);
  1126. if (err)
  1127. return err;
  1128. origpath = grub_strdup (path);
  1129. if (!origpath)
  1130. return grub_errno;
  1131. while (1)
  1132. {
  1133. while (path[0] == '/')
  1134. path++;
  1135. if (!path[0])
  1136. break;
  1137. slash = grub_strchr (path, '/');
  1138. if (!slash)
  1139. slash = path + grub_strlen (path);
  1140. ctoken = path;
  1141. ctokenlen = slash - path;
  1142. if (*type != GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1143. {
  1144. grub_free (path_alloc);
  1145. grub_free (origpath);
  1146. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a directory"));
  1147. }
  1148. if (ctokenlen == 1 && ctoken[0] == '.')
  1149. {
  1150. path = slash;
  1151. continue;
  1152. }
  1153. if (ctokenlen == 2 && ctoken[0] == '.' && ctoken[1] == '.')
  1154. {
  1155. key->type = GRUB_BTRFS_ITEM_TYPE_INODE_REF;
  1156. key->offset = -1;
  1157. err = lower_bound (data, key, &key_out, *tree, &elemaddr, &elemsize,
  1158. NULL, 0);
  1159. if (err)
  1160. {
  1161. grub_free (direl);
  1162. grub_free (path_alloc);
  1163. grub_free (origpath);
  1164. return err;
  1165. }
  1166. if (key_out.type != key->type
  1167. || key->object_id != key_out.object_id)
  1168. {
  1169. grub_free (direl);
  1170. grub_free (path_alloc);
  1171. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1172. grub_free (origpath);
  1173. return err;
  1174. }
  1175. *type = GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY;
  1176. key->object_id = key_out.offset;
  1177. path = slash;
  1178. continue;
  1179. }
  1180. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1181. key->offset = grub_cpu_to_le64 (~grub_getcrc32c (1, ctoken, ctokenlen));
  1182. err = lower_bound (data, key, &key_out, *tree, &elemaddr, &elemsize,
  1183. NULL, 0);
  1184. if (err)
  1185. {
  1186. grub_free (direl);
  1187. grub_free (path_alloc);
  1188. grub_free (origpath);
  1189. return err;
  1190. }
  1191. if (key_cmp (key, &key_out) != 0)
  1192. {
  1193. grub_free (direl);
  1194. grub_free (path_alloc);
  1195. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1196. grub_free (origpath);
  1197. return err;
  1198. }
  1199. struct grub_btrfs_dir_item *cdirel;
  1200. if (elemsize > allocated)
  1201. {
  1202. allocated = 2 * elemsize;
  1203. grub_free (direl);
  1204. direl = grub_malloc (allocated + 1);
  1205. if (!direl)
  1206. {
  1207. grub_free (path_alloc);
  1208. grub_free (origpath);
  1209. return grub_errno;
  1210. }
  1211. }
  1212. err = grub_btrfs_read_logical (data, elemaddr, direl, elemsize, 0);
  1213. if (err)
  1214. {
  1215. grub_free (direl);
  1216. grub_free (path_alloc);
  1217. grub_free (origpath);
  1218. return err;
  1219. }
  1220. for (cdirel = direl;
  1221. (grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1222. < (grub_ssize_t) elemsize;
  1223. cdirel = (void *) ((grub_uint8_t *) (direl + 1)
  1224. + grub_le_to_cpu16 (cdirel->n)
  1225. + grub_le_to_cpu16 (cdirel->m)))
  1226. {
  1227. if (ctokenlen == grub_le_to_cpu16 (cdirel->n)
  1228. && grub_memcmp (cdirel->name, ctoken, ctokenlen) == 0)
  1229. break;
  1230. }
  1231. if ((grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1232. >= (grub_ssize_t) elemsize)
  1233. {
  1234. grub_free (direl);
  1235. grub_free (path_alloc);
  1236. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1237. grub_free (origpath);
  1238. return err;
  1239. }
  1240. path = slash;
  1241. if (cdirel->type == GRUB_BTRFS_DIR_ITEM_TYPE_SYMLINK)
  1242. {
  1243. struct grub_btrfs_inode inode;
  1244. char *tmp;
  1245. if (--symlinks_max == 0)
  1246. {
  1247. grub_free (direl);
  1248. grub_free (path_alloc);
  1249. grub_free (origpath);
  1250. return grub_error (GRUB_ERR_SYMLINK_LOOP,
  1251. N_("too deep nesting of symlinks"));
  1252. }
  1253. err = grub_btrfs_read_inode (data, &inode,
  1254. cdirel->key.object_id, *tree);
  1255. if (err)
  1256. {
  1257. grub_free (direl);
  1258. grub_free (path_alloc);
  1259. grub_free (origpath);
  1260. return err;
  1261. }
  1262. tmp = grub_malloc (grub_le_to_cpu64 (inode.size)
  1263. + grub_strlen (path) + 1);
  1264. if (!tmp)
  1265. {
  1266. grub_free (direl);
  1267. grub_free (path_alloc);
  1268. grub_free (origpath);
  1269. return grub_errno;
  1270. }
  1271. if (grub_btrfs_extent_read (data, cdirel->key.object_id,
  1272. *tree, 0, tmp,
  1273. grub_le_to_cpu64 (inode.size))
  1274. != (grub_ssize_t) grub_le_to_cpu64 (inode.size))
  1275. {
  1276. grub_free (direl);
  1277. grub_free (path_alloc);
  1278. grub_free (origpath);
  1279. grub_free (tmp);
  1280. return grub_errno;
  1281. }
  1282. grub_memcpy (tmp + grub_le_to_cpu64 (inode.size), path,
  1283. grub_strlen (path) + 1);
  1284. grub_free (path_alloc);
  1285. path = path_alloc = tmp;
  1286. if (path[0] == '/')
  1287. {
  1288. err = get_root (data, key, tree, type);
  1289. if (err)
  1290. return err;
  1291. }
  1292. continue;
  1293. }
  1294. *type = cdirel->type;
  1295. switch (cdirel->key.type)
  1296. {
  1297. case GRUB_BTRFS_ITEM_TYPE_ROOT_ITEM:
  1298. {
  1299. struct grub_btrfs_root_item ri;
  1300. err = lower_bound (data, &cdirel->key, &key_out,
  1301. data->sblock.root_tree,
  1302. &elemaddr, &elemsize, NULL, 0);
  1303. if (err)
  1304. {
  1305. grub_free (direl);
  1306. grub_free (path_alloc);
  1307. grub_free (origpath);
  1308. return err;
  1309. }
  1310. if (cdirel->key.object_id != key_out.object_id
  1311. || cdirel->key.type != key_out.type)
  1312. {
  1313. grub_free (direl);
  1314. grub_free (path_alloc);
  1315. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1316. grub_free (origpath);
  1317. return err;
  1318. }
  1319. err = grub_btrfs_read_logical (data, elemaddr, &ri,
  1320. sizeof (ri), 0);
  1321. if (err)
  1322. {
  1323. grub_free (direl);
  1324. grub_free (path_alloc);
  1325. grub_free (origpath);
  1326. return err;
  1327. }
  1328. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1329. key->offset = 0;
  1330. key->object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  1331. *tree = ri.tree;
  1332. break;
  1333. }
  1334. case GRUB_BTRFS_ITEM_TYPE_INODE_ITEM:
  1335. if (*slash && *type == GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR)
  1336. {
  1337. grub_free (direl);
  1338. grub_free (path_alloc);
  1339. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1340. grub_free (origpath);
  1341. return err;
  1342. }
  1343. *key = cdirel->key;
  1344. if (*type == GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1345. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1346. break;
  1347. default:
  1348. grub_free (path_alloc);
  1349. grub_free (origpath);
  1350. grub_free (direl);
  1351. return grub_error (GRUB_ERR_BAD_FS, "unrecognised object type 0x%x",
  1352. cdirel->key.type);
  1353. }
  1354. }
  1355. grub_free (direl);
  1356. grub_free (origpath);
  1357. grub_free (path_alloc);
  1358. return GRUB_ERR_NONE;
  1359. }
  1360. static grub_err_t
  1361. grub_btrfs_dir (grub_device_t device, const char *path,
  1362. grub_fs_dir_hook_t hook, void *hook_data)
  1363. {
  1364. struct grub_btrfs_data *data = grub_btrfs_mount (device);
  1365. struct grub_btrfs_key key_in, key_out;
  1366. grub_err_t err;
  1367. grub_disk_addr_t elemaddr;
  1368. grub_size_t elemsize;
  1369. grub_size_t allocated = 0;
  1370. struct grub_btrfs_dir_item *direl = NULL;
  1371. struct grub_btrfs_leaf_descriptor desc;
  1372. int r = 0;
  1373. grub_uint64_t tree;
  1374. grub_uint8_t type;
  1375. if (!data)
  1376. return grub_errno;
  1377. err = find_path (data, path, &key_in, &tree, &type);
  1378. if (err)
  1379. {
  1380. grub_btrfs_unmount (data);
  1381. return err;
  1382. }
  1383. if (type != GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1384. {
  1385. grub_btrfs_unmount (data);
  1386. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a directory"));
  1387. }
  1388. err = lower_bound (data, &key_in, &key_out, tree,
  1389. &elemaddr, &elemsize, &desc, 0);
  1390. if (err)
  1391. {
  1392. grub_btrfs_unmount (data);
  1393. return err;
  1394. }
  1395. if (key_out.type != GRUB_BTRFS_ITEM_TYPE_DIR_ITEM
  1396. || key_out.object_id != key_in.object_id)
  1397. {
  1398. r = next (data, &desc, &elemaddr, &elemsize, &key_out);
  1399. if (r <= 0)
  1400. goto out;
  1401. }
  1402. do
  1403. {
  1404. struct grub_btrfs_dir_item *cdirel;
  1405. if (key_out.type != GRUB_BTRFS_ITEM_TYPE_DIR_ITEM
  1406. || key_out.object_id != key_in.object_id)
  1407. {
  1408. r = 0;
  1409. break;
  1410. }
  1411. if (elemsize > allocated)
  1412. {
  1413. allocated = 2 * elemsize;
  1414. grub_free (direl);
  1415. direl = grub_malloc (allocated + 1);
  1416. if (!direl)
  1417. {
  1418. r = -grub_errno;
  1419. break;
  1420. }
  1421. }
  1422. err = grub_btrfs_read_logical (data, elemaddr, direl, elemsize, 0);
  1423. if (err)
  1424. {
  1425. r = -err;
  1426. break;
  1427. }
  1428. for (cdirel = direl;
  1429. (grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1430. < (grub_ssize_t) elemsize;
  1431. cdirel = (void *) ((grub_uint8_t *) (direl + 1)
  1432. + grub_le_to_cpu16 (cdirel->n)
  1433. + grub_le_to_cpu16 (cdirel->m)))
  1434. {
  1435. char c;
  1436. struct grub_btrfs_inode inode;
  1437. struct grub_dirhook_info info;
  1438. err = grub_btrfs_read_inode (data, &inode, cdirel->key.object_id,
  1439. tree);
  1440. grub_memset (&info, 0, sizeof (info));
  1441. if (err)
  1442. grub_errno = GRUB_ERR_NONE;
  1443. else
  1444. {
  1445. info.mtime = grub_le_to_cpu64 (inode.mtime.sec);
  1446. info.mtimeset = 1;
  1447. }
  1448. c = cdirel->name[grub_le_to_cpu16 (cdirel->n)];
  1449. cdirel->name[grub_le_to_cpu16 (cdirel->n)] = 0;
  1450. info.dir = (cdirel->type == GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY);
  1451. if (hook (cdirel->name, &info, hook_data))
  1452. goto out;
  1453. cdirel->name[grub_le_to_cpu16 (cdirel->n)] = c;
  1454. }
  1455. r = next (data, &desc, &elemaddr, &elemsize, &key_out);
  1456. }
  1457. while (r > 0);
  1458. out:
  1459. grub_free (direl);
  1460. free_iterator (&desc);
  1461. grub_btrfs_unmount (data);
  1462. return -r;
  1463. }
  1464. static grub_err_t
  1465. grub_btrfs_open (struct grub_file *file, const char *name)
  1466. {
  1467. struct grub_btrfs_data *data = grub_btrfs_mount (file->device);
  1468. grub_err_t err;
  1469. struct grub_btrfs_inode inode;
  1470. grub_uint8_t type;
  1471. struct grub_btrfs_key key_in;
  1472. if (!data)
  1473. return grub_errno;
  1474. err = find_path (data, name, &key_in, &data->tree, &type);
  1475. if (err)
  1476. {
  1477. grub_btrfs_unmount (data);
  1478. return err;
  1479. }
  1480. if (type != GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR)
  1481. {
  1482. grub_btrfs_unmount (data);
  1483. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a regular file"));
  1484. }
  1485. data->inode = key_in.object_id;
  1486. err = grub_btrfs_read_inode (data, &inode, data->inode, data->tree);
  1487. if (err)
  1488. {
  1489. grub_btrfs_unmount (data);
  1490. return err;
  1491. }
  1492. file->data = data;
  1493. file->size = grub_le_to_cpu64 (inode.size);
  1494. return err;
  1495. }
  1496. static grub_err_t
  1497. grub_btrfs_close (grub_file_t file)
  1498. {
  1499. grub_btrfs_unmount (file->data);
  1500. return GRUB_ERR_NONE;
  1501. }
  1502. static grub_ssize_t
  1503. grub_btrfs_read (grub_file_t file, char *buf, grub_size_t len)
  1504. {
  1505. struct grub_btrfs_data *data = file->data;
  1506. return grub_btrfs_extent_read (data, data->inode,
  1507. data->tree, file->offset, buf, len);
  1508. }
  1509. static grub_err_t
  1510. grub_btrfs_uuid (grub_device_t device, char **uuid)
  1511. {
  1512. struct grub_btrfs_data *data;
  1513. *uuid = NULL;
  1514. data = grub_btrfs_mount (device);
  1515. if (!data)
  1516. return grub_errno;
  1517. *uuid = grub_xasprintf ("%04x%04x-%04x-%04x-%04x-%04x%04x%04x",
  1518. grub_be_to_cpu16 (data->sblock.uuid[0]),
  1519. grub_be_to_cpu16 (data->sblock.uuid[1]),
  1520. grub_be_to_cpu16 (data->sblock.uuid[2]),
  1521. grub_be_to_cpu16 (data->sblock.uuid[3]),
  1522. grub_be_to_cpu16 (data->sblock.uuid[4]),
  1523. grub_be_to_cpu16 (data->sblock.uuid[5]),
  1524. grub_be_to_cpu16 (data->sblock.uuid[6]),
  1525. grub_be_to_cpu16 (data->sblock.uuid[7]));
  1526. grub_btrfs_unmount (data);
  1527. return grub_errno;
  1528. }
  1529. static grub_err_t
  1530. grub_btrfs_label (grub_device_t device, char **label)
  1531. {
  1532. struct grub_btrfs_data *data;
  1533. *label = NULL;
  1534. data = grub_btrfs_mount (device);
  1535. if (!data)
  1536. return grub_errno;
  1537. *label = grub_strndup (data->sblock.label, sizeof (data->sblock.label));
  1538. grub_btrfs_unmount (data);
  1539. return grub_errno;
  1540. }
  1541. #ifdef GRUB_UTIL
  1542. static grub_err_t
  1543. grub_btrfs_embed (grub_device_t device __attribute__ ((unused)),
  1544. unsigned int *nsectors,
  1545. unsigned int max_nsectors,
  1546. grub_embed_type_t embed_type,
  1547. grub_disk_addr_t **sectors)
  1548. {
  1549. unsigned i;
  1550. if (embed_type != GRUB_EMBED_PCBIOS)
  1551. return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1552. "BtrFS currently supports only PC-BIOS embedding");
  1553. if (64 * 2 - 1 < *nsectors)
  1554. return grub_error (GRUB_ERR_OUT_OF_RANGE,
  1555. N_("your core.img is unusually large. "
  1556. "It won't fit in the embedding area"));
  1557. *nsectors = 64 * 2 - 1;
  1558. if (*nsectors > max_nsectors)
  1559. *nsectors = max_nsectors;
  1560. *sectors = grub_malloc (*nsectors * sizeof (**sectors));
  1561. if (!*sectors)
  1562. return grub_errno;
  1563. for (i = 0; i < *nsectors; i++)
  1564. (*sectors)[i] = i + 1;
  1565. return GRUB_ERR_NONE;
  1566. }
  1567. #endif
  1568. static struct grub_fs grub_btrfs_fs = {
  1569. .name = "btrfs",
  1570. .dir = grub_btrfs_dir,
  1571. .open = grub_btrfs_open,
  1572. .read = grub_btrfs_read,
  1573. .close = grub_btrfs_close,
  1574. .uuid = grub_btrfs_uuid,
  1575. .label = grub_btrfs_label,
  1576. #ifdef GRUB_UTIL
  1577. .embed = grub_btrfs_embed,
  1578. .reserved_first_sector = 1,
  1579. .blocklist_install = 0,
  1580. #endif
  1581. };
  1582. GRUB_MOD_INIT (btrfs)
  1583. {
  1584. grub_fs_register (&grub_btrfs_fs);
  1585. }
  1586. GRUB_MOD_FINI (btrfs)
  1587. {
  1588. grub_fs_unregister (&grub_btrfs_fs);
  1589. }