mworm.c 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285
  1. #include "all.h"
  2. /*
  3. * multiple cat devices
  4. */
  5. void
  6. mcatinit(Device *d)
  7. {
  8. Device *x, **list;
  9. d->cat.ndev = 0;
  10. for(x=d->cat.first; x; x=x->link) {
  11. devinit(x);
  12. d->cat.ndev++;
  13. }
  14. list = malloc(d->cat.ndev*sizeof(Device*));
  15. d->private = list;
  16. for(x=d->cat.first; x; x=x->link) {
  17. *list++ = x;
  18. x->size = devsize(x);
  19. }
  20. }
  21. Devsize
  22. mcatsize(Device *d)
  23. {
  24. Device *x;
  25. Devsize l, m;
  26. l = 0;
  27. for(x=d->cat.first; x; x=x->link) {
  28. m = x->size;
  29. if(m == 0) {
  30. m = devsize(x);
  31. x->size = m;
  32. }
  33. l += m;
  34. }
  35. return l;
  36. }
  37. int
  38. mcatread(Device *d, Off b, void *c)
  39. {
  40. Device *x;
  41. Devsize l, m;
  42. l = 0;
  43. for(x=d->cat.first; x; x=x->link) {
  44. m = x->size;
  45. if(m == 0) {
  46. m = devsize(x);
  47. x->size = m;
  48. }
  49. if(b < l+m)
  50. return devread(x, b-l, c);
  51. l += m;
  52. }
  53. print("mcatread %Z block %lld beyond end %lld\n",
  54. d, (Wideoff)b, (Wideoff)l);
  55. return 1;
  56. }
  57. int
  58. mcatwrite(Device *d, Off b, void *c)
  59. {
  60. Device *x;
  61. Devsize l, m;
  62. l = 0;
  63. for(x=d->cat.first; x; x=x->link) {
  64. m = x->size;
  65. if(m == 0) {
  66. m = devsize(x);
  67. x->size = m;
  68. }
  69. if(b < l+m)
  70. return devwrite(x, b-l, c);
  71. l += m;
  72. }
  73. print("mcatwrite %Z block %lld beyond end %lld\n",
  74. d, (Wideoff)b, (Wideoff)l);
  75. return 1;
  76. }
  77. /*
  78. * multiple interleave devices
  79. */
  80. void
  81. mlevinit(Device *d)
  82. {
  83. Device *x;
  84. mcatinit(d);
  85. for(x=d->cat.first; x; x=x->link)
  86. x->size = devsize(x);
  87. }
  88. Devsize
  89. mlevsize(Device *d)
  90. {
  91. Device *x;
  92. int n;
  93. Devsize m, min;
  94. min = 0;
  95. n = 0;
  96. for(x=d->cat.first; x; x=x->link) {
  97. m = x->size;
  98. if(m == 0) {
  99. m = devsize(x);
  100. x->size = m;
  101. }
  102. if(min == 0 || m < min)
  103. min = m;
  104. n++;
  105. }
  106. return n * min;
  107. }
  108. int
  109. mlevread(Device *d, Off b, void *c)
  110. {
  111. int n;
  112. Device **list;
  113. n = d->cat.ndev;
  114. list = d->private;
  115. return devread(list[b%n], b/n, c);
  116. }
  117. int
  118. mlevwrite(Device *d, Off b, void *c)
  119. {
  120. int n;
  121. Device **list;
  122. n = d->cat.ndev;
  123. list = d->private;
  124. return devwrite(list[b%n], b/n, c);
  125. }
  126. /*
  127. * partition device
  128. */
  129. void
  130. partinit(Device *d)
  131. {
  132. devinit(d->part.d);
  133. d->part.d->size = devsize(d->part.d);
  134. }
  135. Devsize
  136. partsize(Device *d)
  137. {
  138. Devsize size, l;
  139. l = d->part.d->size / 100;
  140. size = d->part.size * l;
  141. if(size == 0)
  142. size = l*100;
  143. return size;
  144. }
  145. int
  146. partread(Device *d, Off b, void *c)
  147. {
  148. Devsize base, size, l;
  149. l = d->part.d->size / 100;
  150. base = d->part.base * l;
  151. size = d->part.size * l;
  152. if(size == 0)
  153. size = l*100;
  154. if(b < size)
  155. return devread(d->part.d, base+b, c);
  156. print("partread %lld %lld\n", (Wideoff)b, (Wideoff)size);
  157. return 1;
  158. }
  159. int
  160. partwrite(Device *d, Off b, void *c)
  161. {
  162. Devsize base, size, l;
  163. l = d->part.d->size / 100;
  164. base = d->part.base * l;
  165. size = d->part.size * l;
  166. if(size == 0)
  167. size = l*100;
  168. if(b < size)
  169. return devwrite(d->part.d, base+b, c);
  170. print("partwrite %lld %lld\n", (Wideoff)b, (Wideoff)size);
  171. return 1;
  172. }
  173. /*
  174. * mirror device
  175. */
  176. void
  177. mirrinit(Device *d)
  178. {
  179. Device *x;
  180. mcatinit(d);
  181. for(x=d->cat.first; x; x=x->link)
  182. x->size = devsize(x);
  183. }
  184. Devsize
  185. mirrsize(Device *d)
  186. {
  187. Device *x;
  188. int n;
  189. Devsize m, min;
  190. min = 0;
  191. n = 0;
  192. for(x=d->cat.first; x; x=x->link) {
  193. m = x->size;
  194. if(m == 0) {
  195. m = devsize(x);
  196. x->size = m;
  197. }
  198. if(min == 0 || m < min)
  199. min = m;
  200. n++;
  201. }
  202. return min;
  203. }
  204. int
  205. mirrread(Device *d, Off b, void *c)
  206. {
  207. Device *x;
  208. for(x=d->cat.first; x; x=x->link) {
  209. if(x->size == 0)
  210. x->size = devsize(x);
  211. if (devread(x, b, c) == 0) /* okay? */
  212. return 0;
  213. }
  214. // DANGER WILL ROBINSON - all copies of this block were bad
  215. print("mirrread %Z error at block %lld\n", d, (Wideoff)b);
  216. return 1;
  217. }
  218. /*
  219. * write the mirror(s) first so that a power outage, for example, will
  220. * find the main device written only if the mirrors are too, thus
  221. * checking the main device will also correctly check the mirror(s).
  222. *
  223. * devread and devwrite are synchronous; all buffering must be
  224. * implemented at higher levels.
  225. */
  226. static int
  227. ewrite(Device *x, Off b, void *c)
  228. {
  229. if(x->size == 0)
  230. x->size = devsize(x);
  231. if (devwrite(x, b, c) != 0) {
  232. print("mirrwrite %Z error at block %lld\n", x, (Wideoff)b);
  233. return 1;
  234. }
  235. return 0;
  236. }
  237. static int
  238. wrmirrs1st(Device *x, Off b, void *c) // write any mirrors of x, then x
  239. {
  240. int e;
  241. if (x == nil)
  242. return 0;
  243. e = wrmirrs1st(x->link, b, c);
  244. return e | ewrite(x, b, c);
  245. }
  246. int
  247. mirrwrite(Device *d, Off b, void *c)
  248. {
  249. return wrmirrs1st(d->cat.first, b, c);
  250. }