mworm.c 4.2 KB

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