btrfs.c 58 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197
  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. /*
  20. * Tell zstd to expose functions that aren't part of the stable API, which
  21. * aren't safe to use when linking against a dynamic library. We vendor in a
  22. * specific zstd version, so we know what we're getting. We need these unstable
  23. * functions to provide our own allocator, which uses grub_malloc(), to zstd.
  24. */
  25. #define ZSTD_STATIC_LINKING_ONLY
  26. #include <grub/err.h>
  27. #include <grub/file.h>
  28. #include <grub/mm.h>
  29. #include <grub/misc.h>
  30. #include <grub/disk.h>
  31. #include <grub/dl.h>
  32. #include <grub/types.h>
  33. #include <grub/lib/crc.h>
  34. #include <grub/deflate.h>
  35. #include <minilzo.h>
  36. #include <zstd.h>
  37. #include <grub/i18n.h>
  38. #include <grub/btrfs.h>
  39. #include <grub/crypto.h>
  40. #include <grub/diskfilter.h>
  41. GRUB_MOD_LICENSE ("GPLv3+");
  42. #define GRUB_BTRFS_SIGNATURE "_BHRfS_M"
  43. /* From http://www.oberhumer.com/opensource/lzo/lzofaq.php
  44. * LZO will expand incompressible data by a little amount. I still haven't
  45. * computed the exact values, but I suggest using these formulas for
  46. * a worst-case expansion calculation:
  47. *
  48. * output_block_size = input_block_size + (input_block_size / 16) + 64 + 3
  49. * */
  50. #define GRUB_BTRFS_LZO_BLOCK_SIZE 4096
  51. #define GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE (GRUB_BTRFS_LZO_BLOCK_SIZE + \
  52. (GRUB_BTRFS_LZO_BLOCK_SIZE / 16) + 64 + 3)
  53. #define ZSTD_BTRFS_MAX_WINDOWLOG 17
  54. #define ZSTD_BTRFS_MAX_INPUT (1 << ZSTD_BTRFS_MAX_WINDOWLOG)
  55. typedef grub_uint8_t grub_btrfs_checksum_t[0x20];
  56. typedef grub_uint16_t grub_btrfs_uuid_t[8];
  57. struct grub_btrfs_device
  58. {
  59. grub_uint64_t device_id;
  60. grub_uint64_t size;
  61. grub_uint8_t dummy[0x62 - 0x10];
  62. } GRUB_PACKED;
  63. struct grub_btrfs_superblock
  64. {
  65. grub_btrfs_checksum_t checksum;
  66. grub_btrfs_uuid_t uuid;
  67. grub_uint8_t dummy[0x10];
  68. grub_uint8_t signature[sizeof (GRUB_BTRFS_SIGNATURE) - 1];
  69. grub_uint64_t generation;
  70. grub_uint64_t root_tree;
  71. grub_uint64_t chunk_tree;
  72. grub_uint8_t dummy2[0x20];
  73. grub_uint64_t root_dir_objectid;
  74. grub_uint8_t dummy3[0x41];
  75. struct grub_btrfs_device this_device;
  76. char label[0x100];
  77. grub_uint8_t dummy4[0x100];
  78. grub_uint8_t bootstrap_mapping[0x800];
  79. } GRUB_PACKED;
  80. struct btrfs_header
  81. {
  82. grub_btrfs_checksum_t checksum;
  83. grub_btrfs_uuid_t uuid;
  84. grub_uint64_t bytenr;
  85. grub_uint8_t dummy[0x28];
  86. grub_uint32_t nitems;
  87. grub_uint8_t level;
  88. } GRUB_PACKED;
  89. struct grub_btrfs_device_desc
  90. {
  91. grub_device_t dev;
  92. grub_uint64_t id;
  93. };
  94. struct grub_btrfs_data
  95. {
  96. struct grub_btrfs_superblock sblock;
  97. grub_uint64_t tree;
  98. grub_uint64_t inode;
  99. struct grub_btrfs_device_desc *devices_attached;
  100. unsigned n_devices_attached;
  101. unsigned n_devices_allocated;
  102. /* Cached extent data. */
  103. grub_uint64_t extstart;
  104. grub_uint64_t extend;
  105. grub_uint64_t extino;
  106. grub_uint64_t exttree;
  107. grub_size_t extsize;
  108. struct grub_btrfs_extent_data *extent;
  109. };
  110. struct grub_btrfs_chunk_item
  111. {
  112. grub_uint64_t size;
  113. grub_uint64_t dummy;
  114. grub_uint64_t stripe_length;
  115. grub_uint64_t type;
  116. #define GRUB_BTRFS_CHUNK_TYPE_BITS_DONTCARE 0x07
  117. #define GRUB_BTRFS_CHUNK_TYPE_SINGLE 0x00
  118. #define GRUB_BTRFS_CHUNK_TYPE_RAID0 0x08
  119. #define GRUB_BTRFS_CHUNK_TYPE_RAID1 0x10
  120. #define GRUB_BTRFS_CHUNK_TYPE_DUPLICATED 0x20
  121. #define GRUB_BTRFS_CHUNK_TYPE_RAID10 0x40
  122. #define GRUB_BTRFS_CHUNK_TYPE_RAID5 0x80
  123. #define GRUB_BTRFS_CHUNK_TYPE_RAID6 0x100
  124. grub_uint8_t dummy2[0xc];
  125. grub_uint16_t nstripes;
  126. grub_uint16_t nsubstripes;
  127. } GRUB_PACKED;
  128. struct grub_btrfs_chunk_stripe
  129. {
  130. grub_uint64_t device_id;
  131. grub_uint64_t offset;
  132. grub_btrfs_uuid_t device_uuid;
  133. } GRUB_PACKED;
  134. struct grub_btrfs_leaf_node
  135. {
  136. struct grub_btrfs_key key;
  137. grub_uint32_t offset;
  138. grub_uint32_t size;
  139. } GRUB_PACKED;
  140. struct grub_btrfs_internal_node
  141. {
  142. struct grub_btrfs_key key;
  143. grub_uint64_t addr;
  144. grub_uint64_t dummy;
  145. } GRUB_PACKED;
  146. struct grub_btrfs_dir_item
  147. {
  148. struct grub_btrfs_key key;
  149. grub_uint8_t dummy[8];
  150. grub_uint16_t m;
  151. grub_uint16_t n;
  152. #define GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR 1
  153. #define GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY 2
  154. #define GRUB_BTRFS_DIR_ITEM_TYPE_SYMLINK 7
  155. grub_uint8_t type;
  156. char name[0];
  157. } GRUB_PACKED;
  158. struct grub_btrfs_leaf_descriptor
  159. {
  160. unsigned depth;
  161. unsigned allocated;
  162. struct
  163. {
  164. grub_disk_addr_t addr;
  165. unsigned iter;
  166. unsigned maxiter;
  167. int leaf;
  168. } *data;
  169. };
  170. struct grub_btrfs_time
  171. {
  172. grub_int64_t sec;
  173. grub_uint32_t nanosec;
  174. } GRUB_PACKED;
  175. struct grub_btrfs_inode
  176. {
  177. grub_uint8_t dummy1[0x10];
  178. grub_uint64_t size;
  179. grub_uint8_t dummy2[0x70];
  180. struct grub_btrfs_time mtime;
  181. } GRUB_PACKED;
  182. struct grub_btrfs_extent_data
  183. {
  184. grub_uint64_t dummy;
  185. grub_uint64_t size;
  186. grub_uint8_t compression;
  187. grub_uint8_t encryption;
  188. grub_uint16_t encoding;
  189. grub_uint8_t type;
  190. union
  191. {
  192. char inl[0];
  193. struct
  194. {
  195. grub_uint64_t laddr;
  196. grub_uint64_t compressed_size;
  197. grub_uint64_t offset;
  198. grub_uint64_t filled;
  199. };
  200. };
  201. } GRUB_PACKED;
  202. #define GRUB_BTRFS_EXTENT_INLINE 0
  203. #define GRUB_BTRFS_EXTENT_REGULAR 1
  204. #define GRUB_BTRFS_COMPRESSION_NONE 0
  205. #define GRUB_BTRFS_COMPRESSION_ZLIB 1
  206. #define GRUB_BTRFS_COMPRESSION_LZO 2
  207. #define GRUB_BTRFS_COMPRESSION_ZSTD 3
  208. #define GRUB_BTRFS_OBJECT_ID_CHUNK 0x100
  209. static grub_disk_addr_t superblock_sectors[] = { 64 * 2, 64 * 1024 * 2,
  210. 256 * 1048576 * 2, 1048576ULL * 1048576ULL * 2
  211. };
  212. static grub_err_t
  213. grub_btrfs_read_logical (struct grub_btrfs_data *data,
  214. grub_disk_addr_t addr, void *buf, grub_size_t size,
  215. int recursion_depth);
  216. static grub_err_t
  217. read_sblock (grub_disk_t disk, struct grub_btrfs_superblock *sb)
  218. {
  219. struct grub_btrfs_superblock sblock;
  220. unsigned i;
  221. grub_err_t err = GRUB_ERR_NONE;
  222. for (i = 0; i < ARRAY_SIZE (superblock_sectors); i++)
  223. {
  224. /* Don't try additional superblocks beyond device size. */
  225. if (i && (grub_le_to_cpu64 (sblock.this_device.size)
  226. >> GRUB_DISK_SECTOR_BITS) <= superblock_sectors[i])
  227. break;
  228. err = grub_disk_read (disk, superblock_sectors[i], 0,
  229. sizeof (sblock), &sblock);
  230. if (err == GRUB_ERR_OUT_OF_RANGE)
  231. break;
  232. if (grub_memcmp ((char *) sblock.signature, GRUB_BTRFS_SIGNATURE,
  233. sizeof (GRUB_BTRFS_SIGNATURE) - 1) != 0)
  234. break;
  235. if (i == 0 || grub_le_to_cpu64 (sblock.generation)
  236. > grub_le_to_cpu64 (sb->generation))
  237. grub_memcpy (sb, &sblock, sizeof (sblock));
  238. }
  239. if ((err == GRUB_ERR_OUT_OF_RANGE || !err) && i == 0)
  240. return grub_error (GRUB_ERR_BAD_FS, "not a Btrfs filesystem");
  241. if (err == GRUB_ERR_OUT_OF_RANGE)
  242. grub_errno = err = GRUB_ERR_NONE;
  243. return err;
  244. }
  245. static int
  246. key_cmp (const struct grub_btrfs_key *a, const struct grub_btrfs_key *b)
  247. {
  248. if (grub_le_to_cpu64 (a->object_id) < grub_le_to_cpu64 (b->object_id))
  249. return -1;
  250. if (grub_le_to_cpu64 (a->object_id) > grub_le_to_cpu64 (b->object_id))
  251. return +1;
  252. if (a->type < b->type)
  253. return -1;
  254. if (a->type > b->type)
  255. return +1;
  256. if (grub_le_to_cpu64 (a->offset) < grub_le_to_cpu64 (b->offset))
  257. return -1;
  258. if (grub_le_to_cpu64 (a->offset) > grub_le_to_cpu64 (b->offset))
  259. return +1;
  260. return 0;
  261. }
  262. static void
  263. free_iterator (struct grub_btrfs_leaf_descriptor *desc)
  264. {
  265. grub_free (desc->data);
  266. }
  267. static grub_err_t
  268. check_btrfs_header (struct grub_btrfs_data *data, struct btrfs_header *header,
  269. grub_disk_addr_t addr)
  270. {
  271. if (grub_le_to_cpu64 (header->bytenr) != addr)
  272. {
  273. grub_dprintf ("btrfs", "btrfs_header.bytenr is not equal node addr\n");
  274. return grub_error (GRUB_ERR_BAD_FS,
  275. "header bytenr is not equal node addr");
  276. }
  277. if (grub_memcmp (data->sblock.uuid, header->uuid, sizeof(grub_btrfs_uuid_t)))
  278. {
  279. grub_dprintf ("btrfs", "btrfs_header.uuid doesn't match sblock uuid\n");
  280. return grub_error (GRUB_ERR_BAD_FS,
  281. "header uuid doesn't match sblock uuid");
  282. }
  283. return GRUB_ERR_NONE;
  284. }
  285. static grub_err_t
  286. save_ref (struct grub_btrfs_leaf_descriptor *desc,
  287. grub_disk_addr_t addr, unsigned i, unsigned m, int l)
  288. {
  289. desc->depth++;
  290. if (desc->allocated < desc->depth)
  291. {
  292. void *newdata;
  293. desc->allocated *= 2;
  294. newdata = grub_realloc (desc->data, sizeof (desc->data[0])
  295. * desc->allocated);
  296. if (!newdata)
  297. return grub_errno;
  298. desc->data = newdata;
  299. }
  300. desc->data[desc->depth - 1].addr = addr;
  301. desc->data[desc->depth - 1].iter = i;
  302. desc->data[desc->depth - 1].maxiter = m;
  303. desc->data[desc->depth - 1].leaf = l;
  304. return GRUB_ERR_NONE;
  305. }
  306. static int
  307. next (struct grub_btrfs_data *data,
  308. struct grub_btrfs_leaf_descriptor *desc,
  309. grub_disk_addr_t * outaddr, grub_size_t * outsize,
  310. struct grub_btrfs_key *key_out)
  311. {
  312. grub_err_t err;
  313. struct grub_btrfs_leaf_node leaf;
  314. for (; desc->depth > 0; desc->depth--)
  315. {
  316. desc->data[desc->depth - 1].iter++;
  317. if (desc->data[desc->depth - 1].iter
  318. < desc->data[desc->depth - 1].maxiter)
  319. break;
  320. }
  321. if (desc->depth == 0)
  322. return 0;
  323. while (!desc->data[desc->depth - 1].leaf)
  324. {
  325. struct grub_btrfs_internal_node node;
  326. struct btrfs_header head;
  327. err = grub_btrfs_read_logical (data, desc->data[desc->depth - 1].iter
  328. * sizeof (node)
  329. + sizeof (struct btrfs_header)
  330. + desc->data[desc->depth - 1].addr,
  331. &node, sizeof (node), 0);
  332. if (err)
  333. return -err;
  334. err = grub_btrfs_read_logical (data, grub_le_to_cpu64 (node.addr),
  335. &head, sizeof (head), 0);
  336. check_btrfs_header (data, &head, grub_le_to_cpu64 (node.addr));
  337. if (err)
  338. return -err;
  339. save_ref (desc, grub_le_to_cpu64 (node.addr), 0,
  340. grub_le_to_cpu32 (head.nitems), !head.level);
  341. }
  342. err = grub_btrfs_read_logical (data, desc->data[desc->depth - 1].iter
  343. * sizeof (leaf)
  344. + sizeof (struct btrfs_header)
  345. + desc->data[desc->depth - 1].addr, &leaf,
  346. sizeof (leaf), 0);
  347. if (err)
  348. return -err;
  349. *outsize = grub_le_to_cpu32 (leaf.size);
  350. *outaddr = desc->data[desc->depth - 1].addr + sizeof (struct btrfs_header)
  351. + grub_le_to_cpu32 (leaf.offset);
  352. *key_out = leaf.key;
  353. return 1;
  354. }
  355. static grub_err_t
  356. lower_bound (struct grub_btrfs_data *data,
  357. const struct grub_btrfs_key *key_in,
  358. struct grub_btrfs_key *key_out,
  359. grub_uint64_t root,
  360. grub_disk_addr_t *outaddr, grub_size_t *outsize,
  361. struct grub_btrfs_leaf_descriptor *desc,
  362. int recursion_depth)
  363. {
  364. grub_disk_addr_t addr = grub_le_to_cpu64 (root);
  365. int depth = -1;
  366. if (desc)
  367. {
  368. desc->allocated = 16;
  369. desc->depth = 0;
  370. desc->data = grub_malloc (sizeof (desc->data[0]) * desc->allocated);
  371. if (!desc->data)
  372. return grub_errno;
  373. }
  374. /* > 2 would work as well but be robust and allow a bit more just in case.
  375. */
  376. if (recursion_depth > 10)
  377. return grub_error (GRUB_ERR_BAD_FS, "too deep btrfs virtual nesting");
  378. grub_dprintf ("btrfs",
  379. "retrieving %" PRIxGRUB_UINT64_T
  380. " %x %" PRIxGRUB_UINT64_T "\n",
  381. key_in->object_id, key_in->type, key_in->offset);
  382. while (1)
  383. {
  384. grub_err_t err;
  385. struct btrfs_header head;
  386. reiter:
  387. depth++;
  388. /* FIXME: preread few nodes into buffer. */
  389. err = grub_btrfs_read_logical (data, addr, &head, sizeof (head),
  390. recursion_depth + 1);
  391. check_btrfs_header (data, &head, addr);
  392. if (err)
  393. return err;
  394. addr += sizeof (head);
  395. if (head.level)
  396. {
  397. unsigned i;
  398. struct grub_btrfs_internal_node node, node_last;
  399. int have_last = 0;
  400. grub_memset (&node_last, 0, sizeof (node_last));
  401. for (i = 0; i < grub_le_to_cpu32 (head.nitems); i++)
  402. {
  403. err = grub_btrfs_read_logical (data, addr + i * sizeof (node),
  404. &node, sizeof (node),
  405. recursion_depth + 1);
  406. if (err)
  407. return err;
  408. grub_dprintf ("btrfs",
  409. "internal node (depth %d) %" PRIxGRUB_UINT64_T
  410. " %x %" PRIxGRUB_UINT64_T "\n", depth,
  411. node.key.object_id, node.key.type,
  412. node.key.offset);
  413. if (key_cmp (&node.key, key_in) == 0)
  414. {
  415. err = GRUB_ERR_NONE;
  416. if (desc)
  417. err = save_ref (desc, addr - sizeof (head), i,
  418. grub_le_to_cpu32 (head.nitems), 0);
  419. if (err)
  420. return err;
  421. addr = grub_le_to_cpu64 (node.addr);
  422. goto reiter;
  423. }
  424. if (key_cmp (&node.key, key_in) > 0)
  425. break;
  426. node_last = node;
  427. have_last = 1;
  428. }
  429. if (have_last)
  430. {
  431. err = GRUB_ERR_NONE;
  432. if (desc)
  433. err = save_ref (desc, addr - sizeof (head), i - 1,
  434. grub_le_to_cpu32 (head.nitems), 0);
  435. if (err)
  436. return err;
  437. addr = grub_le_to_cpu64 (node_last.addr);
  438. goto reiter;
  439. }
  440. *outsize = 0;
  441. *outaddr = 0;
  442. grub_memset (key_out, 0, sizeof (*key_out));
  443. if (desc)
  444. return save_ref (desc, addr - sizeof (head), -1,
  445. grub_le_to_cpu32 (head.nitems), 0);
  446. return GRUB_ERR_NONE;
  447. }
  448. {
  449. unsigned i;
  450. struct grub_btrfs_leaf_node leaf, leaf_last;
  451. int have_last = 0;
  452. for (i = 0; i < grub_le_to_cpu32 (head.nitems); i++)
  453. {
  454. err = grub_btrfs_read_logical (data, addr + i * sizeof (leaf),
  455. &leaf, sizeof (leaf),
  456. recursion_depth + 1);
  457. if (err)
  458. return err;
  459. grub_dprintf ("btrfs",
  460. "leaf (depth %d) %" PRIxGRUB_UINT64_T
  461. " %x %" PRIxGRUB_UINT64_T "\n", depth,
  462. leaf.key.object_id, leaf.key.type, leaf.key.offset);
  463. if (key_cmp (&leaf.key, key_in) == 0)
  464. {
  465. grub_memcpy (key_out, &leaf.key, sizeof (*key_out));
  466. *outsize = grub_le_to_cpu32 (leaf.size);
  467. *outaddr = addr + grub_le_to_cpu32 (leaf.offset);
  468. if (desc)
  469. return save_ref (desc, addr - sizeof (head), i,
  470. grub_le_to_cpu32 (head.nitems), 1);
  471. return GRUB_ERR_NONE;
  472. }
  473. if (key_cmp (&leaf.key, key_in) > 0)
  474. break;
  475. have_last = 1;
  476. leaf_last = leaf;
  477. }
  478. if (have_last)
  479. {
  480. grub_memcpy (key_out, &leaf_last.key, sizeof (*key_out));
  481. *outsize = grub_le_to_cpu32 (leaf_last.size);
  482. *outaddr = addr + grub_le_to_cpu32 (leaf_last.offset);
  483. if (desc)
  484. return save_ref (desc, addr - sizeof (head), i - 1,
  485. grub_le_to_cpu32 (head.nitems), 1);
  486. return GRUB_ERR_NONE;
  487. }
  488. *outsize = 0;
  489. *outaddr = 0;
  490. grub_memset (key_out, 0, sizeof (*key_out));
  491. if (desc)
  492. return save_ref (desc, addr - sizeof (head), -1,
  493. grub_le_to_cpu32 (head.nitems), 1);
  494. return GRUB_ERR_NONE;
  495. }
  496. }
  497. }
  498. /* Context for find_device. */
  499. struct find_device_ctx
  500. {
  501. struct grub_btrfs_data *data;
  502. grub_uint64_t id;
  503. grub_device_t dev_found;
  504. };
  505. /* Helper for find_device. */
  506. static int
  507. find_device_iter (const char *name, void *data)
  508. {
  509. struct find_device_ctx *ctx = data;
  510. grub_device_t dev;
  511. grub_err_t err;
  512. struct grub_btrfs_superblock sb;
  513. dev = grub_device_open (name);
  514. if (!dev)
  515. return 0;
  516. if (!dev->disk)
  517. {
  518. grub_device_close (dev);
  519. return 0;
  520. }
  521. err = read_sblock (dev->disk, &sb);
  522. if (err == GRUB_ERR_BAD_FS)
  523. {
  524. grub_device_close (dev);
  525. grub_errno = GRUB_ERR_NONE;
  526. return 0;
  527. }
  528. if (err)
  529. {
  530. grub_device_close (dev);
  531. grub_print_error ();
  532. return 0;
  533. }
  534. if (grub_memcmp (ctx->data->sblock.uuid, sb.uuid, sizeof (sb.uuid)) != 0
  535. || sb.this_device.device_id != ctx->id)
  536. {
  537. grub_device_close (dev);
  538. return 0;
  539. }
  540. ctx->dev_found = dev;
  541. return 1;
  542. }
  543. static grub_device_t
  544. find_device (struct grub_btrfs_data *data, grub_uint64_t id)
  545. {
  546. struct find_device_ctx ctx = {
  547. .data = data,
  548. .id = id,
  549. .dev_found = NULL
  550. };
  551. unsigned i;
  552. for (i = 0; i < data->n_devices_attached; i++)
  553. if (id == data->devices_attached[i].id)
  554. return data->devices_attached[i].dev;
  555. grub_device_iterate (find_device_iter, &ctx);
  556. data->n_devices_attached++;
  557. if (data->n_devices_attached > data->n_devices_allocated)
  558. {
  559. void *tmp;
  560. data->n_devices_allocated = 2 * data->n_devices_attached + 1;
  561. data->devices_attached
  562. = grub_realloc (tmp = data->devices_attached,
  563. data->n_devices_allocated
  564. * sizeof (data->devices_attached[0]));
  565. if (!data->devices_attached)
  566. {
  567. if (ctx.dev_found)
  568. grub_device_close (ctx.dev_found);
  569. data->devices_attached = tmp;
  570. return NULL;
  571. }
  572. }
  573. data->devices_attached[data->n_devices_attached - 1].id = id;
  574. data->devices_attached[data->n_devices_attached - 1].dev = ctx.dev_found;
  575. return ctx.dev_found;
  576. }
  577. static grub_err_t
  578. btrfs_read_from_chunk (struct grub_btrfs_data *data,
  579. struct grub_btrfs_chunk_item *chunk,
  580. grub_uint64_t stripen, grub_uint64_t stripe_offset,
  581. int redundancy, grub_uint64_t csize,
  582. void *buf)
  583. {
  584. struct grub_btrfs_chunk_stripe *stripe;
  585. grub_disk_addr_t paddr;
  586. grub_device_t dev;
  587. grub_err_t err;
  588. stripe = (struct grub_btrfs_chunk_stripe *) (chunk + 1);
  589. /* Right now the redundancy handling is easy.
  590. With RAID5-like it will be more difficult. */
  591. stripe += stripen + redundancy;
  592. paddr = grub_le_to_cpu64 (stripe->offset) + stripe_offset;
  593. grub_dprintf ("btrfs", "stripe %" PRIxGRUB_UINT64_T
  594. " maps to 0x%" PRIxGRUB_UINT64_T "\n"
  595. "reading paddr 0x%" PRIxGRUB_UINT64_T "\n",
  596. stripen, stripe->offset, paddr);
  597. dev = find_device (data, stripe->device_id);
  598. if (!dev)
  599. {
  600. grub_dprintf ("btrfs",
  601. "couldn't find a necessary member device "
  602. "of multi-device filesystem\n");
  603. grub_errno = GRUB_ERR_NONE;
  604. return GRUB_ERR_READ_ERROR;
  605. }
  606. err = grub_disk_read (dev->disk, paddr >> GRUB_DISK_SECTOR_BITS,
  607. paddr & (GRUB_DISK_SECTOR_SIZE - 1),
  608. csize, buf);
  609. return err;
  610. }
  611. struct raid56_buffer {
  612. void *buf;
  613. int data_is_valid;
  614. };
  615. static void
  616. rebuild_raid5 (char *dest, struct raid56_buffer *buffers,
  617. grub_uint64_t nstripes, grub_uint64_t csize)
  618. {
  619. grub_uint64_t i;
  620. int first;
  621. for(i = 0; buffers[i].data_is_valid && i < nstripes; i++);
  622. if (i == nstripes)
  623. {
  624. grub_dprintf ("btrfs", "called rebuild_raid5(), but all disks are OK\n");
  625. return;
  626. }
  627. grub_dprintf ("btrfs", "rebuilding RAID 5 stripe #%" PRIuGRUB_UINT64_T "\n", i);
  628. for (i = 0, first = 1; i < nstripes; i++)
  629. {
  630. if (!buffers[i].data_is_valid)
  631. continue;
  632. if (first) {
  633. grub_memcpy(dest, buffers[i].buf, csize);
  634. first = 0;
  635. } else
  636. grub_crypto_xor (dest, dest, buffers[i].buf, csize);
  637. }
  638. }
  639. static grub_err_t
  640. raid6_recover_read_buffer (void *data, int disk_nr,
  641. grub_uint64_t addr __attribute__ ((unused)),
  642. void *dest, grub_size_t size)
  643. {
  644. struct raid56_buffer *buffers = data;
  645. if (!buffers[disk_nr].data_is_valid)
  646. return grub_errno = GRUB_ERR_READ_ERROR;
  647. grub_memcpy(dest, buffers[disk_nr].buf, size);
  648. return grub_errno = GRUB_ERR_NONE;
  649. }
  650. static void
  651. rebuild_raid6 (struct raid56_buffer *buffers, grub_uint64_t nstripes,
  652. grub_uint64_t csize, grub_uint64_t parities_pos, void *dest,
  653. grub_uint64_t stripen)
  654. {
  655. grub_raid6_recover_gen (buffers, nstripes, stripen, parities_pos,
  656. dest, 0, csize, 0, raid6_recover_read_buffer);
  657. }
  658. static grub_err_t
  659. raid56_read_retry (struct grub_btrfs_data *data,
  660. struct grub_btrfs_chunk_item *chunk,
  661. grub_uint64_t stripe_offset, grub_uint64_t stripen,
  662. grub_uint64_t csize, void *buf, grub_uint64_t parities_pos)
  663. {
  664. struct raid56_buffer *buffers;
  665. grub_uint64_t nstripes = grub_le_to_cpu16 (chunk->nstripes);
  666. grub_uint64_t chunk_type = grub_le_to_cpu64 (chunk->type);
  667. grub_err_t ret = GRUB_ERR_OUT_OF_MEMORY;
  668. grub_uint64_t i, failed_devices;
  669. buffers = grub_zalloc (sizeof(*buffers) * nstripes);
  670. if (!buffers)
  671. goto cleanup;
  672. for (i = 0; i < nstripes; i++)
  673. {
  674. buffers[i].buf = grub_zalloc (csize);
  675. if (!buffers[i].buf)
  676. goto cleanup;
  677. }
  678. for (failed_devices = 0, i = 0; i < nstripes; i++)
  679. {
  680. struct grub_btrfs_chunk_stripe *stripe;
  681. grub_disk_addr_t paddr;
  682. grub_device_t dev;
  683. grub_err_t err;
  684. /*
  685. * The struct grub_btrfs_chunk_stripe array lives
  686. * behind struct grub_btrfs_chunk_item.
  687. */
  688. stripe = (struct grub_btrfs_chunk_stripe *) (chunk + 1) + i;
  689. paddr = grub_le_to_cpu64 (stripe->offset) + stripe_offset;
  690. grub_dprintf ("btrfs", "reading paddr %" PRIxGRUB_UINT64_T
  691. " from stripe ID %" PRIxGRUB_UINT64_T "\n",
  692. paddr, stripe->device_id);
  693. dev = find_device (data, stripe->device_id);
  694. if (!dev)
  695. {
  696. grub_dprintf ("btrfs", "stripe %" PRIuGRUB_UINT64_T " FAILED (dev ID %"
  697. PRIxGRUB_UINT64_T ")\n", i, stripe->device_id);
  698. failed_devices++;
  699. continue;
  700. }
  701. err = grub_disk_read (dev->disk, paddr >> GRUB_DISK_SECTOR_BITS,
  702. paddr & (GRUB_DISK_SECTOR_SIZE - 1),
  703. csize, buffers[i].buf);
  704. if (err == GRUB_ERR_NONE)
  705. {
  706. buffers[i].data_is_valid = 1;
  707. grub_dprintf ("btrfs", "stripe %" PRIuGRUB_UINT64_T " OK (dev ID %"
  708. PRIxGRUB_UINT64_T ")\n", i, stripe->device_id);
  709. }
  710. else
  711. {
  712. grub_dprintf ("btrfs", "stripe %" PRIuGRUB_UINT64_T
  713. " READ FAILED (dev ID %" PRIxGRUB_UINT64_T ")\n",
  714. i, stripe->device_id);
  715. failed_devices++;
  716. }
  717. }
  718. if (failed_devices > 1 && (chunk_type & GRUB_BTRFS_CHUNK_TYPE_RAID5))
  719. {
  720. grub_dprintf ("btrfs", "not enough disks for RAID 5: total %" PRIuGRUB_UINT64_T
  721. ", missing %" PRIuGRUB_UINT64_T "\n",
  722. nstripes, failed_devices);
  723. ret = GRUB_ERR_READ_ERROR;
  724. goto cleanup;
  725. }
  726. else if (failed_devices > 2 && (chunk_type & GRUB_BTRFS_CHUNK_TYPE_RAID6))
  727. {
  728. grub_dprintf ("btrfs", "not enough disks for RAID 6: total %" PRIuGRUB_UINT64_T
  729. ", missing %" PRIuGRUB_UINT64_T "\n",
  730. nstripes, failed_devices);
  731. ret = GRUB_ERR_READ_ERROR;
  732. goto cleanup;
  733. }
  734. else
  735. grub_dprintf ("btrfs", "enough disks for RAID 5: total %"
  736. PRIuGRUB_UINT64_T ", missing %" PRIuGRUB_UINT64_T "\n",
  737. nstripes, failed_devices);
  738. /* We have enough disks. So, rebuild the data. */
  739. if (chunk_type & GRUB_BTRFS_CHUNK_TYPE_RAID5)
  740. rebuild_raid5 (buf, buffers, nstripes, csize);
  741. else
  742. rebuild_raid6 (buffers, nstripes, csize, parities_pos, buf, stripen);
  743. ret = GRUB_ERR_NONE;
  744. cleanup:
  745. if (buffers)
  746. for (i = 0; i < nstripes; i++)
  747. grub_free (buffers[i].buf);
  748. grub_free (buffers);
  749. return ret;
  750. }
  751. static grub_err_t
  752. grub_btrfs_read_logical (struct grub_btrfs_data *data, grub_disk_addr_t addr,
  753. void *buf, grub_size_t size, int recursion_depth)
  754. {
  755. while (size > 0)
  756. {
  757. grub_uint8_t *ptr;
  758. struct grub_btrfs_key *key;
  759. struct grub_btrfs_chunk_item *chunk;
  760. grub_uint64_t csize;
  761. grub_err_t err = 0;
  762. struct grub_btrfs_key key_out;
  763. int challoc = 0;
  764. struct grub_btrfs_key key_in;
  765. grub_size_t chsize;
  766. grub_disk_addr_t chaddr;
  767. grub_dprintf ("btrfs", "searching for laddr %" PRIxGRUB_UINT64_T "\n",
  768. addr);
  769. for (ptr = data->sblock.bootstrap_mapping;
  770. ptr < data->sblock.bootstrap_mapping
  771. + sizeof (data->sblock.bootstrap_mapping)
  772. - sizeof (struct grub_btrfs_key);)
  773. {
  774. key = (struct grub_btrfs_key *) ptr;
  775. if (key->type != GRUB_BTRFS_ITEM_TYPE_CHUNK)
  776. break;
  777. chunk = (struct grub_btrfs_chunk_item *) (key + 1);
  778. grub_dprintf ("btrfs",
  779. "%" PRIxGRUB_UINT64_T " %" PRIxGRUB_UINT64_T " \n",
  780. grub_le_to_cpu64 (key->offset),
  781. grub_le_to_cpu64 (chunk->size));
  782. if (grub_le_to_cpu64 (key->offset) <= addr
  783. && addr < grub_le_to_cpu64 (key->offset)
  784. + grub_le_to_cpu64 (chunk->size))
  785. goto chunk_found;
  786. ptr += sizeof (*key) + sizeof (*chunk)
  787. + sizeof (struct grub_btrfs_chunk_stripe)
  788. * grub_le_to_cpu16 (chunk->nstripes);
  789. }
  790. key_in.object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  791. key_in.type = GRUB_BTRFS_ITEM_TYPE_CHUNK;
  792. key_in.offset = grub_cpu_to_le64 (addr);
  793. err = lower_bound (data, &key_in, &key_out,
  794. data->sblock.chunk_tree,
  795. &chaddr, &chsize, NULL, recursion_depth);
  796. if (err)
  797. return err;
  798. key = &key_out;
  799. if (key->type != GRUB_BTRFS_ITEM_TYPE_CHUNK
  800. || !(grub_le_to_cpu64 (key->offset) <= addr))
  801. return grub_error (GRUB_ERR_BAD_FS,
  802. "couldn't find the chunk descriptor");
  803. chunk = grub_malloc (chsize);
  804. if (!chunk)
  805. return grub_errno;
  806. challoc = 1;
  807. err = grub_btrfs_read_logical (data, chaddr, chunk, chsize,
  808. recursion_depth);
  809. if (err)
  810. {
  811. grub_free (chunk);
  812. return err;
  813. }
  814. chunk_found:
  815. {
  816. grub_uint64_t stripen;
  817. grub_uint64_t stripe_offset;
  818. grub_uint64_t off = addr - grub_le_to_cpu64 (key->offset);
  819. grub_uint64_t chunk_stripe_length;
  820. grub_uint16_t nstripes;
  821. unsigned redundancy = 1;
  822. unsigned i, j;
  823. int is_raid56;
  824. grub_uint64_t parities_pos = 0;
  825. is_raid56 = !!(grub_le_to_cpu64 (chunk->type) &
  826. (GRUB_BTRFS_CHUNK_TYPE_RAID5 |
  827. GRUB_BTRFS_CHUNK_TYPE_RAID6));
  828. if (grub_le_to_cpu64 (chunk->size) <= off)
  829. {
  830. grub_dprintf ("btrfs", "no chunk\n");
  831. return grub_error (GRUB_ERR_BAD_FS,
  832. "couldn't find the chunk descriptor");
  833. }
  834. nstripes = grub_le_to_cpu16 (chunk->nstripes) ? : 1;
  835. chunk_stripe_length = grub_le_to_cpu64 (chunk->stripe_length) ? : 512;
  836. grub_dprintf ("btrfs", "chunk 0x%" PRIxGRUB_UINT64_T
  837. "+0x%" PRIxGRUB_UINT64_T
  838. " (%d stripes (%d substripes) of %"
  839. PRIxGRUB_UINT64_T ")\n",
  840. grub_le_to_cpu64 (key->offset),
  841. grub_le_to_cpu64 (chunk->size),
  842. nstripes,
  843. grub_le_to_cpu16 (chunk->nsubstripes),
  844. chunk_stripe_length);
  845. switch (grub_le_to_cpu64 (chunk->type)
  846. & ~GRUB_BTRFS_CHUNK_TYPE_BITS_DONTCARE)
  847. {
  848. case GRUB_BTRFS_CHUNK_TYPE_SINGLE:
  849. {
  850. grub_uint64_t stripe_length;
  851. grub_dprintf ("btrfs", "single\n");
  852. stripe_length = grub_divmod64 (grub_le_to_cpu64 (chunk->size),
  853. nstripes,
  854. NULL);
  855. if (stripe_length == 0)
  856. stripe_length = 512;
  857. stripen = grub_divmod64 (off, stripe_length, &stripe_offset);
  858. csize = (stripen + 1) * stripe_length - off;
  859. break;
  860. }
  861. case GRUB_BTRFS_CHUNK_TYPE_DUPLICATED:
  862. case GRUB_BTRFS_CHUNK_TYPE_RAID1:
  863. {
  864. grub_dprintf ("btrfs", "RAID1\n");
  865. stripen = 0;
  866. stripe_offset = off;
  867. csize = grub_le_to_cpu64 (chunk->size) - off;
  868. redundancy = 2;
  869. break;
  870. }
  871. case GRUB_BTRFS_CHUNK_TYPE_RAID0:
  872. {
  873. grub_uint64_t middle, high;
  874. grub_uint64_t low;
  875. grub_dprintf ("btrfs", "RAID0\n");
  876. middle = grub_divmod64 (off,
  877. chunk_stripe_length,
  878. &low);
  879. high = grub_divmod64 (middle, nstripes,
  880. &stripen);
  881. stripe_offset =
  882. low + chunk_stripe_length * high;
  883. csize = chunk_stripe_length - low;
  884. break;
  885. }
  886. case GRUB_BTRFS_CHUNK_TYPE_RAID10:
  887. {
  888. grub_uint64_t middle, high;
  889. grub_uint64_t low;
  890. grub_uint16_t nsubstripes;
  891. nsubstripes = grub_le_to_cpu16 (chunk->nsubstripes) ? : 1;
  892. middle = grub_divmod64 (off,
  893. chunk_stripe_length,
  894. &low);
  895. high = grub_divmod64 (middle,
  896. nstripes / nsubstripes ? : 1,
  897. &stripen);
  898. stripen *= nsubstripes;
  899. redundancy = nsubstripes;
  900. stripe_offset = low + chunk_stripe_length
  901. * high;
  902. csize = chunk_stripe_length - low;
  903. break;
  904. }
  905. case GRUB_BTRFS_CHUNK_TYPE_RAID5:
  906. case GRUB_BTRFS_CHUNK_TYPE_RAID6:
  907. {
  908. grub_uint64_t nparities, stripe_nr, high, low;
  909. redundancy = 1; /* no redundancy for now */
  910. if (grub_le_to_cpu64 (chunk->type) & GRUB_BTRFS_CHUNK_TYPE_RAID5)
  911. {
  912. grub_dprintf ("btrfs", "RAID5\n");
  913. nparities = 1;
  914. }
  915. else
  916. {
  917. grub_dprintf ("btrfs", "RAID6\n");
  918. nparities = 2;
  919. }
  920. /*
  921. * RAID 6 layout consists of several stripes spread over
  922. * the disks, e.g.:
  923. *
  924. * Disk_0 Disk_1 Disk_2 Disk_3
  925. * A0 B0 P0 Q0
  926. * Q1 A1 B1 P1
  927. * P2 Q2 A2 B2
  928. *
  929. * Note: placement of the parities depend on row number.
  930. *
  931. * Pay attention that the btrfs terminology may differ from
  932. * terminology used in other RAID implementations, e.g. LVM,
  933. * dm or md. The main difference is that btrfs calls contiguous
  934. * block of data on a given disk, e.g. A0, stripe instead of chunk.
  935. *
  936. * The variables listed below have following meaning:
  937. * - stripe_nr is the stripe number excluding the parities
  938. * (A0 = 0, B0 = 1, A1 = 2, B1 = 3, etc.),
  939. * - high is the row number (0 for A0...Q0, 1 for Q1...P1, etc.),
  940. * - stripen is the disk number in a row (0 for A0, Q1, P2,
  941. * 1 for B0, A1, Q2, etc.),
  942. * - off is the logical address to read,
  943. * - chunk_stripe_length is the size of a stripe (typically 64 KiB),
  944. * - nstripes is the number of disks in a row,
  945. * - low is the offset of the data inside a stripe,
  946. * - stripe_offset is the data offset in an array,
  947. * - csize is the "potential" data to read; it will be reduced
  948. * to size if the latter is smaller,
  949. * - nparities is the number of parities (1 for RAID 5, 2 for
  950. * RAID 6); used only in RAID 5/6 code.
  951. */
  952. stripe_nr = grub_divmod64 (off, chunk_stripe_length, &low);
  953. /*
  954. * stripen is computed without the parities
  955. * (0 for A0, A1, A2, 1 for B0, B1, B2, etc.).
  956. */
  957. high = grub_divmod64 (stripe_nr, nstripes - nparities, &stripen);
  958. /*
  959. * The stripes are spread over the disks. Every each row their
  960. * positions are shifted by 1 place. So, the real disks number
  961. * change. Hence, we have to take into account current row number
  962. * modulo nstripes (0 for A0, 1 for A1, 2 for A2, etc.).
  963. */
  964. grub_divmod64 (high + stripen, nstripes, &stripen);
  965. /*
  966. * parities_pos is equal to ((high - nparities) % nstripes)
  967. * (see the diagram above). However, (high - nparities) can
  968. * be negative, e.g. when high == 0, leading to an incorrect
  969. * results. (high + nstripes - nparities) is always positive and
  970. * modulo nstripes is equal to ((high - nparities) % nstripes).
  971. */
  972. grub_divmod64 (high + nstripes - nparities, nstripes, &parities_pos);
  973. stripe_offset = chunk_stripe_length * high + low;
  974. csize = chunk_stripe_length - low;
  975. break;
  976. }
  977. default:
  978. grub_dprintf ("btrfs", "unsupported RAID\n");
  979. return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  980. "unsupported RAID flags %" PRIxGRUB_UINT64_T,
  981. grub_le_to_cpu64 (chunk->type));
  982. }
  983. if (csize == 0)
  984. return grub_error (GRUB_ERR_BUG,
  985. "couldn't find the chunk descriptor");
  986. if (csize > (grub_uint64_t) size)
  987. csize = size;
  988. for (j = 0; j < 2; j++)
  989. {
  990. grub_dprintf ("btrfs", "chunk 0x%" PRIxGRUB_UINT64_T
  991. "+0x%" PRIxGRUB_UINT64_T
  992. " (%d stripes (%d substripes) of %"
  993. PRIxGRUB_UINT64_T ")\n",
  994. grub_le_to_cpu64 (key->offset),
  995. grub_le_to_cpu64 (chunk->size),
  996. grub_le_to_cpu16 (chunk->nstripes),
  997. grub_le_to_cpu16 (chunk->nsubstripes),
  998. grub_le_to_cpu64 (chunk->stripe_length));
  999. grub_dprintf ("btrfs", "reading laddr 0x%" PRIxGRUB_UINT64_T "\n",
  1000. addr);
  1001. if (is_raid56)
  1002. {
  1003. err = btrfs_read_from_chunk (data, chunk, stripen,
  1004. stripe_offset,
  1005. 0, /* no mirror */
  1006. csize, buf);
  1007. grub_errno = GRUB_ERR_NONE;
  1008. if (err)
  1009. err = raid56_read_retry (data, chunk, stripe_offset,
  1010. stripen, csize, buf, parities_pos);
  1011. }
  1012. else
  1013. for (i = 0; i < redundancy; i++)
  1014. {
  1015. err = btrfs_read_from_chunk (data, chunk, stripen,
  1016. stripe_offset,
  1017. i, /* redundancy */
  1018. csize, buf);
  1019. if (!err)
  1020. break;
  1021. grub_errno = GRUB_ERR_NONE;
  1022. }
  1023. if (!err)
  1024. break;
  1025. }
  1026. if (err)
  1027. return grub_errno = err;
  1028. }
  1029. size -= csize;
  1030. buf = (grub_uint8_t *) buf + csize;
  1031. addr += csize;
  1032. if (challoc)
  1033. grub_free (chunk);
  1034. }
  1035. return GRUB_ERR_NONE;
  1036. }
  1037. static struct grub_btrfs_data *
  1038. grub_btrfs_mount (grub_device_t dev)
  1039. {
  1040. struct grub_btrfs_data *data;
  1041. grub_err_t err;
  1042. if (!dev->disk)
  1043. {
  1044. grub_error (GRUB_ERR_BAD_FS, "not BtrFS");
  1045. return NULL;
  1046. }
  1047. data = grub_zalloc (sizeof (*data));
  1048. if (!data)
  1049. return NULL;
  1050. err = read_sblock (dev->disk, &data->sblock);
  1051. if (err)
  1052. {
  1053. grub_free (data);
  1054. return NULL;
  1055. }
  1056. data->n_devices_allocated = 16;
  1057. data->devices_attached = grub_malloc (sizeof (data->devices_attached[0])
  1058. * data->n_devices_allocated);
  1059. if (!data->devices_attached)
  1060. {
  1061. grub_free (data);
  1062. return NULL;
  1063. }
  1064. data->n_devices_attached = 1;
  1065. data->devices_attached[0].dev = dev;
  1066. data->devices_attached[0].id = data->sblock.this_device.device_id;
  1067. return data;
  1068. }
  1069. static void
  1070. grub_btrfs_unmount (struct grub_btrfs_data *data)
  1071. {
  1072. unsigned i;
  1073. /* The device 0 is closed one layer upper. */
  1074. for (i = 1; i < data->n_devices_attached; i++)
  1075. if (data->devices_attached[i].dev)
  1076. grub_device_close (data->devices_attached[i].dev);
  1077. grub_free (data->devices_attached);
  1078. grub_free (data->extent);
  1079. grub_free (data);
  1080. }
  1081. static grub_err_t
  1082. grub_btrfs_read_inode (struct grub_btrfs_data *data,
  1083. struct grub_btrfs_inode *inode, grub_uint64_t num,
  1084. grub_uint64_t tree)
  1085. {
  1086. struct grub_btrfs_key key_in, key_out;
  1087. grub_disk_addr_t elemaddr;
  1088. grub_size_t elemsize;
  1089. grub_err_t err;
  1090. key_in.object_id = num;
  1091. key_in.type = GRUB_BTRFS_ITEM_TYPE_INODE_ITEM;
  1092. key_in.offset = 0;
  1093. err = lower_bound (data, &key_in, &key_out, tree, &elemaddr, &elemsize, NULL,
  1094. 0);
  1095. if (err)
  1096. return err;
  1097. if (num != key_out.object_id
  1098. || key_out.type != GRUB_BTRFS_ITEM_TYPE_INODE_ITEM)
  1099. return grub_error (GRUB_ERR_BAD_FS, "inode not found");
  1100. return grub_btrfs_read_logical (data, elemaddr, inode, sizeof (*inode), 0);
  1101. }
  1102. static void *grub_zstd_malloc (void *state __attribute__((unused)), size_t size)
  1103. {
  1104. return grub_malloc (size);
  1105. }
  1106. static void grub_zstd_free (void *state __attribute__((unused)), void *address)
  1107. {
  1108. return grub_free (address);
  1109. }
  1110. static ZSTD_customMem grub_zstd_allocator (void)
  1111. {
  1112. ZSTD_customMem allocator;
  1113. allocator.customAlloc = &grub_zstd_malloc;
  1114. allocator.customFree = &grub_zstd_free;
  1115. allocator.opaque = NULL;
  1116. return allocator;
  1117. }
  1118. static grub_ssize_t
  1119. grub_btrfs_zstd_decompress (char *ibuf, grub_size_t isize, grub_off_t off,
  1120. char *obuf, grub_size_t osize)
  1121. {
  1122. void *allocated = NULL;
  1123. char *otmpbuf = obuf;
  1124. grub_size_t otmpsize = osize;
  1125. ZSTD_DCtx *dctx = NULL;
  1126. grub_size_t zstd_ret;
  1127. grub_ssize_t ret = -1;
  1128. /*
  1129. * Zstd will fail if it can't fit the entire output in the destination
  1130. * buffer, so if osize isn't large enough, allocate a temporary buffer.
  1131. */
  1132. if (otmpsize < ZSTD_BTRFS_MAX_INPUT)
  1133. {
  1134. allocated = grub_malloc (ZSTD_BTRFS_MAX_INPUT);
  1135. if (!allocated)
  1136. {
  1137. grub_error (GRUB_ERR_OUT_OF_MEMORY, "failed allocate a zstd buffer");
  1138. goto err;
  1139. }
  1140. otmpbuf = (char *) allocated;
  1141. otmpsize = ZSTD_BTRFS_MAX_INPUT;
  1142. }
  1143. /* Create the ZSTD_DCtx. */
  1144. dctx = ZSTD_createDCtx_advanced (grub_zstd_allocator ());
  1145. if (!dctx)
  1146. {
  1147. /* ZSTD_createDCtx_advanced() only fails if it is out of memory. */
  1148. grub_error (GRUB_ERR_OUT_OF_MEMORY, "failed to create a zstd context");
  1149. goto err;
  1150. }
  1151. /*
  1152. * Get the real input size, there may be junk at the
  1153. * end of the frame.
  1154. */
  1155. isize = ZSTD_findFrameCompressedSize (ibuf, isize);
  1156. if (ZSTD_isError (isize))
  1157. {
  1158. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA, "zstd data corrupted");
  1159. goto err;
  1160. }
  1161. /* Decompress and check for errors. */
  1162. zstd_ret = ZSTD_decompressDCtx (dctx, otmpbuf, otmpsize, ibuf, isize);
  1163. if (ZSTD_isError (zstd_ret))
  1164. {
  1165. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA, "zstd data corrupted");
  1166. goto err;
  1167. }
  1168. /*
  1169. * Move the requested data into the obuf. obuf may be equal
  1170. * to otmpbuf, which is why grub_memmove() is required.
  1171. */
  1172. grub_memmove (obuf, otmpbuf + off, osize);
  1173. ret = osize;
  1174. err:
  1175. grub_free (allocated);
  1176. ZSTD_freeDCtx (dctx);
  1177. return ret;
  1178. }
  1179. static grub_ssize_t
  1180. grub_btrfs_lzo_decompress(char *ibuf, grub_size_t isize, grub_off_t off,
  1181. char *obuf, grub_size_t osize)
  1182. {
  1183. grub_uint32_t total_size, cblock_size;
  1184. grub_size_t ret = 0;
  1185. char *ibuf0 = ibuf;
  1186. total_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  1187. ibuf += sizeof (total_size);
  1188. if (isize < total_size)
  1189. return -1;
  1190. /* Jump forward to first block with requested data. */
  1191. while (off >= GRUB_BTRFS_LZO_BLOCK_SIZE)
  1192. {
  1193. /* Don't let following uint32_t cross the page boundary. */
  1194. if (((ibuf - ibuf0) & 0xffc) == 0xffc)
  1195. ibuf = ((ibuf - ibuf0 + 3) & ~3) + ibuf0;
  1196. cblock_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  1197. ibuf += sizeof (cblock_size);
  1198. if (cblock_size > GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE)
  1199. return -1;
  1200. off -= GRUB_BTRFS_LZO_BLOCK_SIZE;
  1201. ibuf += cblock_size;
  1202. }
  1203. while (osize > 0)
  1204. {
  1205. lzo_uint usize = GRUB_BTRFS_LZO_BLOCK_SIZE;
  1206. /* Don't let following uint32_t cross the page boundary. */
  1207. if (((ibuf - ibuf0) & 0xffc) == 0xffc)
  1208. ibuf = ((ibuf - ibuf0 + 3) & ~3) + ibuf0;
  1209. cblock_size = grub_le_to_cpu32 (grub_get_unaligned32 (ibuf));
  1210. ibuf += sizeof (cblock_size);
  1211. if (cblock_size > GRUB_BTRFS_LZO_BLOCK_MAX_CSIZE)
  1212. return -1;
  1213. /* Block partially filled with requested data. */
  1214. if (off > 0 || osize < GRUB_BTRFS_LZO_BLOCK_SIZE)
  1215. {
  1216. grub_size_t to_copy = GRUB_BTRFS_LZO_BLOCK_SIZE - off;
  1217. grub_uint8_t *buf;
  1218. if (to_copy > osize)
  1219. to_copy = osize;
  1220. buf = grub_malloc (GRUB_BTRFS_LZO_BLOCK_SIZE);
  1221. if (!buf)
  1222. return -1;
  1223. if (lzo1x_decompress_safe ((lzo_bytep)ibuf, cblock_size, buf, &usize,
  1224. NULL) != LZO_E_OK)
  1225. {
  1226. grub_free (buf);
  1227. return -1;
  1228. }
  1229. if (to_copy > usize)
  1230. to_copy = usize;
  1231. grub_memcpy(obuf, buf + off, to_copy);
  1232. osize -= to_copy;
  1233. ret += to_copy;
  1234. obuf += to_copy;
  1235. ibuf += cblock_size;
  1236. off = 0;
  1237. grub_free (buf);
  1238. continue;
  1239. }
  1240. /* Decompress whole block directly to output buffer. */
  1241. if (lzo1x_decompress_safe ((lzo_bytep)ibuf, cblock_size, (lzo_bytep)obuf,
  1242. &usize, NULL) != LZO_E_OK)
  1243. return -1;
  1244. osize -= usize;
  1245. ret += usize;
  1246. obuf += usize;
  1247. ibuf += cblock_size;
  1248. }
  1249. return ret;
  1250. }
  1251. static grub_ssize_t
  1252. grub_btrfs_extent_read (struct grub_btrfs_data *data,
  1253. grub_uint64_t ino, grub_uint64_t tree,
  1254. grub_off_t pos0, char *buf, grub_size_t len)
  1255. {
  1256. grub_off_t pos = pos0;
  1257. while (len)
  1258. {
  1259. grub_size_t csize;
  1260. grub_err_t err;
  1261. grub_off_t extoff;
  1262. if (!data->extent || data->extstart > pos || data->extino != ino
  1263. || data->exttree != tree || data->extend <= pos)
  1264. {
  1265. struct grub_btrfs_key key_in, key_out;
  1266. grub_disk_addr_t elemaddr;
  1267. grub_size_t elemsize;
  1268. grub_free (data->extent);
  1269. key_in.object_id = ino;
  1270. key_in.type = GRUB_BTRFS_ITEM_TYPE_EXTENT_ITEM;
  1271. key_in.offset = grub_cpu_to_le64 (pos);
  1272. err = lower_bound (data, &key_in, &key_out, tree,
  1273. &elemaddr, &elemsize, NULL, 0);
  1274. if (err)
  1275. return -1;
  1276. if (key_out.object_id != ino
  1277. || key_out.type != GRUB_BTRFS_ITEM_TYPE_EXTENT_ITEM)
  1278. {
  1279. grub_error (GRUB_ERR_BAD_FS, "extent not found");
  1280. return -1;
  1281. }
  1282. if ((grub_ssize_t) elemsize < ((char *) &data->extent->inl
  1283. - (char *) data->extent))
  1284. {
  1285. grub_error (GRUB_ERR_BAD_FS, "extent descriptor is too short");
  1286. return -1;
  1287. }
  1288. data->extstart = grub_le_to_cpu64 (key_out.offset);
  1289. data->extsize = elemsize;
  1290. data->extent = grub_malloc (elemsize);
  1291. data->extino = ino;
  1292. data->exttree = tree;
  1293. if (!data->extent)
  1294. return grub_errno;
  1295. err = grub_btrfs_read_logical (data, elemaddr, data->extent,
  1296. elemsize, 0);
  1297. if (err)
  1298. return err;
  1299. data->extend = data->extstart + grub_le_to_cpu64 (data->extent->size);
  1300. if (data->extent->type == GRUB_BTRFS_EXTENT_REGULAR
  1301. && (char *) data->extent + elemsize
  1302. >= (char *) &data->extent->filled + sizeof (data->extent->filled))
  1303. data->extend =
  1304. data->extstart + grub_le_to_cpu64 (data->extent->filled);
  1305. grub_dprintf ("btrfs", "regular extent 0x%" PRIxGRUB_UINT64_T "+0x%"
  1306. PRIxGRUB_UINT64_T "\n",
  1307. grub_le_to_cpu64 (key_out.offset),
  1308. grub_le_to_cpu64 (data->extent->size));
  1309. if (data->extend <= pos)
  1310. {
  1311. grub_error (GRUB_ERR_BAD_FS, "extent not found");
  1312. return -1;
  1313. }
  1314. }
  1315. csize = data->extend - pos;
  1316. extoff = pos - data->extstart;
  1317. if (csize > len)
  1318. csize = len;
  1319. if (data->extent->encryption)
  1320. {
  1321. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1322. "encryption not supported");
  1323. return -1;
  1324. }
  1325. if (data->extent->compression != GRUB_BTRFS_COMPRESSION_NONE
  1326. && data->extent->compression != GRUB_BTRFS_COMPRESSION_ZLIB
  1327. && data->extent->compression != GRUB_BTRFS_COMPRESSION_LZO
  1328. && data->extent->compression != GRUB_BTRFS_COMPRESSION_ZSTD)
  1329. {
  1330. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1331. "compression type 0x%x not supported",
  1332. data->extent->compression);
  1333. return -1;
  1334. }
  1335. if (data->extent->encoding)
  1336. {
  1337. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET, "encoding not supported");
  1338. return -1;
  1339. }
  1340. switch (data->extent->type)
  1341. {
  1342. case GRUB_BTRFS_EXTENT_INLINE:
  1343. if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZLIB)
  1344. {
  1345. if (grub_zlib_decompress (data->extent->inl, data->extsize -
  1346. ((grub_uint8_t *) data->extent->inl
  1347. - (grub_uint8_t *) data->extent),
  1348. extoff, buf, csize)
  1349. != (grub_ssize_t) csize)
  1350. {
  1351. if (!grub_errno)
  1352. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA,
  1353. "premature end of compressed");
  1354. return -1;
  1355. }
  1356. }
  1357. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_LZO)
  1358. {
  1359. if (grub_btrfs_lzo_decompress(data->extent->inl, data->extsize -
  1360. ((grub_uint8_t *) data->extent->inl
  1361. - (grub_uint8_t *) data->extent),
  1362. extoff, buf, csize)
  1363. != (grub_ssize_t) csize)
  1364. return -1;
  1365. }
  1366. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZSTD)
  1367. {
  1368. if (grub_btrfs_zstd_decompress (data->extent->inl, data->extsize -
  1369. ((grub_uint8_t *) data->extent->inl
  1370. - (grub_uint8_t *) data->extent),
  1371. extoff, buf, csize)
  1372. != (grub_ssize_t) csize)
  1373. return -1;
  1374. }
  1375. else
  1376. grub_memcpy (buf, data->extent->inl + extoff, csize);
  1377. break;
  1378. case GRUB_BTRFS_EXTENT_REGULAR:
  1379. if (!data->extent->laddr)
  1380. {
  1381. grub_memset (buf, 0, csize);
  1382. break;
  1383. }
  1384. if (data->extent->compression != GRUB_BTRFS_COMPRESSION_NONE)
  1385. {
  1386. char *tmp;
  1387. grub_uint64_t zsize;
  1388. grub_ssize_t ret;
  1389. zsize = grub_le_to_cpu64 (data->extent->compressed_size);
  1390. tmp = grub_malloc (zsize);
  1391. if (!tmp)
  1392. return -1;
  1393. err = grub_btrfs_read_logical (data,
  1394. grub_le_to_cpu64 (data->extent->laddr),
  1395. tmp, zsize, 0);
  1396. if (err)
  1397. {
  1398. grub_free (tmp);
  1399. return -1;
  1400. }
  1401. if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZLIB)
  1402. ret = grub_zlib_decompress (tmp, zsize, extoff
  1403. + grub_le_to_cpu64 (data->extent->offset),
  1404. buf, csize);
  1405. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_LZO)
  1406. ret = grub_btrfs_lzo_decompress (tmp, zsize, extoff
  1407. + grub_le_to_cpu64 (data->extent->offset),
  1408. buf, csize);
  1409. else if (data->extent->compression == GRUB_BTRFS_COMPRESSION_ZSTD)
  1410. ret = grub_btrfs_zstd_decompress (tmp, zsize, extoff
  1411. + grub_le_to_cpu64 (data->extent->offset),
  1412. buf, csize);
  1413. else
  1414. ret = -1;
  1415. grub_free (tmp);
  1416. if (ret != (grub_ssize_t) csize)
  1417. {
  1418. if (!grub_errno)
  1419. grub_error (GRUB_ERR_BAD_COMPRESSED_DATA,
  1420. "premature end of compressed");
  1421. return -1;
  1422. }
  1423. break;
  1424. }
  1425. err = grub_btrfs_read_logical (data,
  1426. grub_le_to_cpu64 (data->extent->laddr)
  1427. + grub_le_to_cpu64 (data->extent->offset)
  1428. + extoff, buf, csize, 0);
  1429. if (err)
  1430. return -1;
  1431. break;
  1432. default:
  1433. grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1434. "unsupported extent type 0x%x", data->extent->type);
  1435. return -1;
  1436. }
  1437. buf += csize;
  1438. pos += csize;
  1439. len -= csize;
  1440. }
  1441. return pos - pos0;
  1442. }
  1443. static grub_err_t
  1444. get_root (struct grub_btrfs_data *data, struct grub_btrfs_key *key,
  1445. grub_uint64_t *tree, grub_uint8_t *type)
  1446. {
  1447. grub_err_t err;
  1448. grub_disk_addr_t elemaddr;
  1449. grub_size_t elemsize;
  1450. struct grub_btrfs_key key_out, key_in;
  1451. struct grub_btrfs_root_item ri;
  1452. key_in.object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_ROOT_VOL_OBJECTID);
  1453. key_in.offset = 0;
  1454. key_in.type = GRUB_BTRFS_ITEM_TYPE_ROOT_ITEM;
  1455. err = lower_bound (data, &key_in, &key_out,
  1456. data->sblock.root_tree,
  1457. &elemaddr, &elemsize, NULL, 0);
  1458. if (err)
  1459. return err;
  1460. if (key_in.object_id != key_out.object_id
  1461. || key_in.type != key_out.type
  1462. || key_in.offset != key_out.offset)
  1463. return grub_error (GRUB_ERR_BAD_FS, "no root");
  1464. err = grub_btrfs_read_logical (data, elemaddr, &ri,
  1465. sizeof (ri), 0);
  1466. if (err)
  1467. return err;
  1468. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1469. key->offset = 0;
  1470. key->object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  1471. *tree = ri.tree;
  1472. *type = GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY;
  1473. return GRUB_ERR_NONE;
  1474. }
  1475. static grub_err_t
  1476. find_path (struct grub_btrfs_data *data,
  1477. const char *path, struct grub_btrfs_key *key,
  1478. grub_uint64_t *tree, grub_uint8_t *type)
  1479. {
  1480. const char *slash = path;
  1481. grub_err_t err;
  1482. grub_disk_addr_t elemaddr;
  1483. grub_size_t elemsize;
  1484. grub_size_t allocated = 0;
  1485. struct grub_btrfs_dir_item *direl = NULL;
  1486. struct grub_btrfs_key key_out;
  1487. const char *ctoken;
  1488. grub_size_t ctokenlen;
  1489. char *path_alloc = NULL;
  1490. char *origpath = NULL;
  1491. unsigned symlinks_max = 32;
  1492. err = get_root (data, key, tree, type);
  1493. if (err)
  1494. return err;
  1495. origpath = grub_strdup (path);
  1496. if (!origpath)
  1497. return grub_errno;
  1498. while (1)
  1499. {
  1500. while (path[0] == '/')
  1501. path++;
  1502. if (!path[0])
  1503. break;
  1504. slash = grub_strchr (path, '/');
  1505. if (!slash)
  1506. slash = path + grub_strlen (path);
  1507. ctoken = path;
  1508. ctokenlen = slash - path;
  1509. if (*type != GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1510. {
  1511. grub_free (path_alloc);
  1512. grub_free (origpath);
  1513. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a directory"));
  1514. }
  1515. if (ctokenlen == 1 && ctoken[0] == '.')
  1516. {
  1517. path = slash;
  1518. continue;
  1519. }
  1520. if (ctokenlen == 2 && ctoken[0] == '.' && ctoken[1] == '.')
  1521. {
  1522. key->type = GRUB_BTRFS_ITEM_TYPE_INODE_REF;
  1523. key->offset = -1;
  1524. err = lower_bound (data, key, &key_out, *tree, &elemaddr, &elemsize,
  1525. NULL, 0);
  1526. if (err)
  1527. {
  1528. grub_free (direl);
  1529. grub_free (path_alloc);
  1530. grub_free (origpath);
  1531. return err;
  1532. }
  1533. if (key_out.type != key->type
  1534. || key->object_id != key_out.object_id)
  1535. {
  1536. grub_free (direl);
  1537. grub_free (path_alloc);
  1538. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1539. grub_free (origpath);
  1540. return err;
  1541. }
  1542. *type = GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY;
  1543. key->object_id = key_out.offset;
  1544. path = slash;
  1545. continue;
  1546. }
  1547. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1548. key->offset = grub_cpu_to_le64 (~grub_getcrc32c (1, ctoken, ctokenlen));
  1549. err = lower_bound (data, key, &key_out, *tree, &elemaddr, &elemsize,
  1550. NULL, 0);
  1551. if (err)
  1552. {
  1553. grub_free (direl);
  1554. grub_free (path_alloc);
  1555. grub_free (origpath);
  1556. return err;
  1557. }
  1558. if (key_cmp (key, &key_out) != 0)
  1559. {
  1560. grub_free (direl);
  1561. grub_free (path_alloc);
  1562. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1563. grub_free (origpath);
  1564. return err;
  1565. }
  1566. struct grub_btrfs_dir_item *cdirel;
  1567. if (elemsize > allocated)
  1568. {
  1569. allocated = 2 * elemsize;
  1570. grub_free (direl);
  1571. direl = grub_malloc (allocated + 1);
  1572. if (!direl)
  1573. {
  1574. grub_free (path_alloc);
  1575. grub_free (origpath);
  1576. return grub_errno;
  1577. }
  1578. }
  1579. err = grub_btrfs_read_logical (data, elemaddr, direl, elemsize, 0);
  1580. if (err)
  1581. {
  1582. grub_free (direl);
  1583. grub_free (path_alloc);
  1584. grub_free (origpath);
  1585. return err;
  1586. }
  1587. for (cdirel = direl;
  1588. (grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1589. < (grub_ssize_t) elemsize;
  1590. cdirel = (void *) ((grub_uint8_t *) (direl + 1)
  1591. + grub_le_to_cpu16 (cdirel->n)
  1592. + grub_le_to_cpu16 (cdirel->m)))
  1593. {
  1594. if (ctokenlen == grub_le_to_cpu16 (cdirel->n)
  1595. && grub_memcmp (cdirel->name, ctoken, ctokenlen) == 0)
  1596. break;
  1597. }
  1598. if ((grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1599. >= (grub_ssize_t) elemsize)
  1600. {
  1601. grub_free (direl);
  1602. grub_free (path_alloc);
  1603. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1604. grub_free (origpath);
  1605. return err;
  1606. }
  1607. path = slash;
  1608. if (cdirel->type == GRUB_BTRFS_DIR_ITEM_TYPE_SYMLINK)
  1609. {
  1610. struct grub_btrfs_inode inode;
  1611. char *tmp;
  1612. if (--symlinks_max == 0)
  1613. {
  1614. grub_free (direl);
  1615. grub_free (path_alloc);
  1616. grub_free (origpath);
  1617. return grub_error (GRUB_ERR_SYMLINK_LOOP,
  1618. N_("too deep nesting of symlinks"));
  1619. }
  1620. err = grub_btrfs_read_inode (data, &inode,
  1621. cdirel->key.object_id, *tree);
  1622. if (err)
  1623. {
  1624. grub_free (direl);
  1625. grub_free (path_alloc);
  1626. grub_free (origpath);
  1627. return err;
  1628. }
  1629. tmp = grub_malloc (grub_le_to_cpu64 (inode.size)
  1630. + grub_strlen (path) + 1);
  1631. if (!tmp)
  1632. {
  1633. grub_free (direl);
  1634. grub_free (path_alloc);
  1635. grub_free (origpath);
  1636. return grub_errno;
  1637. }
  1638. if (grub_btrfs_extent_read (data, cdirel->key.object_id,
  1639. *tree, 0, tmp,
  1640. grub_le_to_cpu64 (inode.size))
  1641. != (grub_ssize_t) grub_le_to_cpu64 (inode.size))
  1642. {
  1643. grub_free (direl);
  1644. grub_free (path_alloc);
  1645. grub_free (origpath);
  1646. grub_free (tmp);
  1647. return grub_errno;
  1648. }
  1649. grub_memcpy (tmp + grub_le_to_cpu64 (inode.size), path,
  1650. grub_strlen (path) + 1);
  1651. grub_free (path_alloc);
  1652. path = path_alloc = tmp;
  1653. if (path[0] == '/')
  1654. {
  1655. err = get_root (data, key, tree, type);
  1656. if (err)
  1657. return err;
  1658. }
  1659. continue;
  1660. }
  1661. *type = cdirel->type;
  1662. switch (cdirel->key.type)
  1663. {
  1664. case GRUB_BTRFS_ITEM_TYPE_ROOT_ITEM:
  1665. {
  1666. struct grub_btrfs_root_item ri;
  1667. err = lower_bound (data, &cdirel->key, &key_out,
  1668. data->sblock.root_tree,
  1669. &elemaddr, &elemsize, NULL, 0);
  1670. if (err)
  1671. {
  1672. grub_free (direl);
  1673. grub_free (path_alloc);
  1674. grub_free (origpath);
  1675. return err;
  1676. }
  1677. if (cdirel->key.object_id != key_out.object_id
  1678. || cdirel->key.type != key_out.type)
  1679. {
  1680. grub_free (direl);
  1681. grub_free (path_alloc);
  1682. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1683. grub_free (origpath);
  1684. return err;
  1685. }
  1686. err = grub_btrfs_read_logical (data, elemaddr, &ri,
  1687. sizeof (ri), 0);
  1688. if (err)
  1689. {
  1690. grub_free (direl);
  1691. grub_free (path_alloc);
  1692. grub_free (origpath);
  1693. return err;
  1694. }
  1695. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1696. key->offset = 0;
  1697. key->object_id = grub_cpu_to_le64_compile_time (GRUB_BTRFS_OBJECT_ID_CHUNK);
  1698. *tree = ri.tree;
  1699. break;
  1700. }
  1701. case GRUB_BTRFS_ITEM_TYPE_INODE_ITEM:
  1702. if (*slash && *type == GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR)
  1703. {
  1704. grub_free (direl);
  1705. grub_free (path_alloc);
  1706. err = grub_error (GRUB_ERR_FILE_NOT_FOUND, N_("file `%s' not found"), origpath);
  1707. grub_free (origpath);
  1708. return err;
  1709. }
  1710. *key = cdirel->key;
  1711. if (*type == GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1712. key->type = GRUB_BTRFS_ITEM_TYPE_DIR_ITEM;
  1713. break;
  1714. default:
  1715. grub_free (path_alloc);
  1716. grub_free (origpath);
  1717. grub_free (direl);
  1718. return grub_error (GRUB_ERR_BAD_FS, "unrecognised object type 0x%x",
  1719. cdirel->key.type);
  1720. }
  1721. }
  1722. grub_free (direl);
  1723. grub_free (origpath);
  1724. grub_free (path_alloc);
  1725. return GRUB_ERR_NONE;
  1726. }
  1727. static grub_err_t
  1728. grub_btrfs_dir (grub_device_t device, const char *path,
  1729. grub_fs_dir_hook_t hook, void *hook_data)
  1730. {
  1731. struct grub_btrfs_data *data = grub_btrfs_mount (device);
  1732. struct grub_btrfs_key key_in, key_out;
  1733. grub_err_t err;
  1734. grub_disk_addr_t elemaddr;
  1735. grub_size_t elemsize;
  1736. grub_size_t allocated = 0;
  1737. struct grub_btrfs_dir_item *direl = NULL;
  1738. struct grub_btrfs_leaf_descriptor desc;
  1739. int r = 0;
  1740. grub_uint64_t tree;
  1741. grub_uint8_t type;
  1742. if (!data)
  1743. return grub_errno;
  1744. err = find_path (data, path, &key_in, &tree, &type);
  1745. if (err)
  1746. {
  1747. grub_btrfs_unmount (data);
  1748. return err;
  1749. }
  1750. if (type != GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY)
  1751. {
  1752. grub_btrfs_unmount (data);
  1753. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a directory"));
  1754. }
  1755. err = lower_bound (data, &key_in, &key_out, tree,
  1756. &elemaddr, &elemsize, &desc, 0);
  1757. if (err)
  1758. {
  1759. grub_btrfs_unmount (data);
  1760. return err;
  1761. }
  1762. if (key_out.type != GRUB_BTRFS_ITEM_TYPE_DIR_ITEM
  1763. || key_out.object_id != key_in.object_id)
  1764. {
  1765. r = next (data, &desc, &elemaddr, &elemsize, &key_out);
  1766. if (r <= 0)
  1767. goto out;
  1768. }
  1769. do
  1770. {
  1771. struct grub_btrfs_dir_item *cdirel;
  1772. if (key_out.type != GRUB_BTRFS_ITEM_TYPE_DIR_ITEM
  1773. || key_out.object_id != key_in.object_id)
  1774. {
  1775. r = 0;
  1776. break;
  1777. }
  1778. if (elemsize > allocated)
  1779. {
  1780. allocated = 2 * elemsize;
  1781. grub_free (direl);
  1782. direl = grub_malloc (allocated + 1);
  1783. if (!direl)
  1784. {
  1785. r = -grub_errno;
  1786. break;
  1787. }
  1788. }
  1789. err = grub_btrfs_read_logical (data, elemaddr, direl, elemsize, 0);
  1790. if (err)
  1791. {
  1792. r = -err;
  1793. break;
  1794. }
  1795. for (cdirel = direl;
  1796. (grub_uint8_t *) cdirel - (grub_uint8_t *) direl
  1797. < (grub_ssize_t) elemsize;
  1798. cdirel = (void *) ((grub_uint8_t *) (direl + 1)
  1799. + grub_le_to_cpu16 (cdirel->n)
  1800. + grub_le_to_cpu16 (cdirel->m)))
  1801. {
  1802. char c;
  1803. struct grub_btrfs_inode inode;
  1804. struct grub_dirhook_info info;
  1805. err = grub_btrfs_read_inode (data, &inode, cdirel->key.object_id,
  1806. tree);
  1807. grub_memset (&info, 0, sizeof (info));
  1808. if (err)
  1809. grub_errno = GRUB_ERR_NONE;
  1810. else
  1811. {
  1812. info.mtime = grub_le_to_cpu64 (inode.mtime.sec);
  1813. info.mtimeset = 1;
  1814. }
  1815. c = cdirel->name[grub_le_to_cpu16 (cdirel->n)];
  1816. cdirel->name[grub_le_to_cpu16 (cdirel->n)] = 0;
  1817. info.dir = (cdirel->type == GRUB_BTRFS_DIR_ITEM_TYPE_DIRECTORY);
  1818. if (hook (cdirel->name, &info, hook_data))
  1819. goto out;
  1820. cdirel->name[grub_le_to_cpu16 (cdirel->n)] = c;
  1821. }
  1822. r = next (data, &desc, &elemaddr, &elemsize, &key_out);
  1823. }
  1824. while (r > 0);
  1825. out:
  1826. grub_free (direl);
  1827. free_iterator (&desc);
  1828. grub_btrfs_unmount (data);
  1829. return -r;
  1830. }
  1831. static grub_err_t
  1832. grub_btrfs_open (struct grub_file *file, const char *name)
  1833. {
  1834. struct grub_btrfs_data *data = grub_btrfs_mount (file->device);
  1835. grub_err_t err;
  1836. struct grub_btrfs_inode inode;
  1837. grub_uint8_t type;
  1838. struct grub_btrfs_key key_in;
  1839. if (!data)
  1840. return grub_errno;
  1841. err = find_path (data, name, &key_in, &data->tree, &type);
  1842. if (err)
  1843. {
  1844. grub_btrfs_unmount (data);
  1845. return err;
  1846. }
  1847. if (type != GRUB_BTRFS_DIR_ITEM_TYPE_REGULAR)
  1848. {
  1849. grub_btrfs_unmount (data);
  1850. return grub_error (GRUB_ERR_BAD_FILE_TYPE, N_("not a regular file"));
  1851. }
  1852. data->inode = key_in.object_id;
  1853. err = grub_btrfs_read_inode (data, &inode, data->inode, data->tree);
  1854. if (err)
  1855. {
  1856. grub_btrfs_unmount (data);
  1857. return err;
  1858. }
  1859. file->data = data;
  1860. file->size = grub_le_to_cpu64 (inode.size);
  1861. return err;
  1862. }
  1863. static grub_err_t
  1864. grub_btrfs_close (grub_file_t file)
  1865. {
  1866. grub_btrfs_unmount (file->data);
  1867. return GRUB_ERR_NONE;
  1868. }
  1869. static grub_ssize_t
  1870. grub_btrfs_read (grub_file_t file, char *buf, grub_size_t len)
  1871. {
  1872. struct grub_btrfs_data *data = file->data;
  1873. return grub_btrfs_extent_read (data, data->inode,
  1874. data->tree, file->offset, buf, len);
  1875. }
  1876. static grub_err_t
  1877. grub_btrfs_uuid (grub_device_t device, char **uuid)
  1878. {
  1879. struct grub_btrfs_data *data;
  1880. *uuid = NULL;
  1881. data = grub_btrfs_mount (device);
  1882. if (!data)
  1883. return grub_errno;
  1884. *uuid = grub_xasprintf ("%04x%04x-%04x-%04x-%04x-%04x%04x%04x",
  1885. grub_be_to_cpu16 (data->sblock.uuid[0]),
  1886. grub_be_to_cpu16 (data->sblock.uuid[1]),
  1887. grub_be_to_cpu16 (data->sblock.uuid[2]),
  1888. grub_be_to_cpu16 (data->sblock.uuid[3]),
  1889. grub_be_to_cpu16 (data->sblock.uuid[4]),
  1890. grub_be_to_cpu16 (data->sblock.uuid[5]),
  1891. grub_be_to_cpu16 (data->sblock.uuid[6]),
  1892. grub_be_to_cpu16 (data->sblock.uuid[7]));
  1893. grub_btrfs_unmount (data);
  1894. return grub_errno;
  1895. }
  1896. static grub_err_t
  1897. grub_btrfs_label (grub_device_t device, char **label)
  1898. {
  1899. struct grub_btrfs_data *data;
  1900. *label = NULL;
  1901. data = grub_btrfs_mount (device);
  1902. if (!data)
  1903. return grub_errno;
  1904. *label = grub_strndup (data->sblock.label, sizeof (data->sblock.label));
  1905. grub_btrfs_unmount (data);
  1906. return grub_errno;
  1907. }
  1908. #ifdef GRUB_UTIL
  1909. static grub_err_t
  1910. grub_btrfs_embed (grub_device_t device __attribute__ ((unused)),
  1911. unsigned int *nsectors,
  1912. unsigned int max_nsectors,
  1913. grub_embed_type_t embed_type,
  1914. grub_disk_addr_t **sectors)
  1915. {
  1916. unsigned i;
  1917. if (embed_type != GRUB_EMBED_PCBIOS)
  1918. return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
  1919. "BtrFS currently supports only PC-BIOS embedding");
  1920. if (64 * 2 - 1 < *nsectors)
  1921. return grub_error (GRUB_ERR_OUT_OF_RANGE,
  1922. N_("your core.img is unusually large. "
  1923. "It won't fit in the embedding area"));
  1924. *nsectors = 64 * 2 - 1;
  1925. if (*nsectors > max_nsectors)
  1926. *nsectors = max_nsectors;
  1927. *sectors = grub_malloc (*nsectors * sizeof (**sectors));
  1928. if (!*sectors)
  1929. return grub_errno;
  1930. for (i = 0; i < *nsectors; i++)
  1931. (*sectors)[i] = i + 1;
  1932. return GRUB_ERR_NONE;
  1933. }
  1934. #endif
  1935. static struct grub_fs grub_btrfs_fs = {
  1936. .name = "btrfs",
  1937. .fs_dir = grub_btrfs_dir,
  1938. .fs_open = grub_btrfs_open,
  1939. .fs_read = grub_btrfs_read,
  1940. .fs_close = grub_btrfs_close,
  1941. .fs_uuid = grub_btrfs_uuid,
  1942. .fs_label = grub_btrfs_label,
  1943. #ifdef GRUB_UTIL
  1944. .fs_embed = grub_btrfs_embed,
  1945. .reserved_first_sector = 1,
  1946. .blocklist_install = 0,
  1947. #endif
  1948. };
  1949. GRUB_MOD_INIT (btrfs)
  1950. {
  1951. grub_fs_register (&grub_btrfs_fs);
  1952. }
  1953. GRUB_MOD_FINI (btrfs)
  1954. {
  1955. grub_fs_unregister (&grub_btrfs_fs);
  1956. }