md_jmicron.c 42 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562
  1. /*-
  2. * SPDX-License-Identifier: BSD-2-Clause
  3. *
  4. * Copyright (c) 2010 Alexander Motin <mav@FreeBSD.org>
  5. * Copyright (c) 2000 - 2008 Søren Schmidt <sos@FreeBSD.org>
  6. * All rights reserved.
  7. *
  8. * Redistribution and use in source and binary forms, with or without
  9. * modification, are permitted provided that the following conditions
  10. * are met:
  11. * 1. Redistributions of source code must retain the above copyright
  12. * notice, this list of conditions and the following disclaimer.
  13. * 2. Redistributions in binary form must reproduce the above copyright
  14. * notice, this list of conditions and the following disclaimer in the
  15. * documentation and/or other materials provided with the distribution.
  16. *
  17. * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
  18. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20. * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
  21. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27. * SUCH DAMAGE.
  28. */
  29. #include <sys/param.h>
  30. #include <sys/bio.h>
  31. #include <sys/endian.h>
  32. #include <sys/kernel.h>
  33. #include <sys/kobj.h>
  34. #include <sys/limits.h>
  35. #include <sys/lock.h>
  36. #include <sys/malloc.h>
  37. #include <sys/mutex.h>
  38. #include <sys/systm.h>
  39. #include <sys/taskqueue.h>
  40. #include <geom/geom.h>
  41. #include <geom/geom_dbg.h>
  42. #include "geom/raid/g_raid.h"
  43. #include "g_raid_md_if.h"
  44. static MALLOC_DEFINE(M_MD_JMICRON, "md_jmicron_data", "GEOM_RAID JMicron metadata");
  45. #define JMICRON_MAX_DISKS 8
  46. #define JMICRON_MAX_SPARE 2
  47. struct jmicron_raid_conf {
  48. uint8_t signature[2];
  49. #define JMICRON_MAGIC "JM"
  50. uint16_t version;
  51. #define JMICRON_VERSION 0x0001
  52. uint16_t checksum;
  53. uint8_t filler_1[10];
  54. uint32_t disk_id;
  55. uint32_t offset;
  56. uint32_t disk_sectors_high;
  57. uint16_t disk_sectors_low;
  58. uint8_t filler_2[2];
  59. uint8_t name[16];
  60. uint8_t type;
  61. #define JMICRON_T_RAID0 0
  62. #define JMICRON_T_RAID1 1
  63. #define JMICRON_T_RAID01 2
  64. #define JMICRON_T_CONCAT 3
  65. #define JMICRON_T_RAID5 5
  66. uint8_t stripe_shift;
  67. uint16_t flags;
  68. #define JMICRON_F_READY 0x0001
  69. #define JMICRON_F_BOOTABLE 0x0002
  70. #define JMICRON_F_BADSEC 0x0004
  71. #define JMICRON_F_ACTIVE 0x0010
  72. #define JMICRON_F_UNSYNC 0x0020
  73. #define JMICRON_F_NEWEST 0x0040
  74. uint8_t filler_3[4];
  75. uint32_t spare[JMICRON_MAX_SPARE];
  76. uint32_t disks[JMICRON_MAX_DISKS];
  77. #define JMICRON_DISK_MASK 0xFFFFFFF0
  78. #define JMICRON_SEG_MASK 0x0000000F
  79. uint8_t filler_4[32];
  80. uint8_t filler_5[384];
  81. };
  82. struct g_raid_md_jmicron_perdisk {
  83. struct jmicron_raid_conf *pd_meta;
  84. int pd_disk_pos;
  85. int pd_disk_id;
  86. off_t pd_disk_size;
  87. };
  88. struct g_raid_md_jmicron_object {
  89. struct g_raid_md_object mdio_base;
  90. uint32_t mdio_config_id;
  91. struct jmicron_raid_conf *mdio_meta;
  92. struct callout mdio_start_co; /* STARTING state timer. */
  93. int mdio_total_disks;
  94. int mdio_disks_present;
  95. int mdio_started;
  96. int mdio_incomplete;
  97. struct root_hold_token *mdio_rootmount; /* Root mount delay token. */
  98. };
  99. static g_raid_md_create_t g_raid_md_create_jmicron;
  100. static g_raid_md_taste_t g_raid_md_taste_jmicron;
  101. static g_raid_md_event_t g_raid_md_event_jmicron;
  102. static g_raid_md_ctl_t g_raid_md_ctl_jmicron;
  103. static g_raid_md_write_t g_raid_md_write_jmicron;
  104. static g_raid_md_fail_disk_t g_raid_md_fail_disk_jmicron;
  105. static g_raid_md_free_disk_t g_raid_md_free_disk_jmicron;
  106. static g_raid_md_free_t g_raid_md_free_jmicron;
  107. static kobj_method_t g_raid_md_jmicron_methods[] = {
  108. KOBJMETHOD(g_raid_md_create, g_raid_md_create_jmicron),
  109. KOBJMETHOD(g_raid_md_taste, g_raid_md_taste_jmicron),
  110. KOBJMETHOD(g_raid_md_event, g_raid_md_event_jmicron),
  111. KOBJMETHOD(g_raid_md_ctl, g_raid_md_ctl_jmicron),
  112. KOBJMETHOD(g_raid_md_write, g_raid_md_write_jmicron),
  113. KOBJMETHOD(g_raid_md_fail_disk, g_raid_md_fail_disk_jmicron),
  114. KOBJMETHOD(g_raid_md_free_disk, g_raid_md_free_disk_jmicron),
  115. KOBJMETHOD(g_raid_md_free, g_raid_md_free_jmicron),
  116. { 0, 0 }
  117. };
  118. static struct g_raid_md_class g_raid_md_jmicron_class = {
  119. "JMicron",
  120. g_raid_md_jmicron_methods,
  121. sizeof(struct g_raid_md_jmicron_object),
  122. .mdc_enable = 1,
  123. .mdc_priority = 100
  124. };
  125. static void
  126. g_raid_md_jmicron_print(struct jmicron_raid_conf *meta)
  127. {
  128. int k;
  129. if (g_raid_debug < 1)
  130. return;
  131. printf("********* ATA JMicron RAID Metadata *********\n");
  132. printf("signature <%c%c>\n", meta->signature[0], meta->signature[1]);
  133. printf("version %04x\n", meta->version);
  134. printf("checksum 0x%04x\n", meta->checksum);
  135. printf("disk_id 0x%08x\n", meta->disk_id);
  136. printf("offset 0x%08x\n", meta->offset);
  137. printf("disk_sectors_high 0x%08x\n", meta->disk_sectors_high);
  138. printf("disk_sectors_low 0x%04x\n", meta->disk_sectors_low);
  139. printf("name <%.16s>\n", meta->name);
  140. printf("type %d\n", meta->type);
  141. printf("stripe_shift %d\n", meta->stripe_shift);
  142. printf("flags %04x\n", meta->flags);
  143. printf("spare ");
  144. for (k = 0; k < JMICRON_MAX_SPARE; k++)
  145. printf(" 0x%08x", meta->spare[k]);
  146. printf("\n");
  147. printf("disks ");
  148. for (k = 0; k < JMICRON_MAX_DISKS; k++)
  149. printf(" 0x%08x", meta->disks[k]);
  150. printf("\n");
  151. printf("=================================================\n");
  152. }
  153. static struct jmicron_raid_conf *
  154. jmicron_meta_copy(struct jmicron_raid_conf *meta)
  155. {
  156. struct jmicron_raid_conf *nmeta;
  157. nmeta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK);
  158. memcpy(nmeta, meta, sizeof(*meta));
  159. return (nmeta);
  160. }
  161. static int
  162. jmicron_meta_total_disks(struct jmicron_raid_conf *meta)
  163. {
  164. int pos;
  165. for (pos = 0; pos < JMICRON_MAX_DISKS; pos++) {
  166. if (meta->disks[pos] == 0)
  167. break;
  168. }
  169. return (pos);
  170. }
  171. static int
  172. jmicron_meta_total_spare(struct jmicron_raid_conf *meta)
  173. {
  174. int pos, n;
  175. n = 0;
  176. for (pos = 0; pos < JMICRON_MAX_SPARE; pos++) {
  177. if (meta->spare[pos] != 0)
  178. n++;
  179. }
  180. return (n);
  181. }
  182. /*
  183. * Generate fake Configuration ID based on disk IDs.
  184. * Note: it will change after each disk set change.
  185. */
  186. static uint32_t
  187. jmicron_meta_config_id(struct jmicron_raid_conf *meta)
  188. {
  189. int pos;
  190. uint32_t config_id;
  191. config_id = 0;
  192. for (pos = 0; pos < JMICRON_MAX_DISKS; pos++)
  193. config_id += meta->disks[pos] << pos;
  194. return (config_id);
  195. }
  196. static void
  197. jmicron_meta_get_name(struct jmicron_raid_conf *meta, char *buf)
  198. {
  199. int i;
  200. strncpy(buf, meta->name, 16);
  201. buf[16] = 0;
  202. for (i = 15; i >= 0; i--) {
  203. if (buf[i] > 0x20)
  204. break;
  205. buf[i] = 0;
  206. }
  207. }
  208. static void
  209. jmicron_meta_put_name(struct jmicron_raid_conf *meta, char *buf)
  210. {
  211. memset(meta->name, 0x20, 16);
  212. memcpy(meta->name, buf, MIN(strlen(buf), 16));
  213. }
  214. static int
  215. jmicron_meta_find_disk(struct jmicron_raid_conf *meta, uint32_t id)
  216. {
  217. int pos;
  218. id &= JMICRON_DISK_MASK;
  219. for (pos = 0; pos < JMICRON_MAX_DISKS; pos++) {
  220. if ((meta->disks[pos] & JMICRON_DISK_MASK) == id)
  221. return (pos);
  222. }
  223. for (pos = 0; pos < JMICRON_MAX_SPARE; pos++) {
  224. if ((meta->spare[pos] & JMICRON_DISK_MASK) == id)
  225. return (-3);
  226. }
  227. return (-1);
  228. }
  229. static struct jmicron_raid_conf *
  230. jmicron_meta_read(struct g_consumer *cp)
  231. {
  232. struct g_provider *pp;
  233. struct jmicron_raid_conf *meta;
  234. char *buf;
  235. int error, i;
  236. uint16_t checksum, *ptr;
  237. pp = cp->provider;
  238. if (pp->sectorsize < sizeof(*meta))
  239. return (NULL);
  240. /* Read the anchor sector. */
  241. buf = g_read_data(cp,
  242. pp->mediasize - pp->sectorsize, pp->sectorsize, &error);
  243. if (buf == NULL) {
  244. G_RAID_DEBUG(1, "Cannot read metadata from %s (error=%d).",
  245. pp->name, error);
  246. return (NULL);
  247. }
  248. meta = (struct jmicron_raid_conf *)buf;
  249. /* Check if this is an JMicron RAID struct */
  250. if (strncmp(meta->signature, JMICRON_MAGIC, strlen(JMICRON_MAGIC))) {
  251. G_RAID_DEBUG(1, "JMicron signature check failed on %s", pp->name);
  252. g_free(buf);
  253. return (NULL);
  254. }
  255. meta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK);
  256. memcpy(meta, buf, min(sizeof(*meta), pp->sectorsize));
  257. g_free(buf);
  258. /* Check metadata checksum. */
  259. for (checksum = 0, ptr = (uint16_t *)meta, i = 0; i < 64; i++)
  260. checksum += *ptr++;
  261. if (checksum != 0) {
  262. G_RAID_DEBUG(1, "JMicron checksum check failed on %s", pp->name);
  263. free(meta, M_MD_JMICRON);
  264. return (NULL);
  265. }
  266. return (meta);
  267. }
  268. static int
  269. jmicron_meta_write(struct g_consumer *cp, struct jmicron_raid_conf *meta)
  270. {
  271. struct g_provider *pp;
  272. char *buf;
  273. int error, i;
  274. uint16_t checksum, *ptr;
  275. pp = cp->provider;
  276. /* Recalculate checksum for case if metadata were changed. */
  277. meta->checksum = 0;
  278. for (checksum = 0, ptr = (uint16_t *)meta, i = 0; i < 64; i++)
  279. checksum += *ptr++;
  280. meta->checksum -= checksum;
  281. /* Create and fill buffer. */
  282. buf = malloc(pp->sectorsize, M_MD_JMICRON, M_WAITOK | M_ZERO);
  283. memcpy(buf, meta, sizeof(*meta));
  284. error = g_write_data(cp,
  285. pp->mediasize - pp->sectorsize, buf, pp->sectorsize);
  286. if (error != 0) {
  287. G_RAID_DEBUG(1, "Cannot write metadata to %s (error=%d).",
  288. pp->name, error);
  289. }
  290. free(buf, M_MD_JMICRON);
  291. return (error);
  292. }
  293. static int
  294. jmicron_meta_erase(struct g_consumer *cp)
  295. {
  296. struct g_provider *pp;
  297. char *buf;
  298. int error;
  299. pp = cp->provider;
  300. buf = malloc(pp->sectorsize, M_MD_JMICRON, M_WAITOK | M_ZERO);
  301. error = g_write_data(cp,
  302. pp->mediasize - pp->sectorsize, buf, pp->sectorsize);
  303. if (error != 0) {
  304. G_RAID_DEBUG(1, "Cannot erase metadata on %s (error=%d).",
  305. pp->name, error);
  306. }
  307. free(buf, M_MD_JMICRON);
  308. return (error);
  309. }
  310. static struct g_raid_disk *
  311. g_raid_md_jmicron_get_disk(struct g_raid_softc *sc, int id)
  312. {
  313. struct g_raid_disk *disk;
  314. struct g_raid_md_jmicron_perdisk *pd;
  315. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  316. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  317. if (pd->pd_disk_pos == id)
  318. break;
  319. }
  320. return (disk);
  321. }
  322. static int
  323. g_raid_md_jmicron_supported(int level, int qual, int disks, int force)
  324. {
  325. if (disks > 8)
  326. return (0);
  327. switch (level) {
  328. case G_RAID_VOLUME_RL_RAID0:
  329. if (disks < 1)
  330. return (0);
  331. if (!force && (disks < 2 || disks > 6))
  332. return (0);
  333. break;
  334. case G_RAID_VOLUME_RL_RAID1:
  335. if (disks < 1)
  336. return (0);
  337. if (!force && (disks != 2))
  338. return (0);
  339. break;
  340. case G_RAID_VOLUME_RL_RAID1E:
  341. if (disks < 2)
  342. return (0);
  343. if (!force && (disks != 4))
  344. return (0);
  345. break;
  346. case G_RAID_VOLUME_RL_SINGLE:
  347. if (disks != 1)
  348. return (0);
  349. if (!force)
  350. return (0);
  351. break;
  352. case G_RAID_VOLUME_RL_CONCAT:
  353. if (disks < 2)
  354. return (0);
  355. break;
  356. case G_RAID_VOLUME_RL_RAID5:
  357. if (disks < 3)
  358. return (0);
  359. if (qual != G_RAID_VOLUME_RLQ_R5LA)
  360. return (0);
  361. if (!force)
  362. return (0);
  363. break;
  364. default:
  365. return (0);
  366. }
  367. if (level != G_RAID_VOLUME_RL_RAID5 && qual != G_RAID_VOLUME_RLQ_NONE)
  368. return (0);
  369. return (1);
  370. }
  371. static int
  372. g_raid_md_jmicron_start_disk(struct g_raid_disk *disk)
  373. {
  374. struct g_raid_softc *sc;
  375. struct g_raid_subdisk *sd, *tmpsd;
  376. struct g_raid_disk *olddisk, *tmpdisk;
  377. struct g_raid_md_object *md;
  378. struct g_raid_md_jmicron_object *mdi;
  379. struct g_raid_md_jmicron_perdisk *pd, *oldpd;
  380. struct jmicron_raid_conf *meta;
  381. int disk_pos, resurrection = 0;
  382. sc = disk->d_softc;
  383. md = sc->sc_md;
  384. mdi = (struct g_raid_md_jmicron_object *)md;
  385. meta = mdi->mdio_meta;
  386. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  387. olddisk = NULL;
  388. /* Find disk position in metadata by its serial. */
  389. if (pd->pd_meta != NULL)
  390. disk_pos = jmicron_meta_find_disk(meta, pd->pd_disk_id);
  391. else
  392. disk_pos = -1;
  393. if (disk_pos < 0) {
  394. G_RAID_DEBUG1(1, sc, "Unknown, probably new or stale disk");
  395. /* If we are in the start process, that's all for now. */
  396. if (!mdi->mdio_started)
  397. goto nofit;
  398. /*
  399. * If we have already started - try to get use of the disk.
  400. * Try to replace OFFLINE disks first, then FAILED.
  401. */
  402. TAILQ_FOREACH(tmpdisk, &sc->sc_disks, d_next) {
  403. if (tmpdisk->d_state != G_RAID_DISK_S_OFFLINE &&
  404. tmpdisk->d_state != G_RAID_DISK_S_FAILED)
  405. continue;
  406. /* Make sure this disk is big enough. */
  407. TAILQ_FOREACH(sd, &tmpdisk->d_subdisks, sd_next) {
  408. if (sd->sd_offset + sd->sd_size + 512 >
  409. pd->pd_disk_size) {
  410. G_RAID_DEBUG1(1, sc,
  411. "Disk too small (%ju < %ju)",
  412. pd->pd_disk_size,
  413. sd->sd_offset + sd->sd_size + 512);
  414. break;
  415. }
  416. }
  417. if (sd != NULL)
  418. continue;
  419. if (tmpdisk->d_state == G_RAID_DISK_S_OFFLINE) {
  420. olddisk = tmpdisk;
  421. break;
  422. } else if (olddisk == NULL)
  423. olddisk = tmpdisk;
  424. }
  425. if (olddisk == NULL) {
  426. nofit:
  427. if (disk_pos == -3 || pd->pd_disk_pos == -3) {
  428. g_raid_change_disk_state(disk,
  429. G_RAID_DISK_S_SPARE);
  430. return (1);
  431. } else {
  432. g_raid_change_disk_state(disk,
  433. G_RAID_DISK_S_STALE);
  434. return (0);
  435. }
  436. }
  437. oldpd = (struct g_raid_md_jmicron_perdisk *)olddisk->d_md_data;
  438. disk_pos = oldpd->pd_disk_pos;
  439. resurrection = 1;
  440. }
  441. if (olddisk == NULL) {
  442. /* Find placeholder by position. */
  443. olddisk = g_raid_md_jmicron_get_disk(sc, disk_pos);
  444. if (olddisk == NULL)
  445. panic("No disk at position %d!", disk_pos);
  446. if (olddisk->d_state != G_RAID_DISK_S_OFFLINE) {
  447. G_RAID_DEBUG1(1, sc, "More than one disk for pos %d",
  448. disk_pos);
  449. g_raid_change_disk_state(disk, G_RAID_DISK_S_STALE);
  450. return (0);
  451. }
  452. oldpd = (struct g_raid_md_jmicron_perdisk *)olddisk->d_md_data;
  453. }
  454. /* Replace failed disk or placeholder with new disk. */
  455. TAILQ_FOREACH_SAFE(sd, &olddisk->d_subdisks, sd_next, tmpsd) {
  456. TAILQ_REMOVE(&olddisk->d_subdisks, sd, sd_next);
  457. TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
  458. sd->sd_disk = disk;
  459. }
  460. oldpd->pd_disk_pos = -2;
  461. pd->pd_disk_pos = disk_pos;
  462. /* Update global metadata just in case. */
  463. meta->disks[disk_pos] = pd->pd_disk_id;
  464. /* If it was placeholder -- destroy it. */
  465. if (olddisk->d_state == G_RAID_DISK_S_OFFLINE) {
  466. g_raid_destroy_disk(olddisk);
  467. } else {
  468. /* Otherwise, make it STALE_FAILED. */
  469. g_raid_change_disk_state(olddisk, G_RAID_DISK_S_STALE_FAILED);
  470. }
  471. /* Welcome the new disk. */
  472. g_raid_change_disk_state(disk, G_RAID_DISK_S_ACTIVE);
  473. TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
  474. /*
  475. * Different disks may have different sizes/offsets,
  476. * especially in concat mode. Update.
  477. */
  478. if (!resurrection) {
  479. sd->sd_offset =
  480. (off_t)pd->pd_meta->offset * 16 * 512; //ZZZ
  481. sd->sd_size =
  482. (((off_t)pd->pd_meta->disk_sectors_high << 16) +
  483. pd->pd_meta->disk_sectors_low) * 512;
  484. }
  485. if (resurrection) {
  486. /* Stale disk, almost same as new. */
  487. g_raid_change_subdisk_state(sd,
  488. G_RAID_SUBDISK_S_NEW);
  489. } else if ((meta->flags & JMICRON_F_BADSEC) != 0 &&
  490. (pd->pd_meta->flags & JMICRON_F_BADSEC) == 0) {
  491. /* Cold-inserted or rebuilding disk. */
  492. g_raid_change_subdisk_state(sd,
  493. G_RAID_SUBDISK_S_NEW);
  494. } else if (pd->pd_meta->flags & JMICRON_F_UNSYNC) {
  495. /* Dirty or resyncing disk.. */
  496. g_raid_change_subdisk_state(sd,
  497. G_RAID_SUBDISK_S_STALE);
  498. } else {
  499. /* Up to date disk. */
  500. g_raid_change_subdisk_state(sd,
  501. G_RAID_SUBDISK_S_ACTIVE);
  502. }
  503. g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
  504. G_RAID_EVENT_SUBDISK);
  505. }
  506. /* Update status of our need for spare. */
  507. if (mdi->mdio_started) {
  508. mdi->mdio_incomplete =
  509. (g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE) <
  510. mdi->mdio_total_disks);
  511. }
  512. return (resurrection);
  513. }
  514. static void
  515. g_disk_md_jmicron_retaste(void *arg, int pending)
  516. {
  517. G_RAID_DEBUG(1, "Array is not complete, trying to retaste.");
  518. g_retaste(&g_raid_class);
  519. free(arg, M_MD_JMICRON);
  520. }
  521. static void
  522. g_raid_md_jmicron_refill(struct g_raid_softc *sc)
  523. {
  524. struct g_raid_md_object *md;
  525. struct g_raid_md_jmicron_object *mdi;
  526. struct g_raid_disk *disk;
  527. struct task *task;
  528. int update, na;
  529. md = sc->sc_md;
  530. mdi = (struct g_raid_md_jmicron_object *)md;
  531. update = 0;
  532. do {
  533. /* Make sure we miss anything. */
  534. na = g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE);
  535. if (na == mdi->mdio_total_disks)
  536. break;
  537. G_RAID_DEBUG1(1, md->mdo_softc,
  538. "Array is not complete (%d of %d), "
  539. "trying to refill.", na, mdi->mdio_total_disks);
  540. /* Try to get use some of STALE disks. */
  541. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  542. if (disk->d_state == G_RAID_DISK_S_STALE) {
  543. update += g_raid_md_jmicron_start_disk(disk);
  544. if (disk->d_state == G_RAID_DISK_S_ACTIVE)
  545. break;
  546. }
  547. }
  548. if (disk != NULL)
  549. continue;
  550. /* Try to get use some of SPARE disks. */
  551. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  552. if (disk->d_state == G_RAID_DISK_S_SPARE) {
  553. update += g_raid_md_jmicron_start_disk(disk);
  554. if (disk->d_state == G_RAID_DISK_S_ACTIVE)
  555. break;
  556. }
  557. }
  558. } while (disk != NULL);
  559. /* Write new metadata if we changed something. */
  560. if (update)
  561. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  562. /* Update status of our need for spare. */
  563. mdi->mdio_incomplete = (g_raid_ndisks(sc, G_RAID_DISK_S_ACTIVE) <
  564. mdi->mdio_total_disks);
  565. /* Request retaste hoping to find spare. */
  566. if (mdi->mdio_incomplete) {
  567. task = malloc(sizeof(struct task),
  568. M_MD_JMICRON, M_WAITOK | M_ZERO);
  569. TASK_INIT(task, 0, g_disk_md_jmicron_retaste, task);
  570. taskqueue_enqueue(taskqueue_swi, task);
  571. }
  572. }
  573. static void
  574. g_raid_md_jmicron_start(struct g_raid_softc *sc)
  575. {
  576. struct g_raid_md_object *md;
  577. struct g_raid_md_jmicron_object *mdi;
  578. struct g_raid_md_jmicron_perdisk *pd;
  579. struct jmicron_raid_conf *meta;
  580. struct g_raid_volume *vol;
  581. struct g_raid_subdisk *sd;
  582. struct g_raid_disk *disk;
  583. off_t size;
  584. int j, disk_pos;
  585. char buf[17];
  586. md = sc->sc_md;
  587. mdi = (struct g_raid_md_jmicron_object *)md;
  588. meta = mdi->mdio_meta;
  589. /* Create volumes and subdisks. */
  590. jmicron_meta_get_name(meta, buf);
  591. vol = g_raid_create_volume(sc, buf, -1);
  592. size = ((off_t)meta->disk_sectors_high << 16) + meta->disk_sectors_low;
  593. size *= 512; //ZZZ
  594. vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_NONE;
  595. if (meta->type == JMICRON_T_RAID0) {
  596. vol->v_raid_level = G_RAID_VOLUME_RL_RAID0;
  597. vol->v_mediasize = size * mdi->mdio_total_disks;
  598. } else if (meta->type == JMICRON_T_RAID1) {
  599. vol->v_raid_level = G_RAID_VOLUME_RL_RAID1;
  600. vol->v_mediasize = size;
  601. } else if (meta->type == JMICRON_T_RAID01) {
  602. vol->v_raid_level = G_RAID_VOLUME_RL_RAID1E;
  603. vol->v_mediasize = size * mdi->mdio_total_disks / 2;
  604. } else if (meta->type == JMICRON_T_CONCAT) {
  605. if (mdi->mdio_total_disks == 1)
  606. vol->v_raid_level = G_RAID_VOLUME_RL_SINGLE;
  607. else
  608. vol->v_raid_level = G_RAID_VOLUME_RL_CONCAT;
  609. vol->v_mediasize = 0;
  610. } else if (meta->type == JMICRON_T_RAID5) {
  611. vol->v_raid_level = G_RAID_VOLUME_RL_RAID5;
  612. vol->v_raid_level_qualifier = G_RAID_VOLUME_RLQ_R5LA;
  613. vol->v_mediasize = size * (mdi->mdio_total_disks - 1);
  614. } else {
  615. vol->v_raid_level = G_RAID_VOLUME_RL_UNKNOWN;
  616. vol->v_mediasize = 0;
  617. }
  618. vol->v_strip_size = 1024 << meta->stripe_shift; //ZZZ
  619. vol->v_disks_count = mdi->mdio_total_disks;
  620. vol->v_sectorsize = 512; //ZZZ
  621. for (j = 0; j < vol->v_disks_count; j++) {
  622. sd = &vol->v_subdisks[j];
  623. sd->sd_offset = (off_t)meta->offset * 16 * 512; //ZZZ
  624. sd->sd_size = size;
  625. }
  626. g_raid_start_volume(vol);
  627. /* Create disk placeholders to store data for later writing. */
  628. for (disk_pos = 0; disk_pos < mdi->mdio_total_disks; disk_pos++) {
  629. pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
  630. pd->pd_disk_pos = disk_pos;
  631. pd->pd_disk_id = meta->disks[disk_pos];
  632. disk = g_raid_create_disk(sc);
  633. disk->d_md_data = (void *)pd;
  634. disk->d_state = G_RAID_DISK_S_OFFLINE;
  635. sd = &vol->v_subdisks[disk_pos];
  636. sd->sd_disk = disk;
  637. TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
  638. }
  639. /* Make all disks found till the moment take their places. */
  640. do {
  641. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  642. if (disk->d_state == G_RAID_DISK_S_NONE) {
  643. g_raid_md_jmicron_start_disk(disk);
  644. break;
  645. }
  646. }
  647. } while (disk != NULL);
  648. mdi->mdio_started = 1;
  649. G_RAID_DEBUG1(0, sc, "Array started.");
  650. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  651. /* Pickup any STALE/SPARE disks to refill array if needed. */
  652. g_raid_md_jmicron_refill(sc);
  653. g_raid_event_send(vol, G_RAID_VOLUME_E_START, G_RAID_EVENT_VOLUME);
  654. callout_stop(&mdi->mdio_start_co);
  655. G_RAID_DEBUG1(1, sc, "root_mount_rel %p", mdi->mdio_rootmount);
  656. root_mount_rel(mdi->mdio_rootmount);
  657. mdi->mdio_rootmount = NULL;
  658. }
  659. static void
  660. g_raid_md_jmicron_new_disk(struct g_raid_disk *disk)
  661. {
  662. struct g_raid_softc *sc;
  663. struct g_raid_md_object *md;
  664. struct g_raid_md_jmicron_object *mdi;
  665. struct jmicron_raid_conf *pdmeta;
  666. struct g_raid_md_jmicron_perdisk *pd;
  667. sc = disk->d_softc;
  668. md = sc->sc_md;
  669. mdi = (struct g_raid_md_jmicron_object *)md;
  670. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  671. pdmeta = pd->pd_meta;
  672. if (mdi->mdio_started) {
  673. if (g_raid_md_jmicron_start_disk(disk))
  674. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  675. } else {
  676. /*
  677. * If we haven't started yet - update common metadata
  678. * to get subdisks details, avoiding data from spare disks.
  679. */
  680. if (mdi->mdio_meta == NULL ||
  681. jmicron_meta_find_disk(mdi->mdio_meta,
  682. mdi->mdio_meta->disk_id) == -3) {
  683. if (mdi->mdio_meta != NULL)
  684. free(mdi->mdio_meta, M_MD_JMICRON);
  685. mdi->mdio_meta = jmicron_meta_copy(pdmeta);
  686. mdi->mdio_total_disks = jmicron_meta_total_disks(pdmeta);
  687. }
  688. mdi->mdio_meta->flags |= pdmeta->flags & JMICRON_F_BADSEC;
  689. mdi->mdio_disks_present++;
  690. G_RAID_DEBUG1(1, sc, "Matching disk (%d of %d+%d up)",
  691. mdi->mdio_disks_present,
  692. mdi->mdio_total_disks,
  693. jmicron_meta_total_spare(mdi->mdio_meta));
  694. /* If we collected all needed disks - start array. */
  695. if (mdi->mdio_disks_present == mdi->mdio_total_disks +
  696. jmicron_meta_total_spare(mdi->mdio_meta))
  697. g_raid_md_jmicron_start(sc);
  698. }
  699. }
  700. static void
  701. g_raid_jmicron_go(void *arg)
  702. {
  703. struct g_raid_softc *sc;
  704. struct g_raid_md_object *md;
  705. struct g_raid_md_jmicron_object *mdi;
  706. sc = arg;
  707. md = sc->sc_md;
  708. mdi = (struct g_raid_md_jmicron_object *)md;
  709. if (!mdi->mdio_started) {
  710. G_RAID_DEBUG1(0, sc, "Force array start due to timeout.");
  711. g_raid_event_send(sc, G_RAID_NODE_E_START, 0);
  712. }
  713. }
  714. static int
  715. g_raid_md_create_jmicron(struct g_raid_md_object *md, struct g_class *mp,
  716. struct g_geom **gp)
  717. {
  718. struct g_raid_softc *sc;
  719. struct g_raid_md_jmicron_object *mdi;
  720. char name[16];
  721. mdi = (struct g_raid_md_jmicron_object *)md;
  722. mdi->mdio_config_id = arc4random();
  723. snprintf(name, sizeof(name), "JMicron-%08x", mdi->mdio_config_id);
  724. sc = g_raid_create_node(mp, name, md);
  725. if (sc == NULL)
  726. return (G_RAID_MD_TASTE_FAIL);
  727. md->mdo_softc = sc;
  728. *gp = sc->sc_geom;
  729. return (G_RAID_MD_TASTE_NEW);
  730. }
  731. static int
  732. g_raid_md_taste_jmicron(struct g_raid_md_object *md, struct g_class *mp,
  733. struct g_consumer *cp, struct g_geom **gp)
  734. {
  735. struct g_consumer *rcp;
  736. struct g_provider *pp;
  737. struct g_raid_md_jmicron_object *mdi, *mdi1;
  738. struct g_raid_softc *sc;
  739. struct g_raid_disk *disk;
  740. struct jmicron_raid_conf *meta;
  741. struct g_raid_md_jmicron_perdisk *pd;
  742. struct g_geom *geom;
  743. int disk_pos, result, spare, len;
  744. char name[16];
  745. uint16_t vendor;
  746. G_RAID_DEBUG(1, "Tasting JMicron on %s", cp->provider->name);
  747. mdi = (struct g_raid_md_jmicron_object *)md;
  748. pp = cp->provider;
  749. /* Read metadata from device. */
  750. meta = NULL;
  751. g_topology_unlock();
  752. vendor = 0xffff;
  753. len = sizeof(vendor);
  754. if (pp->geom->rank == 1)
  755. g_io_getattr("GEOM::hba_vendor", cp, &len, &vendor);
  756. meta = jmicron_meta_read(cp);
  757. g_topology_lock();
  758. if (meta == NULL) {
  759. if (g_raid_aggressive_spare) {
  760. if (vendor == 0x197b) {
  761. G_RAID_DEBUG(1,
  762. "No JMicron metadata, forcing spare.");
  763. spare = 2;
  764. goto search;
  765. } else {
  766. G_RAID_DEBUG(1,
  767. "JMicron vendor mismatch 0x%04x != 0x197b",
  768. vendor);
  769. }
  770. }
  771. return (G_RAID_MD_TASTE_FAIL);
  772. }
  773. /* Check this disk position in obtained metadata. */
  774. disk_pos = jmicron_meta_find_disk(meta, meta->disk_id);
  775. if (disk_pos == -1) {
  776. G_RAID_DEBUG(1, "JMicron disk_id %08x not found",
  777. meta->disk_id);
  778. goto fail1;
  779. }
  780. /* Metadata valid. Print it. */
  781. g_raid_md_jmicron_print(meta);
  782. G_RAID_DEBUG(1, "JMicron disk position %d", disk_pos);
  783. spare = (disk_pos == -2) ? 1 : 0;
  784. search:
  785. /* Search for matching node. */
  786. sc = NULL;
  787. mdi1 = NULL;
  788. LIST_FOREACH(geom, &mp->geom, geom) {
  789. sc = geom->softc;
  790. if (sc == NULL)
  791. continue;
  792. if (sc->sc_stopping != 0)
  793. continue;
  794. if (sc->sc_md->mdo_class != md->mdo_class)
  795. continue;
  796. mdi1 = (struct g_raid_md_jmicron_object *)sc->sc_md;
  797. if (spare == 2) {
  798. if (mdi1->mdio_incomplete)
  799. break;
  800. } else {
  801. if (mdi1->mdio_config_id ==
  802. jmicron_meta_config_id(meta))
  803. break;
  804. }
  805. }
  806. /* Found matching node. */
  807. if (geom != NULL) {
  808. G_RAID_DEBUG(1, "Found matching array %s", sc->sc_name);
  809. result = G_RAID_MD_TASTE_EXISTING;
  810. } else if (spare) { /* Not found needy node -- left for later. */
  811. G_RAID_DEBUG(1, "Spare is not needed at this time");
  812. goto fail1;
  813. } else { /* Not found matching node -- create one. */
  814. result = G_RAID_MD_TASTE_NEW;
  815. mdi->mdio_config_id = jmicron_meta_config_id(meta);
  816. snprintf(name, sizeof(name), "JMicron-%08x",
  817. mdi->mdio_config_id);
  818. sc = g_raid_create_node(mp, name, md);
  819. md->mdo_softc = sc;
  820. geom = sc->sc_geom;
  821. callout_init(&mdi->mdio_start_co, 1);
  822. callout_reset(&mdi->mdio_start_co, g_raid_start_timeout * hz,
  823. g_raid_jmicron_go, sc);
  824. mdi->mdio_rootmount = root_mount_hold("GRAID-JMicron");
  825. G_RAID_DEBUG1(1, sc, "root_mount_hold %p", mdi->mdio_rootmount);
  826. }
  827. /* There is no return after this point, so we close passed consumer. */
  828. g_access(cp, -1, 0, 0);
  829. rcp = g_new_consumer(geom);
  830. rcp->flags |= G_CF_DIRECT_RECEIVE;
  831. g_attach(rcp, pp);
  832. if (g_access(rcp, 1, 1, 1) != 0)
  833. ; //goto fail1;
  834. g_topology_unlock();
  835. sx_xlock(&sc->sc_lock);
  836. pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
  837. pd->pd_meta = meta;
  838. if (spare == 2) {
  839. pd->pd_disk_pos = -3;
  840. pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
  841. } else {
  842. pd->pd_disk_pos = -1;
  843. pd->pd_disk_id = meta->disk_id;
  844. }
  845. pd->pd_disk_size = pp->mediasize;
  846. disk = g_raid_create_disk(sc);
  847. disk->d_md_data = (void *)pd;
  848. disk->d_consumer = rcp;
  849. rcp->private = disk;
  850. g_raid_get_disk_info(disk);
  851. g_raid_md_jmicron_new_disk(disk);
  852. sx_xunlock(&sc->sc_lock);
  853. g_topology_lock();
  854. *gp = geom;
  855. return (result);
  856. fail1:
  857. free(meta, M_MD_JMICRON);
  858. return (G_RAID_MD_TASTE_FAIL);
  859. }
  860. static int
  861. g_raid_md_event_jmicron(struct g_raid_md_object *md,
  862. struct g_raid_disk *disk, u_int event)
  863. {
  864. struct g_raid_softc *sc;
  865. struct g_raid_subdisk *sd;
  866. struct g_raid_md_jmicron_object *mdi;
  867. struct g_raid_md_jmicron_perdisk *pd;
  868. sc = md->mdo_softc;
  869. mdi = (struct g_raid_md_jmicron_object *)md;
  870. if (disk == NULL) {
  871. switch (event) {
  872. case G_RAID_NODE_E_START:
  873. if (!mdi->mdio_started)
  874. g_raid_md_jmicron_start(sc);
  875. return (0);
  876. }
  877. return (-1);
  878. }
  879. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  880. switch (event) {
  881. case G_RAID_DISK_E_DISCONNECTED:
  882. /* If disk was assigned, just update statuses. */
  883. if (pd->pd_disk_pos >= 0) {
  884. g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
  885. if (disk->d_consumer) {
  886. g_raid_kill_consumer(sc, disk->d_consumer);
  887. disk->d_consumer = NULL;
  888. }
  889. TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
  890. g_raid_change_subdisk_state(sd,
  891. G_RAID_SUBDISK_S_NONE);
  892. g_raid_event_send(sd, G_RAID_SUBDISK_E_DISCONNECTED,
  893. G_RAID_EVENT_SUBDISK);
  894. }
  895. } else {
  896. /* Otherwise -- delete. */
  897. g_raid_change_disk_state(disk, G_RAID_DISK_S_NONE);
  898. g_raid_destroy_disk(disk);
  899. }
  900. /* Write updated metadata to all disks. */
  901. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  902. /* Check if anything left except placeholders. */
  903. if (g_raid_ndisks(sc, -1) ==
  904. g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
  905. g_raid_destroy_node(sc, 0);
  906. else
  907. g_raid_md_jmicron_refill(sc);
  908. return (0);
  909. }
  910. return (-2);
  911. }
  912. static int
  913. g_raid_md_ctl_jmicron(struct g_raid_md_object *md,
  914. struct gctl_req *req)
  915. {
  916. struct g_raid_softc *sc;
  917. struct g_raid_volume *vol;
  918. struct g_raid_subdisk *sd;
  919. struct g_raid_disk *disk;
  920. struct g_raid_md_jmicron_object *mdi;
  921. struct g_raid_md_jmicron_perdisk *pd;
  922. struct g_consumer *cp;
  923. struct g_provider *pp;
  924. char arg[16];
  925. const char *verb, *volname, *levelname, *diskname;
  926. int *nargs, *force;
  927. off_t size, sectorsize, strip;
  928. intmax_t *sizearg, *striparg;
  929. int numdisks, i, len, level, qual, update;
  930. int error;
  931. sc = md->mdo_softc;
  932. mdi = (struct g_raid_md_jmicron_object *)md;
  933. verb = gctl_get_param(req, "verb", NULL);
  934. nargs = gctl_get_paraml(req, "nargs", sizeof(*nargs));
  935. error = 0;
  936. if (strcmp(verb, "label") == 0) {
  937. if (*nargs < 4) {
  938. gctl_error(req, "Invalid number of arguments.");
  939. return (-1);
  940. }
  941. volname = gctl_get_asciiparam(req, "arg1");
  942. if (volname == NULL) {
  943. gctl_error(req, "No volume name.");
  944. return (-2);
  945. }
  946. levelname = gctl_get_asciiparam(req, "arg2");
  947. if (levelname == NULL) {
  948. gctl_error(req, "No RAID level.");
  949. return (-3);
  950. }
  951. if (strcasecmp(levelname, "RAID5") == 0)
  952. levelname = "RAID5-LA";
  953. if (g_raid_volume_str2level(levelname, &level, &qual)) {
  954. gctl_error(req, "Unknown RAID level '%s'.", levelname);
  955. return (-4);
  956. }
  957. numdisks = *nargs - 3;
  958. force = gctl_get_paraml(req, "force", sizeof(*force));
  959. if (!g_raid_md_jmicron_supported(level, qual, numdisks,
  960. force ? *force : 0)) {
  961. gctl_error(req, "Unsupported RAID level "
  962. "(0x%02x/0x%02x), or number of disks (%d).",
  963. level, qual, numdisks);
  964. return (-5);
  965. }
  966. /* Search for disks, connect them and probe. */
  967. size = 0x7fffffffffffffffllu;
  968. sectorsize = 0;
  969. for (i = 0; i < numdisks; i++) {
  970. snprintf(arg, sizeof(arg), "arg%d", i + 3);
  971. diskname = gctl_get_asciiparam(req, arg);
  972. if (diskname == NULL) {
  973. gctl_error(req, "No disk name (%s).", arg);
  974. error = -6;
  975. break;
  976. }
  977. if (strcmp(diskname, "NONE") == 0) {
  978. cp = NULL;
  979. pp = NULL;
  980. } else {
  981. g_topology_lock();
  982. cp = g_raid_open_consumer(sc, diskname);
  983. if (cp == NULL) {
  984. gctl_error(req, "Can't open '%s'.",
  985. diskname);
  986. g_topology_unlock();
  987. error = -7;
  988. break;
  989. }
  990. pp = cp->provider;
  991. }
  992. pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
  993. pd->pd_disk_pos = i;
  994. pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
  995. disk = g_raid_create_disk(sc);
  996. disk->d_md_data = (void *)pd;
  997. disk->d_consumer = cp;
  998. if (cp == NULL)
  999. continue;
  1000. cp->private = disk;
  1001. g_topology_unlock();
  1002. g_raid_get_disk_info(disk);
  1003. pd->pd_disk_size = pp->mediasize;
  1004. if (size > pp->mediasize)
  1005. size = pp->mediasize;
  1006. if (sectorsize < pp->sectorsize)
  1007. sectorsize = pp->sectorsize;
  1008. }
  1009. if (error != 0)
  1010. return (error);
  1011. if (sectorsize <= 0) {
  1012. gctl_error(req, "Can't get sector size.");
  1013. return (-8);
  1014. }
  1015. /* Reserve space for metadata. */
  1016. size -= sectorsize;
  1017. /* Handle size argument. */
  1018. len = sizeof(*sizearg);
  1019. sizearg = gctl_get_param(req, "size", &len);
  1020. if (sizearg != NULL && len == sizeof(*sizearg) &&
  1021. *sizearg > 0) {
  1022. if (*sizearg > size) {
  1023. gctl_error(req, "Size too big %lld > %lld.",
  1024. (long long)*sizearg, (long long)size);
  1025. return (-9);
  1026. }
  1027. size = *sizearg;
  1028. }
  1029. /* Handle strip argument. */
  1030. strip = 131072;
  1031. len = sizeof(*striparg);
  1032. striparg = gctl_get_param(req, "strip", &len);
  1033. if (striparg != NULL && len == sizeof(*striparg) &&
  1034. *striparg > 0) {
  1035. if (*striparg < sectorsize) {
  1036. gctl_error(req, "Strip size too small.");
  1037. return (-10);
  1038. }
  1039. if (*striparg % sectorsize != 0) {
  1040. gctl_error(req, "Incorrect strip size.");
  1041. return (-11);
  1042. }
  1043. if (strip > 65535 * sectorsize) {
  1044. gctl_error(req, "Strip size too big.");
  1045. return (-12);
  1046. }
  1047. strip = *striparg;
  1048. }
  1049. /* Round size down to strip or sector. */
  1050. if (level == G_RAID_VOLUME_RL_RAID1)
  1051. size -= (size % sectorsize);
  1052. else if (level == G_RAID_VOLUME_RL_RAID1E &&
  1053. (numdisks & 1) != 0)
  1054. size -= (size % (2 * strip));
  1055. else
  1056. size -= (size % strip);
  1057. if (size <= 0) {
  1058. gctl_error(req, "Size too small.");
  1059. return (-13);
  1060. }
  1061. if (size > 0xffffffffffffllu * sectorsize) {
  1062. gctl_error(req, "Size too big.");
  1063. return (-14);
  1064. }
  1065. /* We have all we need, create things: volume, ... */
  1066. mdi->mdio_total_disks = numdisks;
  1067. mdi->mdio_started = 1;
  1068. vol = g_raid_create_volume(sc, volname, -1);
  1069. vol->v_md_data = (void *)(intptr_t)0;
  1070. vol->v_raid_level = level;
  1071. vol->v_raid_level_qualifier = qual;
  1072. vol->v_strip_size = strip;
  1073. vol->v_disks_count = numdisks;
  1074. if (level == G_RAID_VOLUME_RL_RAID0 ||
  1075. level == G_RAID_VOLUME_RL_CONCAT ||
  1076. level == G_RAID_VOLUME_RL_SINGLE)
  1077. vol->v_mediasize = size * numdisks;
  1078. else if (level == G_RAID_VOLUME_RL_RAID1)
  1079. vol->v_mediasize = size;
  1080. else if (level == G_RAID_VOLUME_RL_RAID5)
  1081. vol->v_mediasize = size * (numdisks - 1);
  1082. else { /* RAID1E */
  1083. vol->v_mediasize = ((size * numdisks) / strip / 2) *
  1084. strip;
  1085. }
  1086. vol->v_sectorsize = sectorsize;
  1087. g_raid_start_volume(vol);
  1088. /* , and subdisks. */
  1089. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  1090. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  1091. sd = &vol->v_subdisks[pd->pd_disk_pos];
  1092. sd->sd_disk = disk;
  1093. sd->sd_offset = 0;
  1094. sd->sd_size = size;
  1095. TAILQ_INSERT_TAIL(&disk->d_subdisks, sd, sd_next);
  1096. if (sd->sd_disk->d_consumer != NULL) {
  1097. g_raid_change_disk_state(disk,
  1098. G_RAID_DISK_S_ACTIVE);
  1099. g_raid_change_subdisk_state(sd,
  1100. G_RAID_SUBDISK_S_ACTIVE);
  1101. g_raid_event_send(sd, G_RAID_SUBDISK_E_NEW,
  1102. G_RAID_EVENT_SUBDISK);
  1103. } else {
  1104. g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
  1105. }
  1106. }
  1107. /* Write metadata based on created entities. */
  1108. G_RAID_DEBUG1(0, sc, "Array started.");
  1109. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  1110. /* Pickup any STALE/SPARE disks to refill array if needed. */
  1111. g_raid_md_jmicron_refill(sc);
  1112. g_raid_event_send(vol, G_RAID_VOLUME_E_START,
  1113. G_RAID_EVENT_VOLUME);
  1114. return (0);
  1115. }
  1116. if (strcmp(verb, "delete") == 0) {
  1117. /* Check if some volume is still open. */
  1118. force = gctl_get_paraml(req, "force", sizeof(*force));
  1119. if (force != NULL && *force == 0 &&
  1120. g_raid_nopens(sc) != 0) {
  1121. gctl_error(req, "Some volume is still open.");
  1122. return (-4);
  1123. }
  1124. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  1125. if (disk->d_consumer)
  1126. jmicron_meta_erase(disk->d_consumer);
  1127. }
  1128. g_raid_destroy_node(sc, 0);
  1129. return (0);
  1130. }
  1131. if (strcmp(verb, "remove") == 0 ||
  1132. strcmp(verb, "fail") == 0) {
  1133. if (*nargs < 2) {
  1134. gctl_error(req, "Invalid number of arguments.");
  1135. return (-1);
  1136. }
  1137. for (i = 1; i < *nargs; i++) {
  1138. snprintf(arg, sizeof(arg), "arg%d", i);
  1139. diskname = gctl_get_asciiparam(req, arg);
  1140. if (diskname == NULL) {
  1141. gctl_error(req, "No disk name (%s).", arg);
  1142. error = -2;
  1143. break;
  1144. }
  1145. if (strncmp(diskname, _PATH_DEV, 5) == 0)
  1146. diskname += 5;
  1147. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  1148. if (disk->d_consumer != NULL &&
  1149. disk->d_consumer->provider != NULL &&
  1150. strcmp(disk->d_consumer->provider->name,
  1151. diskname) == 0)
  1152. break;
  1153. }
  1154. if (disk == NULL) {
  1155. gctl_error(req, "Disk '%s' not found.",
  1156. diskname);
  1157. error = -3;
  1158. break;
  1159. }
  1160. if (strcmp(verb, "fail") == 0) {
  1161. g_raid_md_fail_disk_jmicron(md, NULL, disk);
  1162. continue;
  1163. }
  1164. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  1165. /* Erase metadata on deleting disk. */
  1166. jmicron_meta_erase(disk->d_consumer);
  1167. /* If disk was assigned, just update statuses. */
  1168. if (pd->pd_disk_pos >= 0) {
  1169. g_raid_change_disk_state(disk, G_RAID_DISK_S_OFFLINE);
  1170. g_raid_kill_consumer(sc, disk->d_consumer);
  1171. disk->d_consumer = NULL;
  1172. TAILQ_FOREACH(sd, &disk->d_subdisks, sd_next) {
  1173. g_raid_change_subdisk_state(sd,
  1174. G_RAID_SUBDISK_S_NONE);
  1175. g_raid_event_send(sd, G_RAID_SUBDISK_E_DISCONNECTED,
  1176. G_RAID_EVENT_SUBDISK);
  1177. }
  1178. } else {
  1179. /* Otherwise -- delete. */
  1180. g_raid_change_disk_state(disk, G_RAID_DISK_S_NONE);
  1181. g_raid_destroy_disk(disk);
  1182. }
  1183. }
  1184. /* Write updated metadata to remaining disks. */
  1185. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  1186. /* Check if anything left except placeholders. */
  1187. if (g_raid_ndisks(sc, -1) ==
  1188. g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
  1189. g_raid_destroy_node(sc, 0);
  1190. else
  1191. g_raid_md_jmicron_refill(sc);
  1192. return (error);
  1193. }
  1194. if (strcmp(verb, "insert") == 0) {
  1195. if (*nargs < 2) {
  1196. gctl_error(req, "Invalid number of arguments.");
  1197. return (-1);
  1198. }
  1199. update = 0;
  1200. for (i = 1; i < *nargs; i++) {
  1201. /* Get disk name. */
  1202. snprintf(arg, sizeof(arg), "arg%d", i);
  1203. diskname = gctl_get_asciiparam(req, arg);
  1204. if (diskname == NULL) {
  1205. gctl_error(req, "No disk name (%s).", arg);
  1206. error = -3;
  1207. break;
  1208. }
  1209. /* Try to find provider with specified name. */
  1210. g_topology_lock();
  1211. cp = g_raid_open_consumer(sc, diskname);
  1212. if (cp == NULL) {
  1213. gctl_error(req, "Can't open disk '%s'.",
  1214. diskname);
  1215. g_topology_unlock();
  1216. error = -4;
  1217. break;
  1218. }
  1219. pp = cp->provider;
  1220. pd = malloc(sizeof(*pd), M_MD_JMICRON, M_WAITOK | M_ZERO);
  1221. pd->pd_disk_pos = -3;
  1222. pd->pd_disk_id = arc4random() & JMICRON_DISK_MASK;
  1223. pd->pd_disk_size = pp->mediasize;
  1224. disk = g_raid_create_disk(sc);
  1225. disk->d_consumer = cp;
  1226. disk->d_md_data = (void *)pd;
  1227. cp->private = disk;
  1228. g_topology_unlock();
  1229. g_raid_get_disk_info(disk);
  1230. /* Welcome the "new" disk. */
  1231. update += g_raid_md_jmicron_start_disk(disk);
  1232. if (disk->d_state != G_RAID_DISK_S_ACTIVE &&
  1233. disk->d_state != G_RAID_DISK_S_SPARE) {
  1234. gctl_error(req, "Disk '%s' doesn't fit.",
  1235. diskname);
  1236. g_raid_destroy_disk(disk);
  1237. error = -8;
  1238. break;
  1239. }
  1240. }
  1241. /* Write new metadata if we changed something. */
  1242. if (update)
  1243. g_raid_md_write_jmicron(md, NULL, NULL, NULL);
  1244. return (error);
  1245. }
  1246. gctl_error(req, "Command '%s' is not supported.", verb);
  1247. return (-100);
  1248. }
  1249. static int
  1250. g_raid_md_write_jmicron(struct g_raid_md_object *md, struct g_raid_volume *tvol,
  1251. struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
  1252. {
  1253. struct g_raid_softc *sc;
  1254. struct g_raid_volume *vol;
  1255. struct g_raid_subdisk *sd;
  1256. struct g_raid_disk *disk;
  1257. struct g_raid_md_jmicron_object *mdi;
  1258. struct g_raid_md_jmicron_perdisk *pd;
  1259. struct jmicron_raid_conf *meta;
  1260. int i, spares;
  1261. sc = md->mdo_softc;
  1262. mdi = (struct g_raid_md_jmicron_object *)md;
  1263. if (sc->sc_stopping == G_RAID_DESTROY_HARD)
  1264. return (0);
  1265. /* There is only one volume. */
  1266. vol = TAILQ_FIRST(&sc->sc_volumes);
  1267. /* Fill global fields. */
  1268. meta = malloc(sizeof(*meta), M_MD_JMICRON, M_WAITOK | M_ZERO);
  1269. strncpy(meta->signature, JMICRON_MAGIC, 2);
  1270. meta->version = JMICRON_VERSION;
  1271. jmicron_meta_put_name(meta, vol->v_name);
  1272. if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID0)
  1273. meta->type = JMICRON_T_RAID0;
  1274. else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1)
  1275. meta->type = JMICRON_T_RAID1;
  1276. else if (vol->v_raid_level == G_RAID_VOLUME_RL_RAID1E)
  1277. meta->type = JMICRON_T_RAID01;
  1278. else if (vol->v_raid_level == G_RAID_VOLUME_RL_CONCAT ||
  1279. vol->v_raid_level == G_RAID_VOLUME_RL_SINGLE)
  1280. meta->type = JMICRON_T_CONCAT;
  1281. else
  1282. meta->type = JMICRON_T_RAID5;
  1283. meta->stripe_shift = fls(vol->v_strip_size / 2048);
  1284. meta->flags = JMICRON_F_READY | JMICRON_F_BOOTABLE;
  1285. for (i = 0; i < vol->v_disks_count; i++) {
  1286. sd = &vol->v_subdisks[i];
  1287. if (sd->sd_disk == NULL || sd->sd_disk->d_md_data == NULL)
  1288. meta->disks[i] = 0xffffffff;
  1289. else {
  1290. pd = (struct g_raid_md_jmicron_perdisk *)
  1291. sd->sd_disk->d_md_data;
  1292. meta->disks[i] = pd->pd_disk_id;
  1293. }
  1294. if (sd->sd_state < G_RAID_SUBDISK_S_STALE)
  1295. meta->flags |= JMICRON_F_BADSEC;
  1296. if (vol->v_dirty)
  1297. meta->flags |= JMICRON_F_UNSYNC;
  1298. }
  1299. /* Put spares to their slots. */
  1300. spares = 0;
  1301. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  1302. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  1303. if (disk->d_state != G_RAID_DISK_S_SPARE)
  1304. continue;
  1305. meta->spare[spares] = pd->pd_disk_id;
  1306. if (++spares >= 2)
  1307. break;
  1308. }
  1309. /* We are done. Print meta data and store them to disks. */
  1310. if (mdi->mdio_meta != NULL)
  1311. free(mdi->mdio_meta, M_MD_JMICRON);
  1312. mdi->mdio_meta = meta;
  1313. TAILQ_FOREACH(disk, &sc->sc_disks, d_next) {
  1314. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  1315. if (disk->d_state != G_RAID_DISK_S_ACTIVE &&
  1316. disk->d_state != G_RAID_DISK_S_SPARE)
  1317. continue;
  1318. if (pd->pd_meta != NULL) {
  1319. free(pd->pd_meta, M_MD_JMICRON);
  1320. pd->pd_meta = NULL;
  1321. }
  1322. pd->pd_meta = jmicron_meta_copy(meta);
  1323. pd->pd_meta->disk_id = pd->pd_disk_id;
  1324. if ((sd = TAILQ_FIRST(&disk->d_subdisks)) != NULL) {
  1325. pd->pd_meta->offset =
  1326. (sd->sd_offset / 512) / 16;
  1327. pd->pd_meta->disk_sectors_high =
  1328. (sd->sd_size / 512) >> 16;
  1329. pd->pd_meta->disk_sectors_low =
  1330. (sd->sd_size / 512) & 0xffff;
  1331. if (sd->sd_state < G_RAID_SUBDISK_S_STALE)
  1332. pd->pd_meta->flags &= ~JMICRON_F_BADSEC;
  1333. else if (sd->sd_state < G_RAID_SUBDISK_S_ACTIVE)
  1334. pd->pd_meta->flags |= JMICRON_F_UNSYNC;
  1335. }
  1336. G_RAID_DEBUG(1, "Writing JMicron metadata to %s",
  1337. g_raid_get_diskname(disk));
  1338. g_raid_md_jmicron_print(pd->pd_meta);
  1339. jmicron_meta_write(disk->d_consumer, pd->pd_meta);
  1340. }
  1341. return (0);
  1342. }
  1343. static int
  1344. g_raid_md_fail_disk_jmicron(struct g_raid_md_object *md,
  1345. struct g_raid_subdisk *tsd, struct g_raid_disk *tdisk)
  1346. {
  1347. struct g_raid_softc *sc;
  1348. struct g_raid_md_jmicron_perdisk *pd;
  1349. struct g_raid_subdisk *sd;
  1350. sc = md->mdo_softc;
  1351. pd = (struct g_raid_md_jmicron_perdisk *)tdisk->d_md_data;
  1352. /* We can't fail disk that is not a part of array now. */
  1353. if (pd->pd_disk_pos < 0)
  1354. return (-1);
  1355. if (tdisk->d_consumer)
  1356. jmicron_meta_erase(tdisk->d_consumer);
  1357. /* Change states. */
  1358. g_raid_change_disk_state(tdisk, G_RAID_DISK_S_FAILED);
  1359. TAILQ_FOREACH(sd, &tdisk->d_subdisks, sd_next) {
  1360. g_raid_change_subdisk_state(sd,
  1361. G_RAID_SUBDISK_S_FAILED);
  1362. g_raid_event_send(sd, G_RAID_SUBDISK_E_FAILED,
  1363. G_RAID_EVENT_SUBDISK);
  1364. }
  1365. /* Write updated metadata to remaining disks. */
  1366. g_raid_md_write_jmicron(md, NULL, NULL, tdisk);
  1367. /* Check if anything left except placeholders. */
  1368. if (g_raid_ndisks(sc, -1) ==
  1369. g_raid_ndisks(sc, G_RAID_DISK_S_OFFLINE))
  1370. g_raid_destroy_node(sc, 0);
  1371. else
  1372. g_raid_md_jmicron_refill(sc);
  1373. return (0);
  1374. }
  1375. static int
  1376. g_raid_md_free_disk_jmicron(struct g_raid_md_object *md,
  1377. struct g_raid_disk *disk)
  1378. {
  1379. struct g_raid_md_jmicron_perdisk *pd;
  1380. pd = (struct g_raid_md_jmicron_perdisk *)disk->d_md_data;
  1381. if (pd->pd_meta != NULL) {
  1382. free(pd->pd_meta, M_MD_JMICRON);
  1383. pd->pd_meta = NULL;
  1384. }
  1385. free(pd, M_MD_JMICRON);
  1386. disk->d_md_data = NULL;
  1387. return (0);
  1388. }
  1389. static int
  1390. g_raid_md_free_jmicron(struct g_raid_md_object *md)
  1391. {
  1392. struct g_raid_md_jmicron_object *mdi;
  1393. mdi = (struct g_raid_md_jmicron_object *)md;
  1394. if (!mdi->mdio_started) {
  1395. mdi->mdio_started = 0;
  1396. callout_stop(&mdi->mdio_start_co);
  1397. G_RAID_DEBUG1(1, md->mdo_softc,
  1398. "root_mount_rel %p", mdi->mdio_rootmount);
  1399. root_mount_rel(mdi->mdio_rootmount);
  1400. mdi->mdio_rootmount = NULL;
  1401. }
  1402. if (mdi->mdio_meta != NULL) {
  1403. free(mdi->mdio_meta, M_MD_JMICRON);
  1404. mdi->mdio_meta = NULL;
  1405. }
  1406. return (0);
  1407. }
  1408. G_RAID_MD_DECLARE(jmicron, "JMicron");