ide-tape.c 76 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765
  1. /*
  2. * IDE ATAPI streaming tape driver.
  3. *
  4. * Copyright (C) 1995-1999 Gadi Oxman <gadio@netvision.net.il>
  5. * Copyright (C) 2003-2005 Bartlomiej Zolnierkiewicz
  6. *
  7. * This driver was constructed as a student project in the software laboratory
  8. * of the faculty of electrical engineering in the Technion - Israel's
  9. * Institute Of Technology, with the guide of Avner Lottem and Dr. Ilana David.
  10. *
  11. * It is hereby placed under the terms of the GNU general public license.
  12. * (See linux/COPYING).
  13. *
  14. * For a historical changelog see
  15. * Documentation/ide/ChangeLog.ide-tape.1995-2002
  16. */
  17. #define IDETAPE_VERSION "1.20"
  18. #include <linux/module.h>
  19. #include <linux/types.h>
  20. #include <linux/string.h>
  21. #include <linux/kernel.h>
  22. #include <linux/delay.h>
  23. #include <linux/timer.h>
  24. #include <linux/mm.h>
  25. #include <linux/interrupt.h>
  26. #include <linux/jiffies.h>
  27. #include <linux/major.h>
  28. #include <linux/errno.h>
  29. #include <linux/genhd.h>
  30. #include <linux/slab.h>
  31. #include <linux/pci.h>
  32. #include <linux/ide.h>
  33. #include <linux/smp_lock.h>
  34. #include <linux/completion.h>
  35. #include <linux/bitops.h>
  36. #include <linux/mutex.h>
  37. #include <scsi/scsi.h>
  38. #include <asm/byteorder.h>
  39. #include <linux/irq.h>
  40. #include <linux/uaccess.h>
  41. #include <linux/io.h>
  42. #include <asm/unaligned.h>
  43. #include <linux/mtio.h>
  44. enum {
  45. /* output errors only */
  46. DBG_ERR = (1 << 0),
  47. /* output all sense key/asc */
  48. DBG_SENSE = (1 << 1),
  49. /* info regarding all chrdev-related procedures */
  50. DBG_CHRDEV = (1 << 2),
  51. /* all remaining procedures */
  52. DBG_PROCS = (1 << 3),
  53. /* buffer alloc info (pc_stack & rq_stack) */
  54. DBG_PCRQ_STACK = (1 << 4),
  55. };
  56. /* define to see debug info */
  57. #define IDETAPE_DEBUG_LOG 0
  58. #if IDETAPE_DEBUG_LOG
  59. #define debug_log(lvl, fmt, args...) \
  60. { \
  61. if (tape->debug_mask & lvl) \
  62. printk(KERN_INFO "ide-tape: " fmt, ## args); \
  63. }
  64. #else
  65. #define debug_log(lvl, fmt, args...) do {} while (0)
  66. #endif
  67. /**************************** Tunable parameters *****************************/
  68. /*
  69. * After each failed packet command we issue a request sense command and retry
  70. * the packet command IDETAPE_MAX_PC_RETRIES times.
  71. *
  72. * Setting IDETAPE_MAX_PC_RETRIES to 0 will disable retries.
  73. */
  74. #define IDETAPE_MAX_PC_RETRIES 3
  75. /*
  76. * With each packet command, we allocate a buffer of IDETAPE_PC_BUFFER_SIZE
  77. * bytes. This is used for several packet commands (Not for READ/WRITE commands)
  78. */
  79. #define IDETAPE_PC_BUFFER_SIZE 256
  80. /*
  81. * In various places in the driver, we need to allocate storage
  82. * for packet commands and requests, which will remain valid while
  83. * we leave the driver to wait for an interrupt or a timeout event.
  84. */
  85. #define IDETAPE_PC_STACK (10 + IDETAPE_MAX_PC_RETRIES)
  86. /*
  87. * Some drives (for example, Seagate STT3401A Travan) require a very long
  88. * timeout, because they don't return an interrupt or clear their busy bit
  89. * until after the command completes (even retension commands).
  90. */
  91. #define IDETAPE_WAIT_CMD (900*HZ)
  92. /*
  93. * The following parameter is used to select the point in the internal tape fifo
  94. * in which we will start to refill the buffer. Decreasing the following
  95. * parameter will improve the system's latency and interactive response, while
  96. * using a high value might improve system throughput.
  97. */
  98. #define IDETAPE_FIFO_THRESHOLD 2
  99. /*
  100. * DSC polling parameters.
  101. *
  102. * Polling for DSC (a single bit in the status register) is a very important
  103. * function in ide-tape. There are two cases in which we poll for DSC:
  104. *
  105. * 1. Before a read/write packet command, to ensure that we can transfer data
  106. * from/to the tape's data buffers, without causing an actual media access.
  107. * In case the tape is not ready yet, we take out our request from the device
  108. * request queue, so that ide.c could service requests from the other device
  109. * on the same interface in the meantime.
  110. *
  111. * 2. After the successful initialization of a "media access packet command",
  112. * which is a command that can take a long time to complete (the interval can
  113. * range from several seconds to even an hour). Again, we postpone our request
  114. * in the middle to free the bus for the other device. The polling frequency
  115. * here should be lower than the read/write frequency since those media access
  116. * commands are slow. We start from a "fast" frequency - IDETAPE_DSC_MA_FAST
  117. * (1 second), and if we don't receive DSC after IDETAPE_DSC_MA_THRESHOLD
  118. * (5 min), we switch it to a lower frequency - IDETAPE_DSC_MA_SLOW (1 min).
  119. *
  120. * We also set a timeout for the timer, in case something goes wrong. The
  121. * timeout should be longer then the maximum execution time of a tape operation.
  122. */
  123. /* DSC timings. */
  124. #define IDETAPE_DSC_RW_MIN 5*HZ/100 /* 50 msec */
  125. #define IDETAPE_DSC_RW_MAX 40*HZ/100 /* 400 msec */
  126. #define IDETAPE_DSC_RW_TIMEOUT 2*60*HZ /* 2 minutes */
  127. #define IDETAPE_DSC_MA_FAST 2*HZ /* 2 seconds */
  128. #define IDETAPE_DSC_MA_THRESHOLD 5*60*HZ /* 5 minutes */
  129. #define IDETAPE_DSC_MA_SLOW 30*HZ /* 30 seconds */
  130. #define IDETAPE_DSC_MA_TIMEOUT 2*60*60*HZ /* 2 hours */
  131. /*************************** End of tunable parameters ***********************/
  132. /* tape directions */
  133. enum {
  134. IDETAPE_DIR_NONE = (1 << 0),
  135. IDETAPE_DIR_READ = (1 << 1),
  136. IDETAPE_DIR_WRITE = (1 << 2),
  137. };
  138. struct idetape_bh {
  139. u32 b_size;
  140. atomic_t b_count;
  141. struct idetape_bh *b_reqnext;
  142. char *b_data;
  143. };
  144. /* Tape door status */
  145. #define DOOR_UNLOCKED 0
  146. #define DOOR_LOCKED 1
  147. #define DOOR_EXPLICITLY_LOCKED 2
  148. /* Some defines for the SPACE command */
  149. #define IDETAPE_SPACE_OVER_FILEMARK 1
  150. #define IDETAPE_SPACE_TO_EOD 3
  151. /* Some defines for the LOAD UNLOAD command */
  152. #define IDETAPE_LU_LOAD_MASK 1
  153. #define IDETAPE_LU_RETENSION_MASK 2
  154. #define IDETAPE_LU_EOT_MASK 4
  155. /*
  156. * Special requests for our block device strategy routine.
  157. *
  158. * In order to service a character device command, we add special requests to
  159. * the tail of our block device request queue and wait for their completion.
  160. */
  161. enum {
  162. REQ_IDETAPE_PC1 = (1 << 0), /* packet command (first stage) */
  163. REQ_IDETAPE_PC2 = (1 << 1), /* packet command (second stage) */
  164. REQ_IDETAPE_READ = (1 << 2),
  165. REQ_IDETAPE_WRITE = (1 << 3),
  166. };
  167. /* Error codes returned in rq->errors to the higher part of the driver. */
  168. #define IDETAPE_ERROR_GENERAL 101
  169. #define IDETAPE_ERROR_FILEMARK 102
  170. #define IDETAPE_ERROR_EOD 103
  171. /* Structures related to the SELECT SENSE / MODE SENSE packet commands. */
  172. #define IDETAPE_BLOCK_DESCRIPTOR 0
  173. #define IDETAPE_CAPABILITIES_PAGE 0x2a
  174. /* Tape flag bits values. */
  175. enum {
  176. IDETAPE_FLAG_IGNORE_DSC = (1 << 0),
  177. /* 0 When the tape position is unknown */
  178. IDETAPE_FLAG_ADDRESS_VALID = (1 << 1),
  179. /* Device already opened */
  180. IDETAPE_FLAG_BUSY = (1 << 2),
  181. /* Attempt to auto-detect the current user block size */
  182. IDETAPE_FLAG_DETECT_BS = (1 << 3),
  183. /* Currently on a filemark */
  184. IDETAPE_FLAG_FILEMARK = (1 << 4),
  185. /* DRQ interrupt device */
  186. IDETAPE_FLAG_DRQ_INTERRUPT = (1 << 5),
  187. /* 0 = no tape is loaded, so we don't rewind after ejecting */
  188. IDETAPE_FLAG_MEDIUM_PRESENT = (1 << 6),
  189. };
  190. /*
  191. * Most of our global data which we need to save even as we leave the driver due
  192. * to an interrupt or a timer event is stored in the struct defined below.
  193. */
  194. typedef struct ide_tape_obj {
  195. ide_drive_t *drive;
  196. ide_driver_t *driver;
  197. struct gendisk *disk;
  198. struct kref kref;
  199. /*
  200. * Since a typical character device operation requires more
  201. * than one packet command, we provide here enough memory
  202. * for the maximum of interconnected packet commands.
  203. * The packet commands are stored in the circular array pc_stack.
  204. * pc_stack_index points to the last used entry, and warps around
  205. * to the start when we get to the last array entry.
  206. *
  207. * pc points to the current processed packet command.
  208. *
  209. * failed_pc points to the last failed packet command, or contains
  210. * NULL if we do not need to retry any packet command. This is
  211. * required since an additional packet command is needed before the
  212. * retry, to get detailed information on what went wrong.
  213. */
  214. /* Current packet command */
  215. struct ide_atapi_pc *pc;
  216. /* Last failed packet command */
  217. struct ide_atapi_pc *failed_pc;
  218. /* Packet command stack */
  219. struct ide_atapi_pc pc_stack[IDETAPE_PC_STACK];
  220. /* Next free packet command storage space */
  221. int pc_stack_index;
  222. struct request rq_stack[IDETAPE_PC_STACK];
  223. /* We implement a circular array */
  224. int rq_stack_index;
  225. /*
  226. * DSC polling variables.
  227. *
  228. * While polling for DSC we use postponed_rq to postpone the current
  229. * request so that ide.c will be able to service pending requests on the
  230. * other device. Note that at most we will have only one DSC (usually
  231. * data transfer) request in the device request queue.
  232. */
  233. struct request *postponed_rq;
  234. /* The time in which we started polling for DSC */
  235. unsigned long dsc_polling_start;
  236. /* Timer used to poll for dsc */
  237. struct timer_list dsc_timer;
  238. /* Read/Write dsc polling frequency */
  239. unsigned long best_dsc_rw_freq;
  240. unsigned long dsc_poll_freq;
  241. unsigned long dsc_timeout;
  242. /* Read position information */
  243. u8 partition;
  244. /* Current block */
  245. unsigned int first_frame;
  246. /* Last error information */
  247. u8 sense_key, asc, ascq;
  248. /* Character device operation */
  249. unsigned int minor;
  250. /* device name */
  251. char name[4];
  252. /* Current character device data transfer direction */
  253. u8 chrdev_dir;
  254. /* tape block size, usually 512 or 1024 bytes */
  255. unsigned short blk_size;
  256. int user_bs_factor;
  257. /* Copy of the tape's Capabilities and Mechanical Page */
  258. u8 caps[20];
  259. /*
  260. * Active data transfer request parameters.
  261. *
  262. * At most, there is only one ide-tape originated data transfer request
  263. * in the device request queue. This allows ide.c to easily service
  264. * requests from the other device when we postpone our active request.
  265. */
  266. /* Data buffer size chosen based on the tape's recommendation */
  267. int buffer_size;
  268. /* merge buffer */
  269. struct idetape_bh *merge_bh;
  270. /* size of the merge buffer */
  271. int merge_bh_size;
  272. /* pointer to current buffer head within the merge buffer */
  273. struct idetape_bh *bh;
  274. char *b_data;
  275. int b_count;
  276. int pages_per_buffer;
  277. /* Wasted space in each stage */
  278. int excess_bh_size;
  279. /* Status/Action flags: long for set_bit */
  280. unsigned long flags;
  281. /* protects the ide-tape queue */
  282. spinlock_t lock;
  283. /* Measures average tape speed */
  284. unsigned long avg_time;
  285. int avg_size;
  286. int avg_speed;
  287. /* the door is currently locked */
  288. int door_locked;
  289. /* the tape hardware is write protected */
  290. char drv_write_prot;
  291. /* the tape is write protected (hardware or opened as read-only) */
  292. char write_prot;
  293. u32 debug_mask;
  294. } idetape_tape_t;
  295. static DEFINE_MUTEX(idetape_ref_mutex);
  296. static struct class *idetape_sysfs_class;
  297. #define to_ide_tape(obj) container_of(obj, struct ide_tape_obj, kref)
  298. #define ide_tape_g(disk) \
  299. container_of((disk)->private_data, struct ide_tape_obj, driver)
  300. static struct ide_tape_obj *ide_tape_get(struct gendisk *disk)
  301. {
  302. struct ide_tape_obj *tape = NULL;
  303. mutex_lock(&idetape_ref_mutex);
  304. tape = ide_tape_g(disk);
  305. if (tape)
  306. kref_get(&tape->kref);
  307. mutex_unlock(&idetape_ref_mutex);
  308. return tape;
  309. }
  310. static void ide_tape_release(struct kref *);
  311. static void ide_tape_put(struct ide_tape_obj *tape)
  312. {
  313. mutex_lock(&idetape_ref_mutex);
  314. kref_put(&tape->kref, ide_tape_release);
  315. mutex_unlock(&idetape_ref_mutex);
  316. }
  317. /*
  318. * The variables below are used for the character device interface. Additional
  319. * state variables are defined in our ide_drive_t structure.
  320. */
  321. static struct ide_tape_obj *idetape_devs[MAX_HWIFS * MAX_DRIVES];
  322. #define ide_tape_f(file) ((file)->private_data)
  323. static struct ide_tape_obj *ide_tape_chrdev_get(unsigned int i)
  324. {
  325. struct ide_tape_obj *tape = NULL;
  326. mutex_lock(&idetape_ref_mutex);
  327. tape = idetape_devs[i];
  328. if (tape)
  329. kref_get(&tape->kref);
  330. mutex_unlock(&idetape_ref_mutex);
  331. return tape;
  332. }
  333. static void idetape_input_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
  334. unsigned int bcount)
  335. {
  336. struct idetape_bh *bh = pc->bh;
  337. int count;
  338. while (bcount) {
  339. if (bh == NULL) {
  340. printk(KERN_ERR "ide-tape: bh == NULL in "
  341. "idetape_input_buffers\n");
  342. ide_pad_transfer(drive, 0, bcount);
  343. return;
  344. }
  345. count = min(
  346. (unsigned int)(bh->b_size - atomic_read(&bh->b_count)),
  347. bcount);
  348. drive->hwif->input_data(drive, NULL, bh->b_data +
  349. atomic_read(&bh->b_count), count);
  350. bcount -= count;
  351. atomic_add(count, &bh->b_count);
  352. if (atomic_read(&bh->b_count) == bh->b_size) {
  353. bh = bh->b_reqnext;
  354. if (bh)
  355. atomic_set(&bh->b_count, 0);
  356. }
  357. }
  358. pc->bh = bh;
  359. }
  360. static void idetape_output_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
  361. unsigned int bcount)
  362. {
  363. struct idetape_bh *bh = pc->bh;
  364. int count;
  365. while (bcount) {
  366. if (bh == NULL) {
  367. printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
  368. __func__);
  369. return;
  370. }
  371. count = min((unsigned int)pc->b_count, (unsigned int)bcount);
  372. drive->hwif->output_data(drive, NULL, pc->b_data, count);
  373. bcount -= count;
  374. pc->b_data += count;
  375. pc->b_count -= count;
  376. if (!pc->b_count) {
  377. bh = bh->b_reqnext;
  378. pc->bh = bh;
  379. if (bh) {
  380. pc->b_data = bh->b_data;
  381. pc->b_count = atomic_read(&bh->b_count);
  382. }
  383. }
  384. }
  385. }
  386. static void idetape_update_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc)
  387. {
  388. struct idetape_bh *bh = pc->bh;
  389. int count;
  390. unsigned int bcount = pc->xferred;
  391. if (pc->flags & PC_FLAG_WRITING)
  392. return;
  393. while (bcount) {
  394. if (bh == NULL) {
  395. printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
  396. __func__);
  397. return;
  398. }
  399. count = min((unsigned int)bh->b_size, (unsigned int)bcount);
  400. atomic_set(&bh->b_count, count);
  401. if (atomic_read(&bh->b_count) == bh->b_size)
  402. bh = bh->b_reqnext;
  403. bcount -= count;
  404. }
  405. pc->bh = bh;
  406. }
  407. /*
  408. * idetape_next_pc_storage returns a pointer to a place in which we can
  409. * safely store a packet command, even though we intend to leave the
  410. * driver. A storage space for a maximum of IDETAPE_PC_STACK packet
  411. * commands is allocated at initialization time.
  412. */
  413. static struct ide_atapi_pc *idetape_next_pc_storage(ide_drive_t *drive)
  414. {
  415. idetape_tape_t *tape = drive->driver_data;
  416. debug_log(DBG_PCRQ_STACK, "pc_stack_index=%d\n", tape->pc_stack_index);
  417. if (tape->pc_stack_index == IDETAPE_PC_STACK)
  418. tape->pc_stack_index = 0;
  419. return (&tape->pc_stack[tape->pc_stack_index++]);
  420. }
  421. /*
  422. * idetape_next_rq_storage is used along with idetape_next_pc_storage.
  423. * Since we queue packet commands in the request queue, we need to
  424. * allocate a request, along with the allocation of a packet command.
  425. */
  426. /**************************************************************
  427. * *
  428. * This should get fixed to use kmalloc(.., GFP_ATOMIC) *
  429. * followed later on by kfree(). -ml *
  430. * *
  431. **************************************************************/
  432. static struct request *idetape_next_rq_storage(ide_drive_t *drive)
  433. {
  434. idetape_tape_t *tape = drive->driver_data;
  435. debug_log(DBG_PCRQ_STACK, "rq_stack_index=%d\n", tape->rq_stack_index);
  436. if (tape->rq_stack_index == IDETAPE_PC_STACK)
  437. tape->rq_stack_index = 0;
  438. return (&tape->rq_stack[tape->rq_stack_index++]);
  439. }
  440. /*
  441. * called on each failed packet command retry to analyze the request sense. We
  442. * currently do not utilize this information.
  443. */
  444. static void idetape_analyze_error(ide_drive_t *drive, u8 *sense)
  445. {
  446. idetape_tape_t *tape = drive->driver_data;
  447. struct ide_atapi_pc *pc = tape->failed_pc;
  448. tape->sense_key = sense[2] & 0xF;
  449. tape->asc = sense[12];
  450. tape->ascq = sense[13];
  451. debug_log(DBG_ERR, "pc = %x, sense key = %x, asc = %x, ascq = %x\n",
  452. pc->c[0], tape->sense_key, tape->asc, tape->ascq);
  453. /* Correct pc->xferred by asking the tape. */
  454. if (pc->flags & PC_FLAG_DMA_ERROR) {
  455. pc->xferred = pc->req_xfer -
  456. tape->blk_size *
  457. get_unaligned_be32(&sense[3]);
  458. idetape_update_buffers(drive, pc);
  459. }
  460. /*
  461. * If error was the result of a zero-length read or write command,
  462. * with sense key=5, asc=0x22, ascq=0, let it slide. Some drives
  463. * (i.e. Seagate STT3401A Travan) don't support 0-length read/writes.
  464. */
  465. if ((pc->c[0] == READ_6 || pc->c[0] == WRITE_6)
  466. /* length == 0 */
  467. && pc->c[4] == 0 && pc->c[3] == 0 && pc->c[2] == 0) {
  468. if (tape->sense_key == 5) {
  469. /* don't report an error, everything's ok */
  470. pc->error = 0;
  471. /* don't retry read/write */
  472. pc->flags |= PC_FLAG_ABORT;
  473. }
  474. }
  475. if (pc->c[0] == READ_6 && (sense[2] & 0x80)) {
  476. pc->error = IDETAPE_ERROR_FILEMARK;
  477. pc->flags |= PC_FLAG_ABORT;
  478. }
  479. if (pc->c[0] == WRITE_6) {
  480. if ((sense[2] & 0x40) || (tape->sense_key == 0xd
  481. && tape->asc == 0x0 && tape->ascq == 0x2)) {
  482. pc->error = IDETAPE_ERROR_EOD;
  483. pc->flags |= PC_FLAG_ABORT;
  484. }
  485. }
  486. if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
  487. if (tape->sense_key == 8) {
  488. pc->error = IDETAPE_ERROR_EOD;
  489. pc->flags |= PC_FLAG_ABORT;
  490. }
  491. if (!(pc->flags & PC_FLAG_ABORT) &&
  492. pc->xferred)
  493. pc->retries = IDETAPE_MAX_PC_RETRIES + 1;
  494. }
  495. }
  496. /* Free data buffers completely. */
  497. static void ide_tape_kfree_buffer(idetape_tape_t *tape)
  498. {
  499. struct idetape_bh *prev_bh, *bh = tape->merge_bh;
  500. while (bh) {
  501. u32 size = bh->b_size;
  502. while (size) {
  503. unsigned int order = fls(size >> PAGE_SHIFT)-1;
  504. if (bh->b_data)
  505. free_pages((unsigned long)bh->b_data, order);
  506. size &= (order-1);
  507. bh->b_data += (1 << order) * PAGE_SIZE;
  508. }
  509. prev_bh = bh;
  510. bh = bh->b_reqnext;
  511. kfree(prev_bh);
  512. }
  513. kfree(tape->merge_bh);
  514. }
  515. static int idetape_end_request(ide_drive_t *drive, int uptodate, int nr_sects)
  516. {
  517. struct request *rq = HWGROUP(drive)->rq;
  518. idetape_tape_t *tape = drive->driver_data;
  519. unsigned long flags;
  520. int error;
  521. debug_log(DBG_PROCS, "Enter %s\n", __func__);
  522. switch (uptodate) {
  523. case 0: error = IDETAPE_ERROR_GENERAL; break;
  524. case 1: error = 0; break;
  525. default: error = uptodate;
  526. }
  527. rq->errors = error;
  528. if (error)
  529. tape->failed_pc = NULL;
  530. if (!blk_special_request(rq)) {
  531. ide_end_request(drive, uptodate, nr_sects);
  532. return 0;
  533. }
  534. spin_lock_irqsave(&tape->lock, flags);
  535. ide_end_drive_cmd(drive, 0, 0);
  536. spin_unlock_irqrestore(&tape->lock, flags);
  537. return 0;
  538. }
  539. static void ide_tape_callback(ide_drive_t *drive)
  540. {
  541. idetape_tape_t *tape = drive->driver_data;
  542. struct ide_atapi_pc *pc = tape->pc;
  543. int uptodate = pc->error ? 0 : 1;
  544. debug_log(DBG_PROCS, "Enter %s\n", __func__);
  545. if (tape->failed_pc == pc)
  546. tape->failed_pc = NULL;
  547. if (pc->c[0] == REQUEST_SENSE) {
  548. if (uptodate)
  549. idetape_analyze_error(drive, pc->buf);
  550. else
  551. printk(KERN_ERR "ide-tape: Error in REQUEST SENSE "
  552. "itself - Aborting request!\n");
  553. } else if (pc->c[0] == READ_6 || pc->c[0] == WRITE_6) {
  554. struct request *rq = drive->hwif->hwgroup->rq;
  555. int blocks = pc->xferred / tape->blk_size;
  556. tape->avg_size += blocks * tape->blk_size;
  557. if (time_after_eq(jiffies, tape->avg_time + HZ)) {
  558. tape->avg_speed = tape->avg_size * HZ /
  559. (jiffies - tape->avg_time) / 1024;
  560. tape->avg_size = 0;
  561. tape->avg_time = jiffies;
  562. }
  563. tape->first_frame += blocks;
  564. rq->current_nr_sectors -= blocks;
  565. if (pc->error)
  566. uptodate = pc->error;
  567. } else if (pc->c[0] == READ_POSITION && uptodate) {
  568. u8 *readpos = tape->pc->buf;
  569. debug_log(DBG_SENSE, "BOP - %s\n",
  570. (readpos[0] & 0x80) ? "Yes" : "No");
  571. debug_log(DBG_SENSE, "EOP - %s\n",
  572. (readpos[0] & 0x40) ? "Yes" : "No");
  573. if (readpos[0] & 0x4) {
  574. printk(KERN_INFO "ide-tape: Block location is unknown"
  575. "to the tape\n");
  576. clear_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
  577. uptodate = 0;
  578. } else {
  579. debug_log(DBG_SENSE, "Block Location - %u\n",
  580. be32_to_cpu(*(u32 *)&readpos[4]));
  581. tape->partition = readpos[1];
  582. tape->first_frame = be32_to_cpu(*(u32 *)&readpos[4]);
  583. set_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags);
  584. }
  585. }
  586. idetape_end_request(drive, uptodate, 0);
  587. }
  588. static void idetape_init_pc(struct ide_atapi_pc *pc)
  589. {
  590. memset(pc->c, 0, 12);
  591. pc->retries = 0;
  592. pc->flags = 0;
  593. pc->req_xfer = 0;
  594. pc->buf = pc->pc_buf;
  595. pc->buf_size = IDETAPE_PC_BUFFER_SIZE;
  596. pc->bh = NULL;
  597. pc->b_data = NULL;
  598. pc->callback = ide_tape_callback;
  599. }
  600. static void idetape_create_request_sense_cmd(struct ide_atapi_pc *pc)
  601. {
  602. idetape_init_pc(pc);
  603. pc->c[0] = REQUEST_SENSE;
  604. pc->c[4] = 20;
  605. pc->req_xfer = 20;
  606. }
  607. static void idetape_init_rq(struct request *rq, u8 cmd)
  608. {
  609. blk_rq_init(NULL, rq);
  610. rq->cmd_type = REQ_TYPE_SPECIAL;
  611. rq->cmd[0] = cmd;
  612. }
  613. /*
  614. * Generate a new packet command request in front of the request queue, before
  615. * the current request, so that it will be processed immediately, on the next
  616. * pass through the driver. The function below is called from the request
  617. * handling part of the driver (the "bottom" part). Safe storage for the request
  618. * should be allocated with ide_tape_next_{pc,rq}_storage() prior to that.
  619. *
  620. * Memory for those requests is pre-allocated at initialization time, and is
  621. * limited to IDETAPE_PC_STACK requests. We assume that we have enough space for
  622. * the maximum possible number of inter-dependent packet commands.
  623. *
  624. * The higher level of the driver - The ioctl handler and the character device
  625. * handling functions should queue request to the lower level part and wait for
  626. * their completion using idetape_queue_pc_tail or idetape_queue_rw_tail.
  627. */
  628. static void idetape_queue_pc_head(ide_drive_t *drive, struct ide_atapi_pc *pc,
  629. struct request *rq)
  630. {
  631. struct ide_tape_obj *tape = drive->driver_data;
  632. idetape_init_rq(rq, REQ_IDETAPE_PC1);
  633. rq->cmd_flags |= REQ_PREEMPT;
  634. rq->buffer = (char *) pc;
  635. rq->rq_disk = tape->disk;
  636. ide_do_drive_cmd(drive, rq);
  637. }
  638. /*
  639. * idetape_retry_pc is called when an error was detected during the
  640. * last packet command. We queue a request sense packet command in
  641. * the head of the request list.
  642. */
  643. static void idetape_retry_pc(ide_drive_t *drive)
  644. {
  645. idetape_tape_t *tape = drive->driver_data;
  646. struct ide_atapi_pc *pc;
  647. struct request *rq;
  648. (void)ide_read_error(drive);
  649. pc = idetape_next_pc_storage(drive);
  650. rq = idetape_next_rq_storage(drive);
  651. idetape_create_request_sense_cmd(pc);
  652. set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
  653. idetape_queue_pc_head(drive, pc, rq);
  654. }
  655. /*
  656. * Postpone the current request so that ide.c will be able to service requests
  657. * from another device on the same hwgroup while we are polling for DSC.
  658. */
  659. static void idetape_postpone_request(ide_drive_t *drive)
  660. {
  661. idetape_tape_t *tape = drive->driver_data;
  662. debug_log(DBG_PROCS, "Enter %s\n", __func__);
  663. tape->postponed_rq = HWGROUP(drive)->rq;
  664. ide_stall_queue(drive, tape->dsc_poll_freq);
  665. }
  666. static void ide_tape_handle_dsc(ide_drive_t *drive)
  667. {
  668. idetape_tape_t *tape = drive->driver_data;
  669. /* Media access command */
  670. tape->dsc_polling_start = jiffies;
  671. tape->dsc_poll_freq = IDETAPE_DSC_MA_FAST;
  672. tape->dsc_timeout = jiffies + IDETAPE_DSC_MA_TIMEOUT;
  673. /* Allow ide.c to handle other requests */
  674. idetape_postpone_request(drive);
  675. }
  676. static void ide_tape_io_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
  677. unsigned int bcount, int write)
  678. {
  679. if (write)
  680. idetape_output_buffers(drive, pc, bcount);
  681. else
  682. idetape_input_buffers(drive, pc, bcount);
  683. }
  684. /*
  685. * This is the usual interrupt handler which will be called during a packet
  686. * command. We will transfer some of the data (as requested by the drive) and
  687. * will re-point interrupt handler to us. When data transfer is finished, we
  688. * will act according to the algorithm described before
  689. * idetape_issue_pc.
  690. */
  691. static ide_startstop_t idetape_pc_intr(ide_drive_t *drive)
  692. {
  693. idetape_tape_t *tape = drive->driver_data;
  694. return ide_pc_intr(drive, tape->pc, idetape_pc_intr, IDETAPE_WAIT_CMD,
  695. NULL, idetape_update_buffers, idetape_retry_pc,
  696. ide_tape_handle_dsc, ide_tape_io_buffers);
  697. }
  698. /*
  699. * Packet Command Interface
  700. *
  701. * The current Packet Command is available in tape->pc, and will not change
  702. * until we finish handling it. Each packet command is associated with a
  703. * callback function that will be called when the command is finished.
  704. *
  705. * The handling will be done in three stages:
  706. *
  707. * 1. idetape_issue_pc will send the packet command to the drive, and will set
  708. * the interrupt handler to idetape_pc_intr.
  709. *
  710. * 2. On each interrupt, idetape_pc_intr will be called. This step will be
  711. * repeated until the device signals us that no more interrupts will be issued.
  712. *
  713. * 3. ATAPI Tape media access commands have immediate status with a delayed
  714. * process. In case of a successful initiation of a media access packet command,
  715. * the DSC bit will be set when the actual execution of the command is finished.
  716. * Since the tape drive will not issue an interrupt, we have to poll for this
  717. * event. In this case, we define the request as "low priority request" by
  718. * setting rq_status to IDETAPE_RQ_POSTPONED, set a timer to poll for DSC and
  719. * exit the driver.
  720. *
  721. * ide.c will then give higher priority to requests which originate from the
  722. * other device, until will change rq_status to RQ_ACTIVE.
  723. *
  724. * 4. When the packet command is finished, it will be checked for errors.
  725. *
  726. * 5. In case an error was found, we queue a request sense packet command in
  727. * front of the request queue and retry the operation up to
  728. * IDETAPE_MAX_PC_RETRIES times.
  729. *
  730. * 6. In case no error was found, or we decided to give up and not to retry
  731. * again, the callback function will be called and then we will handle the next
  732. * request.
  733. */
  734. static ide_startstop_t idetape_transfer_pc(ide_drive_t *drive)
  735. {
  736. idetape_tape_t *tape = drive->driver_data;
  737. return ide_transfer_pc(drive, tape->pc, idetape_pc_intr,
  738. IDETAPE_WAIT_CMD, NULL);
  739. }
  740. static ide_startstop_t idetape_issue_pc(ide_drive_t *drive,
  741. struct ide_atapi_pc *pc)
  742. {
  743. idetape_tape_t *tape = drive->driver_data;
  744. if (tape->pc->c[0] == REQUEST_SENSE &&
  745. pc->c[0] == REQUEST_SENSE) {
  746. printk(KERN_ERR "ide-tape: possible ide-tape.c bug - "
  747. "Two request sense in serial were issued\n");
  748. }
  749. if (tape->failed_pc == NULL && pc->c[0] != REQUEST_SENSE)
  750. tape->failed_pc = pc;
  751. /* Set the current packet command */
  752. tape->pc = pc;
  753. if (pc->retries > IDETAPE_MAX_PC_RETRIES ||
  754. (pc->flags & PC_FLAG_ABORT)) {
  755. /*
  756. * We will "abort" retrying a packet command in case legitimate
  757. * error code was received (crossing a filemark, or end of the
  758. * media, for example).
  759. */
  760. if (!(pc->flags & PC_FLAG_ABORT)) {
  761. if (!(pc->c[0] == TEST_UNIT_READY &&
  762. tape->sense_key == 2 && tape->asc == 4 &&
  763. (tape->ascq == 1 || tape->ascq == 8))) {
  764. printk(KERN_ERR "ide-tape: %s: I/O error, "
  765. "pc = %2x, key = %2x, "
  766. "asc = %2x, ascq = %2x\n",
  767. tape->name, pc->c[0],
  768. tape->sense_key, tape->asc,
  769. tape->ascq);
  770. }
  771. /* Giving up */
  772. pc->error = IDETAPE_ERROR_GENERAL;
  773. }
  774. tape->failed_pc = NULL;
  775. pc->callback(drive);
  776. return ide_stopped;
  777. }
  778. debug_log(DBG_SENSE, "Retry #%d, cmd = %02X\n", pc->retries, pc->c[0]);
  779. pc->retries++;
  780. return ide_issue_pc(drive, pc, idetape_transfer_pc,
  781. IDETAPE_WAIT_CMD, NULL);
  782. }
  783. /* A mode sense command is used to "sense" tape parameters. */
  784. static void idetape_create_mode_sense_cmd(struct ide_atapi_pc *pc, u8 page_code)
  785. {
  786. idetape_init_pc(pc);
  787. pc->c[0] = MODE_SENSE;
  788. if (page_code != IDETAPE_BLOCK_DESCRIPTOR)
  789. /* DBD = 1 - Don't return block descriptors */
  790. pc->c[1] = 8;
  791. pc->c[2] = page_code;
  792. /*
  793. * Changed pc->c[3] to 0 (255 will at best return unused info).
  794. *
  795. * For SCSI this byte is defined as subpage instead of high byte
  796. * of length and some IDE drives seem to interpret it this way
  797. * and return an error when 255 is used.
  798. */
  799. pc->c[3] = 0;
  800. /* We will just discard data in that case */
  801. pc->c[4] = 255;
  802. if (page_code == IDETAPE_BLOCK_DESCRIPTOR)
  803. pc->req_xfer = 12;
  804. else if (page_code == IDETAPE_CAPABILITIES_PAGE)
  805. pc->req_xfer = 24;
  806. else
  807. pc->req_xfer = 50;
  808. }
  809. static ide_startstop_t idetape_media_access_finished(ide_drive_t *drive)
  810. {
  811. idetape_tape_t *tape = drive->driver_data;
  812. struct ide_atapi_pc *pc = tape->pc;
  813. u8 stat;
  814. stat = ide_read_status(drive);
  815. if (stat & SEEK_STAT) {
  816. if (stat & ERR_STAT) {
  817. /* Error detected */
  818. if (pc->c[0] != TEST_UNIT_READY)
  819. printk(KERN_ERR "ide-tape: %s: I/O error, ",
  820. tape->name);
  821. /* Retry operation */
  822. idetape_retry_pc(drive);
  823. return ide_stopped;
  824. }
  825. pc->error = 0;
  826. } else {
  827. pc->error = IDETAPE_ERROR_GENERAL;
  828. tape->failed_pc = NULL;
  829. }
  830. pc->callback(drive);
  831. return ide_stopped;
  832. }
  833. static void idetape_create_read_cmd(idetape_tape_t *tape,
  834. struct ide_atapi_pc *pc,
  835. unsigned int length, struct idetape_bh *bh)
  836. {
  837. idetape_init_pc(pc);
  838. pc->c[0] = READ_6;
  839. put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
  840. pc->c[1] = 1;
  841. pc->bh = bh;
  842. atomic_set(&bh->b_count, 0);
  843. pc->buf = NULL;
  844. pc->buf_size = length * tape->blk_size;
  845. pc->req_xfer = pc->buf_size;
  846. if (pc->req_xfer == tape->buffer_size)
  847. pc->flags |= PC_FLAG_DMA_OK;
  848. }
  849. static void idetape_create_write_cmd(idetape_tape_t *tape,
  850. struct ide_atapi_pc *pc,
  851. unsigned int length, struct idetape_bh *bh)
  852. {
  853. idetape_init_pc(pc);
  854. pc->c[0] = WRITE_6;
  855. put_unaligned(cpu_to_be32(length), (unsigned int *) &pc->c[1]);
  856. pc->c[1] = 1;
  857. pc->flags |= PC_FLAG_WRITING;
  858. pc->bh = bh;
  859. pc->b_data = bh->b_data;
  860. pc->b_count = atomic_read(&bh->b_count);
  861. pc->buf = NULL;
  862. pc->buf_size = length * tape->blk_size;
  863. pc->req_xfer = pc->buf_size;
  864. if (pc->req_xfer == tape->buffer_size)
  865. pc->flags |= PC_FLAG_DMA_OK;
  866. }
  867. static ide_startstop_t idetape_do_request(ide_drive_t *drive,
  868. struct request *rq, sector_t block)
  869. {
  870. idetape_tape_t *tape = drive->driver_data;
  871. struct ide_atapi_pc *pc = NULL;
  872. struct request *postponed_rq = tape->postponed_rq;
  873. u8 stat;
  874. debug_log(DBG_SENSE, "sector: %ld, nr_sectors: %ld,"
  875. " current_nr_sectors: %d\n",
  876. rq->sector, rq->nr_sectors, rq->current_nr_sectors);
  877. if (!blk_special_request(rq)) {
  878. /* We do not support buffer cache originated requests. */
  879. printk(KERN_NOTICE "ide-tape: %s: Unsupported request in "
  880. "request queue (%d)\n", drive->name, rq->cmd_type);
  881. ide_end_request(drive, 0, 0);
  882. return ide_stopped;
  883. }
  884. /* Retry a failed packet command */
  885. if (tape->failed_pc && tape->pc->c[0] == REQUEST_SENSE) {
  886. pc = tape->failed_pc;
  887. goto out;
  888. }
  889. if (postponed_rq != NULL)
  890. if (rq != postponed_rq) {
  891. printk(KERN_ERR "ide-tape: ide-tape.c bug - "
  892. "Two DSC requests were queued\n");
  893. idetape_end_request(drive, 0, 0);
  894. return ide_stopped;
  895. }
  896. tape->postponed_rq = NULL;
  897. /*
  898. * If the tape is still busy, postpone our request and service
  899. * the other device meanwhile.
  900. */
  901. stat = ide_read_status(drive);
  902. if (!drive->dsc_overlap && !(rq->cmd[0] & REQ_IDETAPE_PC2))
  903. set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
  904. if (drive->post_reset == 1) {
  905. set_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags);
  906. drive->post_reset = 0;
  907. }
  908. if (!test_and_clear_bit(IDETAPE_FLAG_IGNORE_DSC, &tape->flags) &&
  909. (stat & SEEK_STAT) == 0) {
  910. if (postponed_rq == NULL) {
  911. tape->dsc_polling_start = jiffies;
  912. tape->dsc_poll_freq = tape->best_dsc_rw_freq;
  913. tape->dsc_timeout = jiffies + IDETAPE_DSC_RW_TIMEOUT;
  914. } else if (time_after(jiffies, tape->dsc_timeout)) {
  915. printk(KERN_ERR "ide-tape: %s: DSC timeout\n",
  916. tape->name);
  917. if (rq->cmd[0] & REQ_IDETAPE_PC2) {
  918. idetape_media_access_finished(drive);
  919. return ide_stopped;
  920. } else {
  921. return ide_do_reset(drive);
  922. }
  923. } else if (time_after(jiffies,
  924. tape->dsc_polling_start +
  925. IDETAPE_DSC_MA_THRESHOLD))
  926. tape->dsc_poll_freq = IDETAPE_DSC_MA_SLOW;
  927. idetape_postpone_request(drive);
  928. return ide_stopped;
  929. }
  930. if (rq->cmd[0] & REQ_IDETAPE_READ) {
  931. pc = idetape_next_pc_storage(drive);
  932. idetape_create_read_cmd(tape, pc, rq->current_nr_sectors,
  933. (struct idetape_bh *)rq->special);
  934. goto out;
  935. }
  936. if (rq->cmd[0] & REQ_IDETAPE_WRITE) {
  937. pc = idetape_next_pc_storage(drive);
  938. idetape_create_write_cmd(tape, pc, rq->current_nr_sectors,
  939. (struct idetape_bh *)rq->special);
  940. goto out;
  941. }
  942. if (rq->cmd[0] & REQ_IDETAPE_PC1) {
  943. pc = (struct ide_atapi_pc *) rq->buffer;
  944. rq->cmd[0] &= ~(REQ_IDETAPE_PC1);
  945. rq->cmd[0] |= REQ_IDETAPE_PC2;
  946. goto out;
  947. }
  948. if (rq->cmd[0] & REQ_IDETAPE_PC2) {
  949. idetape_media_access_finished(drive);
  950. return ide_stopped;
  951. }
  952. BUG();
  953. out:
  954. if (test_bit(IDETAPE_FLAG_DRQ_INTERRUPT, &tape->flags))
  955. pc->flags |= PC_FLAG_DRQ_INTERRUPT;
  956. return idetape_issue_pc(drive, pc);
  957. }
  958. /*
  959. * The function below uses __get_free_pages to allocate a data buffer of size
  960. * tape->buffer_size (or a bit more). We attempt to combine sequential pages as
  961. * much as possible.
  962. *
  963. * It returns a pointer to the newly allocated buffer, or NULL in case of
  964. * failure.
  965. */
  966. static struct idetape_bh *ide_tape_kmalloc_buffer(idetape_tape_t *tape,
  967. int full, int clear)
  968. {
  969. struct idetape_bh *prev_bh, *bh, *merge_bh;
  970. int pages = tape->pages_per_buffer;
  971. unsigned int order, b_allocd;
  972. char *b_data = NULL;
  973. merge_bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
  974. bh = merge_bh;
  975. if (bh == NULL)
  976. goto abort;
  977. order = fls(pages) - 1;
  978. bh->b_data = (char *) __get_free_pages(GFP_KERNEL, order);
  979. if (!bh->b_data)
  980. goto abort;
  981. b_allocd = (1 << order) * PAGE_SIZE;
  982. pages &= (order-1);
  983. if (clear)
  984. memset(bh->b_data, 0, b_allocd);
  985. bh->b_reqnext = NULL;
  986. bh->b_size = b_allocd;
  987. atomic_set(&bh->b_count, full ? bh->b_size : 0);
  988. while (pages) {
  989. order = fls(pages) - 1;
  990. b_data = (char *) __get_free_pages(GFP_KERNEL, order);
  991. if (!b_data)
  992. goto abort;
  993. b_allocd = (1 << order) * PAGE_SIZE;
  994. if (clear)
  995. memset(b_data, 0, b_allocd);
  996. /* newly allocated page frames below buffer header or ...*/
  997. if (bh->b_data == b_data + b_allocd) {
  998. bh->b_size += b_allocd;
  999. bh->b_data -= b_allocd;
  1000. if (full)
  1001. atomic_add(b_allocd, &bh->b_count);
  1002. continue;
  1003. }
  1004. /* they are above the header */
  1005. if (b_data == bh->b_data + bh->b_size) {
  1006. bh->b_size += b_allocd;
  1007. if (full)
  1008. atomic_add(b_allocd, &bh->b_count);
  1009. continue;
  1010. }
  1011. prev_bh = bh;
  1012. bh = kmalloc(sizeof(struct idetape_bh), GFP_KERNEL);
  1013. if (!bh) {
  1014. free_pages((unsigned long) b_data, order);
  1015. goto abort;
  1016. }
  1017. bh->b_reqnext = NULL;
  1018. bh->b_data = b_data;
  1019. bh->b_size = b_allocd;
  1020. atomic_set(&bh->b_count, full ? bh->b_size : 0);
  1021. prev_bh->b_reqnext = bh;
  1022. pages &= (order-1);
  1023. }
  1024. bh->b_size -= tape->excess_bh_size;
  1025. if (full)
  1026. atomic_sub(tape->excess_bh_size, &bh->b_count);
  1027. return merge_bh;
  1028. abort:
  1029. ide_tape_kfree_buffer(tape);
  1030. return NULL;
  1031. }
  1032. static int idetape_copy_stage_from_user(idetape_tape_t *tape,
  1033. const char __user *buf, int n)
  1034. {
  1035. struct idetape_bh *bh = tape->bh;
  1036. int count;
  1037. int ret = 0;
  1038. while (n) {
  1039. if (bh == NULL) {
  1040. printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
  1041. __func__);
  1042. return 1;
  1043. }
  1044. count = min((unsigned int)
  1045. (bh->b_size - atomic_read(&bh->b_count)),
  1046. (unsigned int)n);
  1047. if (copy_from_user(bh->b_data + atomic_read(&bh->b_count), buf,
  1048. count))
  1049. ret = 1;
  1050. n -= count;
  1051. atomic_add(count, &bh->b_count);
  1052. buf += count;
  1053. if (atomic_read(&bh->b_count) == bh->b_size) {
  1054. bh = bh->b_reqnext;
  1055. if (bh)
  1056. atomic_set(&bh->b_count, 0);
  1057. }
  1058. }
  1059. tape->bh = bh;
  1060. return ret;
  1061. }
  1062. static int idetape_copy_stage_to_user(idetape_tape_t *tape, char __user *buf,
  1063. int n)
  1064. {
  1065. struct idetape_bh *bh = tape->bh;
  1066. int count;
  1067. int ret = 0;
  1068. while (n) {
  1069. if (bh == NULL) {
  1070. printk(KERN_ERR "ide-tape: bh == NULL in %s\n",
  1071. __func__);
  1072. return 1;
  1073. }
  1074. count = min(tape->b_count, n);
  1075. if (copy_to_user(buf, tape->b_data, count))
  1076. ret = 1;
  1077. n -= count;
  1078. tape->b_data += count;
  1079. tape->b_count -= count;
  1080. buf += count;
  1081. if (!tape->b_count) {
  1082. bh = bh->b_reqnext;
  1083. tape->bh = bh;
  1084. if (bh) {
  1085. tape->b_data = bh->b_data;
  1086. tape->b_count = atomic_read(&bh->b_count);
  1087. }
  1088. }
  1089. }
  1090. return ret;
  1091. }
  1092. static void idetape_init_merge_buffer(idetape_tape_t *tape)
  1093. {
  1094. struct idetape_bh *bh = tape->merge_bh;
  1095. tape->bh = tape->merge_bh;
  1096. if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
  1097. atomic_set(&bh->b_count, 0);
  1098. else {
  1099. tape->b_data = bh->b_data;
  1100. tape->b_count = atomic_read(&bh->b_count);
  1101. }
  1102. }
  1103. /*
  1104. * Write a filemark if write_filemark=1. Flush the device buffers without
  1105. * writing a filemark otherwise.
  1106. */
  1107. static void idetape_create_write_filemark_cmd(ide_drive_t *drive,
  1108. struct ide_atapi_pc *pc, int write_filemark)
  1109. {
  1110. idetape_init_pc(pc);
  1111. pc->c[0] = WRITE_FILEMARKS;
  1112. pc->c[4] = write_filemark;
  1113. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1114. }
  1115. static void idetape_create_test_unit_ready_cmd(struct ide_atapi_pc *pc)
  1116. {
  1117. idetape_init_pc(pc);
  1118. pc->c[0] = TEST_UNIT_READY;
  1119. }
  1120. /*
  1121. * We add a special packet command request to the tail of the request queue, and
  1122. * wait for it to be serviced. This is not to be called from within the request
  1123. * handling part of the driver! We allocate here data on the stack and it is
  1124. * valid until the request is finished. This is not the case for the bottom part
  1125. * of the driver, where we are always leaving the functions to wait for an
  1126. * interrupt or a timer event.
  1127. *
  1128. * From the bottom part of the driver, we should allocate safe memory using
  1129. * idetape_next_pc_storage() and ide_tape_next_rq_storage(), and add the request
  1130. * to the request list without waiting for it to be serviced! In that case, we
  1131. * usually use idetape_queue_pc_head().
  1132. */
  1133. static int idetape_queue_pc_tail(ide_drive_t *drive, struct ide_atapi_pc *pc)
  1134. {
  1135. struct ide_tape_obj *tape = drive->driver_data;
  1136. struct request *rq;
  1137. int error;
  1138. rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
  1139. rq->cmd_type = REQ_TYPE_SPECIAL;
  1140. rq->cmd[0] = REQ_IDETAPE_PC1;
  1141. rq->buffer = (char *)pc;
  1142. error = blk_execute_rq(drive->queue, tape->disk, rq, 0);
  1143. blk_put_request(rq);
  1144. return error;
  1145. }
  1146. static void idetape_create_load_unload_cmd(ide_drive_t *drive,
  1147. struct ide_atapi_pc *pc, int cmd)
  1148. {
  1149. idetape_init_pc(pc);
  1150. pc->c[0] = START_STOP;
  1151. pc->c[4] = cmd;
  1152. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1153. }
  1154. static int idetape_wait_ready(ide_drive_t *drive, unsigned long timeout)
  1155. {
  1156. idetape_tape_t *tape = drive->driver_data;
  1157. struct ide_atapi_pc pc;
  1158. int load_attempted = 0;
  1159. /* Wait for the tape to become ready */
  1160. set_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
  1161. timeout += jiffies;
  1162. while (time_before(jiffies, timeout)) {
  1163. idetape_create_test_unit_ready_cmd(&pc);
  1164. if (!idetape_queue_pc_tail(drive, &pc))
  1165. return 0;
  1166. if ((tape->sense_key == 2 && tape->asc == 4 && tape->ascq == 2)
  1167. || (tape->asc == 0x3A)) {
  1168. /* no media */
  1169. if (load_attempted)
  1170. return -ENOMEDIUM;
  1171. idetape_create_load_unload_cmd(drive, &pc,
  1172. IDETAPE_LU_LOAD_MASK);
  1173. idetape_queue_pc_tail(drive, &pc);
  1174. load_attempted = 1;
  1175. /* not about to be ready */
  1176. } else if (!(tape->sense_key == 2 && tape->asc == 4 &&
  1177. (tape->ascq == 1 || tape->ascq == 8)))
  1178. return -EIO;
  1179. msleep(100);
  1180. }
  1181. return -EIO;
  1182. }
  1183. static int idetape_flush_tape_buffers(ide_drive_t *drive)
  1184. {
  1185. struct ide_atapi_pc pc;
  1186. int rc;
  1187. idetape_create_write_filemark_cmd(drive, &pc, 0);
  1188. rc = idetape_queue_pc_tail(drive, &pc);
  1189. if (rc)
  1190. return rc;
  1191. idetape_wait_ready(drive, 60 * 5 * HZ);
  1192. return 0;
  1193. }
  1194. static void idetape_create_read_position_cmd(struct ide_atapi_pc *pc)
  1195. {
  1196. idetape_init_pc(pc);
  1197. pc->c[0] = READ_POSITION;
  1198. pc->req_xfer = 20;
  1199. }
  1200. static int idetape_read_position(ide_drive_t *drive)
  1201. {
  1202. idetape_tape_t *tape = drive->driver_data;
  1203. struct ide_atapi_pc pc;
  1204. int position;
  1205. debug_log(DBG_PROCS, "Enter %s\n", __func__);
  1206. idetape_create_read_position_cmd(&pc);
  1207. if (idetape_queue_pc_tail(drive, &pc))
  1208. return -1;
  1209. position = tape->first_frame;
  1210. return position;
  1211. }
  1212. static void idetape_create_locate_cmd(ide_drive_t *drive,
  1213. struct ide_atapi_pc *pc,
  1214. unsigned int block, u8 partition, int skip)
  1215. {
  1216. idetape_init_pc(pc);
  1217. pc->c[0] = POSITION_TO_ELEMENT;
  1218. pc->c[1] = 2;
  1219. put_unaligned(cpu_to_be32(block), (unsigned int *) &pc->c[3]);
  1220. pc->c[8] = partition;
  1221. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1222. }
  1223. static int idetape_create_prevent_cmd(ide_drive_t *drive,
  1224. struct ide_atapi_pc *pc, int prevent)
  1225. {
  1226. idetape_tape_t *tape = drive->driver_data;
  1227. /* device supports locking according to capabilities page */
  1228. if (!(tape->caps[6] & 0x01))
  1229. return 0;
  1230. idetape_init_pc(pc);
  1231. pc->c[0] = ALLOW_MEDIUM_REMOVAL;
  1232. pc->c[4] = prevent;
  1233. return 1;
  1234. }
  1235. static void __ide_tape_discard_merge_buffer(ide_drive_t *drive)
  1236. {
  1237. idetape_tape_t *tape = drive->driver_data;
  1238. if (tape->chrdev_dir != IDETAPE_DIR_READ)
  1239. return;
  1240. clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags);
  1241. tape->merge_bh_size = 0;
  1242. if (tape->merge_bh != NULL) {
  1243. ide_tape_kfree_buffer(tape);
  1244. tape->merge_bh = NULL;
  1245. }
  1246. tape->chrdev_dir = IDETAPE_DIR_NONE;
  1247. }
  1248. /*
  1249. * Position the tape to the requested block using the LOCATE packet command.
  1250. * A READ POSITION command is then issued to check where we are positioned. Like
  1251. * all higher level operations, we queue the commands at the tail of the request
  1252. * queue and wait for their completion.
  1253. */
  1254. static int idetape_position_tape(ide_drive_t *drive, unsigned int block,
  1255. u8 partition, int skip)
  1256. {
  1257. idetape_tape_t *tape = drive->driver_data;
  1258. int retval;
  1259. struct ide_atapi_pc pc;
  1260. if (tape->chrdev_dir == IDETAPE_DIR_READ)
  1261. __ide_tape_discard_merge_buffer(drive);
  1262. idetape_wait_ready(drive, 60 * 5 * HZ);
  1263. idetape_create_locate_cmd(drive, &pc, block, partition, skip);
  1264. retval = idetape_queue_pc_tail(drive, &pc);
  1265. if (retval)
  1266. return (retval);
  1267. idetape_create_read_position_cmd(&pc);
  1268. return (idetape_queue_pc_tail(drive, &pc));
  1269. }
  1270. static void ide_tape_discard_merge_buffer(ide_drive_t *drive,
  1271. int restore_position)
  1272. {
  1273. idetape_tape_t *tape = drive->driver_data;
  1274. int seek, position;
  1275. __ide_tape_discard_merge_buffer(drive);
  1276. if (restore_position) {
  1277. position = idetape_read_position(drive);
  1278. seek = position > 0 ? position : 0;
  1279. if (idetape_position_tape(drive, seek, 0, 0)) {
  1280. printk(KERN_INFO "ide-tape: %s: position_tape failed in"
  1281. " %s\n", tape->name, __func__);
  1282. return;
  1283. }
  1284. }
  1285. }
  1286. /*
  1287. * Generate a read/write request for the block device interface and wait for it
  1288. * to be serviced.
  1289. */
  1290. static int idetape_queue_rw_tail(ide_drive_t *drive, int cmd, int blocks,
  1291. struct idetape_bh *bh)
  1292. {
  1293. idetape_tape_t *tape = drive->driver_data;
  1294. struct request *rq;
  1295. int ret, errors;
  1296. debug_log(DBG_SENSE, "%s: cmd=%d\n", __func__, cmd);
  1297. rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
  1298. rq->cmd_type = REQ_TYPE_SPECIAL;
  1299. rq->cmd[0] = cmd;
  1300. rq->rq_disk = tape->disk;
  1301. rq->special = (void *)bh;
  1302. rq->sector = tape->first_frame;
  1303. rq->nr_sectors = blocks;
  1304. rq->current_nr_sectors = blocks;
  1305. blk_execute_rq(drive->queue, tape->disk, rq, 0);
  1306. errors = rq->errors;
  1307. ret = tape->blk_size * (blocks - rq->current_nr_sectors);
  1308. blk_put_request(rq);
  1309. if ((cmd & (REQ_IDETAPE_READ | REQ_IDETAPE_WRITE)) == 0)
  1310. return 0;
  1311. if (tape->merge_bh)
  1312. idetape_init_merge_buffer(tape);
  1313. if (errors == IDETAPE_ERROR_GENERAL)
  1314. return -EIO;
  1315. return ret;
  1316. }
  1317. static void idetape_create_inquiry_cmd(struct ide_atapi_pc *pc)
  1318. {
  1319. idetape_init_pc(pc);
  1320. pc->c[0] = INQUIRY;
  1321. pc->c[4] = 254;
  1322. pc->req_xfer = 254;
  1323. }
  1324. static void idetape_create_rewind_cmd(ide_drive_t *drive,
  1325. struct ide_atapi_pc *pc)
  1326. {
  1327. idetape_init_pc(pc);
  1328. pc->c[0] = REZERO_UNIT;
  1329. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1330. }
  1331. static void idetape_create_erase_cmd(struct ide_atapi_pc *pc)
  1332. {
  1333. idetape_init_pc(pc);
  1334. pc->c[0] = ERASE;
  1335. pc->c[1] = 1;
  1336. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1337. }
  1338. static void idetape_create_space_cmd(struct ide_atapi_pc *pc, int count, u8 cmd)
  1339. {
  1340. idetape_init_pc(pc);
  1341. pc->c[0] = SPACE;
  1342. put_unaligned(cpu_to_be32(count), (unsigned int *) &pc->c[1]);
  1343. pc->c[1] = cmd;
  1344. pc->flags |= PC_FLAG_WAIT_FOR_DSC;
  1345. }
  1346. /* Queue up a character device originated write request. */
  1347. static int idetape_add_chrdev_write_request(ide_drive_t *drive, int blocks)
  1348. {
  1349. idetape_tape_t *tape = drive->driver_data;
  1350. debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
  1351. return idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE,
  1352. blocks, tape->merge_bh);
  1353. }
  1354. static void ide_tape_flush_merge_buffer(ide_drive_t *drive)
  1355. {
  1356. idetape_tape_t *tape = drive->driver_data;
  1357. int blocks, min;
  1358. struct idetape_bh *bh;
  1359. if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
  1360. printk(KERN_ERR "ide-tape: bug: Trying to empty merge buffer"
  1361. " but we are not writing.\n");
  1362. return;
  1363. }
  1364. if (tape->merge_bh_size > tape->buffer_size) {
  1365. printk(KERN_ERR "ide-tape: bug: merge_buffer too big\n");
  1366. tape->merge_bh_size = tape->buffer_size;
  1367. }
  1368. if (tape->merge_bh_size) {
  1369. blocks = tape->merge_bh_size / tape->blk_size;
  1370. if (tape->merge_bh_size % tape->blk_size) {
  1371. unsigned int i;
  1372. blocks++;
  1373. i = tape->blk_size - tape->merge_bh_size %
  1374. tape->blk_size;
  1375. bh = tape->bh->b_reqnext;
  1376. while (bh) {
  1377. atomic_set(&bh->b_count, 0);
  1378. bh = bh->b_reqnext;
  1379. }
  1380. bh = tape->bh;
  1381. while (i) {
  1382. if (bh == NULL) {
  1383. printk(KERN_INFO "ide-tape: bug,"
  1384. " bh NULL\n");
  1385. break;
  1386. }
  1387. min = min(i, (unsigned int)(bh->b_size -
  1388. atomic_read(&bh->b_count)));
  1389. memset(bh->b_data + atomic_read(&bh->b_count),
  1390. 0, min);
  1391. atomic_add(min, &bh->b_count);
  1392. i -= min;
  1393. bh = bh->b_reqnext;
  1394. }
  1395. }
  1396. (void) idetape_add_chrdev_write_request(drive, blocks);
  1397. tape->merge_bh_size = 0;
  1398. }
  1399. if (tape->merge_bh != NULL) {
  1400. ide_tape_kfree_buffer(tape);
  1401. tape->merge_bh = NULL;
  1402. }
  1403. tape->chrdev_dir = IDETAPE_DIR_NONE;
  1404. }
  1405. static int idetape_init_read(ide_drive_t *drive)
  1406. {
  1407. idetape_tape_t *tape = drive->driver_data;
  1408. int bytes_read;
  1409. /* Initialize read operation */
  1410. if (tape->chrdev_dir != IDETAPE_DIR_READ) {
  1411. if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
  1412. ide_tape_flush_merge_buffer(drive);
  1413. idetape_flush_tape_buffers(drive);
  1414. }
  1415. if (tape->merge_bh || tape->merge_bh_size) {
  1416. printk(KERN_ERR "ide-tape: merge_bh_size should be"
  1417. " 0 now\n");
  1418. tape->merge_bh_size = 0;
  1419. }
  1420. tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
  1421. if (!tape->merge_bh)
  1422. return -ENOMEM;
  1423. tape->chrdev_dir = IDETAPE_DIR_READ;
  1424. /*
  1425. * Issue a read 0 command to ensure that DSC handshake is
  1426. * switched from completion mode to buffer available mode.
  1427. * No point in issuing this if DSC overlap isn't supported, some
  1428. * drives (Seagate STT3401A) will return an error.
  1429. */
  1430. if (drive->dsc_overlap) {
  1431. bytes_read = idetape_queue_rw_tail(drive,
  1432. REQ_IDETAPE_READ, 0,
  1433. tape->merge_bh);
  1434. if (bytes_read < 0) {
  1435. ide_tape_kfree_buffer(tape);
  1436. tape->merge_bh = NULL;
  1437. tape->chrdev_dir = IDETAPE_DIR_NONE;
  1438. return bytes_read;
  1439. }
  1440. }
  1441. }
  1442. return 0;
  1443. }
  1444. /* called from idetape_chrdev_read() to service a chrdev read request. */
  1445. static int idetape_add_chrdev_read_request(ide_drive_t *drive, int blocks)
  1446. {
  1447. idetape_tape_t *tape = drive->driver_data;
  1448. debug_log(DBG_PROCS, "Enter %s, %d blocks\n", __func__, blocks);
  1449. /* If we are at a filemark, return a read length of 0 */
  1450. if (test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
  1451. return 0;
  1452. idetape_init_read(drive);
  1453. return idetape_queue_rw_tail(drive, REQ_IDETAPE_READ, blocks,
  1454. tape->merge_bh);
  1455. }
  1456. static void idetape_pad_zeros(ide_drive_t *drive, int bcount)
  1457. {
  1458. idetape_tape_t *tape = drive->driver_data;
  1459. struct idetape_bh *bh;
  1460. int blocks;
  1461. while (bcount) {
  1462. unsigned int count;
  1463. bh = tape->merge_bh;
  1464. count = min(tape->buffer_size, bcount);
  1465. bcount -= count;
  1466. blocks = count / tape->blk_size;
  1467. while (count) {
  1468. atomic_set(&bh->b_count,
  1469. min(count, (unsigned int)bh->b_size));
  1470. memset(bh->b_data, 0, atomic_read(&bh->b_count));
  1471. count -= atomic_read(&bh->b_count);
  1472. bh = bh->b_reqnext;
  1473. }
  1474. idetape_queue_rw_tail(drive, REQ_IDETAPE_WRITE, blocks,
  1475. tape->merge_bh);
  1476. }
  1477. }
  1478. /*
  1479. * Rewinds the tape to the Beginning Of the current Partition (BOP). We
  1480. * currently support only one partition.
  1481. */
  1482. static int idetape_rewind_tape(ide_drive_t *drive)
  1483. {
  1484. int retval;
  1485. struct ide_atapi_pc pc;
  1486. idetape_tape_t *tape;
  1487. tape = drive->driver_data;
  1488. debug_log(DBG_SENSE, "Enter %s\n", __func__);
  1489. idetape_create_rewind_cmd(drive, &pc);
  1490. retval = idetape_queue_pc_tail(drive, &pc);
  1491. if (retval)
  1492. return retval;
  1493. idetape_create_read_position_cmd(&pc);
  1494. retval = idetape_queue_pc_tail(drive, &pc);
  1495. if (retval)
  1496. return retval;
  1497. return 0;
  1498. }
  1499. /* mtio.h compatible commands should be issued to the chrdev interface. */
  1500. static int idetape_blkdev_ioctl(ide_drive_t *drive, unsigned int cmd,
  1501. unsigned long arg)
  1502. {
  1503. idetape_tape_t *tape = drive->driver_data;
  1504. void __user *argp = (void __user *)arg;
  1505. struct idetape_config {
  1506. int dsc_rw_frequency;
  1507. int dsc_media_access_frequency;
  1508. int nr_stages;
  1509. } config;
  1510. debug_log(DBG_PROCS, "Enter %s\n", __func__);
  1511. switch (cmd) {
  1512. case 0x0340:
  1513. if (copy_from_user(&config, argp, sizeof(config)))
  1514. return -EFAULT;
  1515. tape->best_dsc_rw_freq = config.dsc_rw_frequency;
  1516. break;
  1517. case 0x0350:
  1518. config.dsc_rw_frequency = (int) tape->best_dsc_rw_freq;
  1519. config.nr_stages = 1;
  1520. if (copy_to_user(argp, &config, sizeof(config)))
  1521. return -EFAULT;
  1522. break;
  1523. default:
  1524. return -EIO;
  1525. }
  1526. return 0;
  1527. }
  1528. static int idetape_space_over_filemarks(ide_drive_t *drive, short mt_op,
  1529. int mt_count)
  1530. {
  1531. idetape_tape_t *tape = drive->driver_data;
  1532. struct ide_atapi_pc pc;
  1533. int retval, count = 0;
  1534. int sprev = !!(tape->caps[4] & 0x20);
  1535. if (mt_count == 0)
  1536. return 0;
  1537. if (MTBSF == mt_op || MTBSFM == mt_op) {
  1538. if (!sprev)
  1539. return -EIO;
  1540. mt_count = -mt_count;
  1541. }
  1542. if (tape->chrdev_dir == IDETAPE_DIR_READ) {
  1543. tape->merge_bh_size = 0;
  1544. if (test_and_clear_bit(IDETAPE_FLAG_FILEMARK, &tape->flags))
  1545. ++count;
  1546. ide_tape_discard_merge_buffer(drive, 0);
  1547. }
  1548. switch (mt_op) {
  1549. case MTFSF:
  1550. case MTBSF:
  1551. idetape_create_space_cmd(&pc, mt_count - count,
  1552. IDETAPE_SPACE_OVER_FILEMARK);
  1553. return idetape_queue_pc_tail(drive, &pc);
  1554. case MTFSFM:
  1555. case MTBSFM:
  1556. if (!sprev)
  1557. return -EIO;
  1558. retval = idetape_space_over_filemarks(drive, MTFSF,
  1559. mt_count - count);
  1560. if (retval)
  1561. return retval;
  1562. count = (MTBSFM == mt_op ? 1 : -1);
  1563. return idetape_space_over_filemarks(drive, MTFSF, count);
  1564. default:
  1565. printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
  1566. mt_op);
  1567. return -EIO;
  1568. }
  1569. }
  1570. /*
  1571. * Our character device read / write functions.
  1572. *
  1573. * The tape is optimized to maximize throughput when it is transferring an
  1574. * integral number of the "continuous transfer limit", which is a parameter of
  1575. * the specific tape (26kB on my particular tape, 32kB for Onstream).
  1576. *
  1577. * As of version 1.3 of the driver, the character device provides an abstract
  1578. * continuous view of the media - any mix of block sizes (even 1 byte) on the
  1579. * same backup/restore procedure is supported. The driver will internally
  1580. * convert the requests to the recommended transfer unit, so that an unmatch
  1581. * between the user's block size to the recommended size will only result in a
  1582. * (slightly) increased driver overhead, but will no longer hit performance.
  1583. * This is not applicable to Onstream.
  1584. */
  1585. static ssize_t idetape_chrdev_read(struct file *file, char __user *buf,
  1586. size_t count, loff_t *ppos)
  1587. {
  1588. struct ide_tape_obj *tape = ide_tape_f(file);
  1589. ide_drive_t *drive = tape->drive;
  1590. ssize_t bytes_read, temp, actually_read = 0, rc;
  1591. ssize_t ret = 0;
  1592. u16 ctl = *(u16 *)&tape->caps[12];
  1593. debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
  1594. if (tape->chrdev_dir != IDETAPE_DIR_READ) {
  1595. if (test_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags))
  1596. if (count > tape->blk_size &&
  1597. (count % tape->blk_size) == 0)
  1598. tape->user_bs_factor = count / tape->blk_size;
  1599. }
  1600. rc = idetape_init_read(drive);
  1601. if (rc < 0)
  1602. return rc;
  1603. if (count == 0)
  1604. return (0);
  1605. if (tape->merge_bh_size) {
  1606. actually_read = min((unsigned int)(tape->merge_bh_size),
  1607. (unsigned int)count);
  1608. if (idetape_copy_stage_to_user(tape, buf, actually_read))
  1609. ret = -EFAULT;
  1610. buf += actually_read;
  1611. tape->merge_bh_size -= actually_read;
  1612. count -= actually_read;
  1613. }
  1614. while (count >= tape->buffer_size) {
  1615. bytes_read = idetape_add_chrdev_read_request(drive, ctl);
  1616. if (bytes_read <= 0)
  1617. goto finish;
  1618. if (idetape_copy_stage_to_user(tape, buf, bytes_read))
  1619. ret = -EFAULT;
  1620. buf += bytes_read;
  1621. count -= bytes_read;
  1622. actually_read += bytes_read;
  1623. }
  1624. if (count) {
  1625. bytes_read = idetape_add_chrdev_read_request(drive, ctl);
  1626. if (bytes_read <= 0)
  1627. goto finish;
  1628. temp = min((unsigned long)count, (unsigned long)bytes_read);
  1629. if (idetape_copy_stage_to_user(tape, buf, temp))
  1630. ret = -EFAULT;
  1631. actually_read += temp;
  1632. tape->merge_bh_size = bytes_read-temp;
  1633. }
  1634. finish:
  1635. if (!actually_read && test_bit(IDETAPE_FLAG_FILEMARK, &tape->flags)) {
  1636. debug_log(DBG_SENSE, "%s: spacing over filemark\n", tape->name);
  1637. idetape_space_over_filemarks(drive, MTFSF, 1);
  1638. return 0;
  1639. }
  1640. return ret ? ret : actually_read;
  1641. }
  1642. static ssize_t idetape_chrdev_write(struct file *file, const char __user *buf,
  1643. size_t count, loff_t *ppos)
  1644. {
  1645. struct ide_tape_obj *tape = ide_tape_f(file);
  1646. ide_drive_t *drive = tape->drive;
  1647. ssize_t actually_written = 0;
  1648. ssize_t ret = 0;
  1649. u16 ctl = *(u16 *)&tape->caps[12];
  1650. /* The drive is write protected. */
  1651. if (tape->write_prot)
  1652. return -EACCES;
  1653. debug_log(DBG_CHRDEV, "Enter %s, count %Zd\n", __func__, count);
  1654. /* Initialize write operation */
  1655. if (tape->chrdev_dir != IDETAPE_DIR_WRITE) {
  1656. if (tape->chrdev_dir == IDETAPE_DIR_READ)
  1657. ide_tape_discard_merge_buffer(drive, 1);
  1658. if (tape->merge_bh || tape->merge_bh_size) {
  1659. printk(KERN_ERR "ide-tape: merge_bh_size "
  1660. "should be 0 now\n");
  1661. tape->merge_bh_size = 0;
  1662. }
  1663. tape->merge_bh = ide_tape_kmalloc_buffer(tape, 0, 0);
  1664. if (!tape->merge_bh)
  1665. return -ENOMEM;
  1666. tape->chrdev_dir = IDETAPE_DIR_WRITE;
  1667. idetape_init_merge_buffer(tape);
  1668. /*
  1669. * Issue a write 0 command to ensure that DSC handshake is
  1670. * switched from completion mode to buffer available mode. No
  1671. * point in issuing this if DSC overlap isn't supported, some
  1672. * drives (Seagate STT3401A) will return an error.
  1673. */
  1674. if (drive->dsc_overlap) {
  1675. ssize_t retval = idetape_queue_rw_tail(drive,
  1676. REQ_IDETAPE_WRITE, 0,
  1677. tape->merge_bh);
  1678. if (retval < 0) {
  1679. ide_tape_kfree_buffer(tape);
  1680. tape->merge_bh = NULL;
  1681. tape->chrdev_dir = IDETAPE_DIR_NONE;
  1682. return retval;
  1683. }
  1684. }
  1685. }
  1686. if (count == 0)
  1687. return (0);
  1688. if (tape->merge_bh_size) {
  1689. if (tape->merge_bh_size >= tape->buffer_size) {
  1690. printk(KERN_ERR "ide-tape: bug: merge buf too big\n");
  1691. tape->merge_bh_size = 0;
  1692. }
  1693. actually_written = min((unsigned int)
  1694. (tape->buffer_size - tape->merge_bh_size),
  1695. (unsigned int)count);
  1696. if (idetape_copy_stage_from_user(tape, buf, actually_written))
  1697. ret = -EFAULT;
  1698. buf += actually_written;
  1699. tape->merge_bh_size += actually_written;
  1700. count -= actually_written;
  1701. if (tape->merge_bh_size == tape->buffer_size) {
  1702. ssize_t retval;
  1703. tape->merge_bh_size = 0;
  1704. retval = idetape_add_chrdev_write_request(drive, ctl);
  1705. if (retval <= 0)
  1706. return (retval);
  1707. }
  1708. }
  1709. while (count >= tape->buffer_size) {
  1710. ssize_t retval;
  1711. if (idetape_copy_stage_from_user(tape, buf, tape->buffer_size))
  1712. ret = -EFAULT;
  1713. buf += tape->buffer_size;
  1714. count -= tape->buffer_size;
  1715. retval = idetape_add_chrdev_write_request(drive, ctl);
  1716. actually_written += tape->buffer_size;
  1717. if (retval <= 0)
  1718. return (retval);
  1719. }
  1720. if (count) {
  1721. actually_written += count;
  1722. if (idetape_copy_stage_from_user(tape, buf, count))
  1723. ret = -EFAULT;
  1724. tape->merge_bh_size += count;
  1725. }
  1726. return ret ? ret : actually_written;
  1727. }
  1728. static int idetape_write_filemark(ide_drive_t *drive)
  1729. {
  1730. struct ide_atapi_pc pc;
  1731. /* Write a filemark */
  1732. idetape_create_write_filemark_cmd(drive, &pc, 1);
  1733. if (idetape_queue_pc_tail(drive, &pc)) {
  1734. printk(KERN_ERR "ide-tape: Couldn't write a filemark\n");
  1735. return -EIO;
  1736. }
  1737. return 0;
  1738. }
  1739. /*
  1740. * Called from idetape_chrdev_ioctl when the general mtio MTIOCTOP ioctl is
  1741. * requested.
  1742. *
  1743. * Note: MTBSF and MTBSFM are not supported when the tape doesn't support
  1744. * spacing over filemarks in the reverse direction. In this case, MTFSFM is also
  1745. * usually not supported.
  1746. *
  1747. * The following commands are currently not supported:
  1748. *
  1749. * MTFSS, MTBSS, MTWSM, MTSETDENSITY, MTSETDRVBUFFER, MT_ST_BOOLEANS,
  1750. * MT_ST_WRITE_THRESHOLD.
  1751. */
  1752. static int idetape_mtioctop(ide_drive_t *drive, short mt_op, int mt_count)
  1753. {
  1754. idetape_tape_t *tape = drive->driver_data;
  1755. struct ide_atapi_pc pc;
  1756. int i, retval;
  1757. debug_log(DBG_ERR, "Handling MTIOCTOP ioctl: mt_op=%d, mt_count=%d\n",
  1758. mt_op, mt_count);
  1759. switch (mt_op) {
  1760. case MTFSF:
  1761. case MTFSFM:
  1762. case MTBSF:
  1763. case MTBSFM:
  1764. if (!mt_count)
  1765. return 0;
  1766. return idetape_space_over_filemarks(drive, mt_op, mt_count);
  1767. default:
  1768. break;
  1769. }
  1770. switch (mt_op) {
  1771. case MTWEOF:
  1772. if (tape->write_prot)
  1773. return -EACCES;
  1774. ide_tape_discard_merge_buffer(drive, 1);
  1775. for (i = 0; i < mt_count; i++) {
  1776. retval = idetape_write_filemark(drive);
  1777. if (retval)
  1778. return retval;
  1779. }
  1780. return 0;
  1781. case MTREW:
  1782. ide_tape_discard_merge_buffer(drive, 0);
  1783. if (idetape_rewind_tape(drive))
  1784. return -EIO;
  1785. return 0;
  1786. case MTLOAD:
  1787. ide_tape_discard_merge_buffer(drive, 0);
  1788. idetape_create_load_unload_cmd(drive, &pc,
  1789. IDETAPE_LU_LOAD_MASK);
  1790. return idetape_queue_pc_tail(drive, &pc);
  1791. case MTUNLOAD:
  1792. case MTOFFL:
  1793. /*
  1794. * If door is locked, attempt to unlock before
  1795. * attempting to eject.
  1796. */
  1797. if (tape->door_locked) {
  1798. if (idetape_create_prevent_cmd(drive, &pc, 0))
  1799. if (!idetape_queue_pc_tail(drive, &pc))
  1800. tape->door_locked = DOOR_UNLOCKED;
  1801. }
  1802. ide_tape_discard_merge_buffer(drive, 0);
  1803. idetape_create_load_unload_cmd(drive, &pc,
  1804. !IDETAPE_LU_LOAD_MASK);
  1805. retval = idetape_queue_pc_tail(drive, &pc);
  1806. if (!retval)
  1807. clear_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags);
  1808. return retval;
  1809. case MTNOP:
  1810. ide_tape_discard_merge_buffer(drive, 0);
  1811. return idetape_flush_tape_buffers(drive);
  1812. case MTRETEN:
  1813. ide_tape_discard_merge_buffer(drive, 0);
  1814. idetape_create_load_unload_cmd(drive, &pc,
  1815. IDETAPE_LU_RETENSION_MASK | IDETAPE_LU_LOAD_MASK);
  1816. return idetape_queue_pc_tail(drive, &pc);
  1817. case MTEOM:
  1818. idetape_create_space_cmd(&pc, 0, IDETAPE_SPACE_TO_EOD);
  1819. return idetape_queue_pc_tail(drive, &pc);
  1820. case MTERASE:
  1821. (void)idetape_rewind_tape(drive);
  1822. idetape_create_erase_cmd(&pc);
  1823. return idetape_queue_pc_tail(drive, &pc);
  1824. case MTSETBLK:
  1825. if (mt_count) {
  1826. if (mt_count < tape->blk_size ||
  1827. mt_count % tape->blk_size)
  1828. return -EIO;
  1829. tape->user_bs_factor = mt_count / tape->blk_size;
  1830. clear_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
  1831. } else
  1832. set_bit(IDETAPE_FLAG_DETECT_BS, &tape->flags);
  1833. return 0;
  1834. case MTSEEK:
  1835. ide_tape_discard_merge_buffer(drive, 0);
  1836. return idetape_position_tape(drive,
  1837. mt_count * tape->user_bs_factor, tape->partition, 0);
  1838. case MTSETPART:
  1839. ide_tape_discard_merge_buffer(drive, 0);
  1840. return idetape_position_tape(drive, 0, mt_count, 0);
  1841. case MTFSR:
  1842. case MTBSR:
  1843. case MTLOCK:
  1844. if (!idetape_create_prevent_cmd(drive, &pc, 1))
  1845. return 0;
  1846. retval = idetape_queue_pc_tail(drive, &pc);
  1847. if (retval)
  1848. return retval;
  1849. tape->door_locked = DOOR_EXPLICITLY_LOCKED;
  1850. return 0;
  1851. case MTUNLOCK:
  1852. if (!idetape_create_prevent_cmd(drive, &pc, 0))
  1853. return 0;
  1854. retval = idetape_queue_pc_tail(drive, &pc);
  1855. if (retval)
  1856. return retval;
  1857. tape->door_locked = DOOR_UNLOCKED;
  1858. return 0;
  1859. default:
  1860. printk(KERN_ERR "ide-tape: MTIO operation %d not supported\n",
  1861. mt_op);
  1862. return -EIO;
  1863. }
  1864. }
  1865. /*
  1866. * Our character device ioctls. General mtio.h magnetic io commands are
  1867. * supported here, and not in the corresponding block interface. Our own
  1868. * ide-tape ioctls are supported on both interfaces.
  1869. */
  1870. static int idetape_chrdev_ioctl(struct inode *inode, struct file *file,
  1871. unsigned int cmd, unsigned long arg)
  1872. {
  1873. struct ide_tape_obj *tape = ide_tape_f(file);
  1874. ide_drive_t *drive = tape->drive;
  1875. struct mtop mtop;
  1876. struct mtget mtget;
  1877. struct mtpos mtpos;
  1878. int block_offset = 0, position = tape->first_frame;
  1879. void __user *argp = (void __user *)arg;
  1880. debug_log(DBG_CHRDEV, "Enter %s, cmd=%u\n", __func__, cmd);
  1881. if (tape->chrdev_dir == IDETAPE_DIR_WRITE) {
  1882. ide_tape_flush_merge_buffer(drive);
  1883. idetape_flush_tape_buffers(drive);
  1884. }
  1885. if (cmd == MTIOCGET || cmd == MTIOCPOS) {
  1886. block_offset = tape->merge_bh_size /
  1887. (tape->blk_size * tape->user_bs_factor);
  1888. position = idetape_read_position(drive);
  1889. if (position < 0)
  1890. return -EIO;
  1891. }
  1892. switch (cmd) {
  1893. case MTIOCTOP:
  1894. if (copy_from_user(&mtop, argp, sizeof(struct mtop)))
  1895. return -EFAULT;
  1896. return idetape_mtioctop(drive, mtop.mt_op, mtop.mt_count);
  1897. case MTIOCGET:
  1898. memset(&mtget, 0, sizeof(struct mtget));
  1899. mtget.mt_type = MT_ISSCSI2;
  1900. mtget.mt_blkno = position / tape->user_bs_factor - block_offset;
  1901. mtget.mt_dsreg =
  1902. ((tape->blk_size * tape->user_bs_factor)
  1903. << MT_ST_BLKSIZE_SHIFT) & MT_ST_BLKSIZE_MASK;
  1904. if (tape->drv_write_prot)
  1905. mtget.mt_gstat |= GMT_WR_PROT(0xffffffff);
  1906. if (copy_to_user(argp, &mtget, sizeof(struct mtget)))
  1907. return -EFAULT;
  1908. return 0;
  1909. case MTIOCPOS:
  1910. mtpos.mt_blkno = position / tape->user_bs_factor - block_offset;
  1911. if (copy_to_user(argp, &mtpos, sizeof(struct mtpos)))
  1912. return -EFAULT;
  1913. return 0;
  1914. default:
  1915. if (tape->chrdev_dir == IDETAPE_DIR_READ)
  1916. ide_tape_discard_merge_buffer(drive, 1);
  1917. return idetape_blkdev_ioctl(drive, cmd, arg);
  1918. }
  1919. }
  1920. /*
  1921. * Do a mode sense page 0 with block descriptor and if it succeeds set the tape
  1922. * block size with the reported value.
  1923. */
  1924. static void ide_tape_get_bsize_from_bdesc(ide_drive_t *drive)
  1925. {
  1926. idetape_tape_t *tape = drive->driver_data;
  1927. struct ide_atapi_pc pc;
  1928. idetape_create_mode_sense_cmd(&pc, IDETAPE_BLOCK_DESCRIPTOR);
  1929. if (idetape_queue_pc_tail(drive, &pc)) {
  1930. printk(KERN_ERR "ide-tape: Can't get block descriptor\n");
  1931. if (tape->blk_size == 0) {
  1932. printk(KERN_WARNING "ide-tape: Cannot deal with zero "
  1933. "block size, assuming 32k\n");
  1934. tape->blk_size = 32768;
  1935. }
  1936. return;
  1937. }
  1938. tape->blk_size = (pc.buf[4 + 5] << 16) +
  1939. (pc.buf[4 + 6] << 8) +
  1940. pc.buf[4 + 7];
  1941. tape->drv_write_prot = (pc.buf[2] & 0x80) >> 7;
  1942. }
  1943. static int idetape_chrdev_open(struct inode *inode, struct file *filp)
  1944. {
  1945. unsigned int minor = iminor(inode), i = minor & ~0xc0;
  1946. ide_drive_t *drive;
  1947. idetape_tape_t *tape;
  1948. struct ide_atapi_pc pc;
  1949. int retval;
  1950. if (i >= MAX_HWIFS * MAX_DRIVES)
  1951. return -ENXIO;
  1952. tape = ide_tape_chrdev_get(i);
  1953. if (!tape)
  1954. return -ENXIO;
  1955. debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
  1956. /*
  1957. * We really want to do nonseekable_open(inode, filp); here, but some
  1958. * versions of tar incorrectly call lseek on tapes and bail out if that
  1959. * fails. So we disallow pread() and pwrite(), but permit lseeks.
  1960. */
  1961. filp->f_mode &= ~(FMODE_PREAD | FMODE_PWRITE);
  1962. drive = tape->drive;
  1963. filp->private_data = tape;
  1964. if (test_and_set_bit(IDETAPE_FLAG_BUSY, &tape->flags)) {
  1965. retval = -EBUSY;
  1966. goto out_put_tape;
  1967. }
  1968. retval = idetape_wait_ready(drive, 60 * HZ);
  1969. if (retval) {
  1970. clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
  1971. printk(KERN_ERR "ide-tape: %s: drive not ready\n", tape->name);
  1972. goto out_put_tape;
  1973. }
  1974. idetape_read_position(drive);
  1975. if (!test_bit(IDETAPE_FLAG_ADDRESS_VALID, &tape->flags))
  1976. (void)idetape_rewind_tape(drive);
  1977. /* Read block size and write protect status from drive. */
  1978. ide_tape_get_bsize_from_bdesc(drive);
  1979. /* Set write protect flag if device is opened as read-only. */
  1980. if ((filp->f_flags & O_ACCMODE) == O_RDONLY)
  1981. tape->write_prot = 1;
  1982. else
  1983. tape->write_prot = tape->drv_write_prot;
  1984. /* Make sure drive isn't write protected if user wants to write. */
  1985. if (tape->write_prot) {
  1986. if ((filp->f_flags & O_ACCMODE) == O_WRONLY ||
  1987. (filp->f_flags & O_ACCMODE) == O_RDWR) {
  1988. clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
  1989. retval = -EROFS;
  1990. goto out_put_tape;
  1991. }
  1992. }
  1993. /* Lock the tape drive door so user can't eject. */
  1994. if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
  1995. if (idetape_create_prevent_cmd(drive, &pc, 1)) {
  1996. if (!idetape_queue_pc_tail(drive, &pc)) {
  1997. if (tape->door_locked != DOOR_EXPLICITLY_LOCKED)
  1998. tape->door_locked = DOOR_LOCKED;
  1999. }
  2000. }
  2001. }
  2002. return 0;
  2003. out_put_tape:
  2004. ide_tape_put(tape);
  2005. return retval;
  2006. }
  2007. static void idetape_write_release(ide_drive_t *drive, unsigned int minor)
  2008. {
  2009. idetape_tape_t *tape = drive->driver_data;
  2010. ide_tape_flush_merge_buffer(drive);
  2011. tape->merge_bh = ide_tape_kmalloc_buffer(tape, 1, 0);
  2012. if (tape->merge_bh != NULL) {
  2013. idetape_pad_zeros(drive, tape->blk_size *
  2014. (tape->user_bs_factor - 1));
  2015. ide_tape_kfree_buffer(tape);
  2016. tape->merge_bh = NULL;
  2017. }
  2018. idetape_write_filemark(drive);
  2019. idetape_flush_tape_buffers(drive);
  2020. idetape_flush_tape_buffers(drive);
  2021. }
  2022. static int idetape_chrdev_release(struct inode *inode, struct file *filp)
  2023. {
  2024. struct ide_tape_obj *tape = ide_tape_f(filp);
  2025. ide_drive_t *drive = tape->drive;
  2026. struct ide_atapi_pc pc;
  2027. unsigned int minor = iminor(inode);
  2028. lock_kernel();
  2029. tape = drive->driver_data;
  2030. debug_log(DBG_CHRDEV, "Enter %s\n", __func__);
  2031. if (tape->chrdev_dir == IDETAPE_DIR_WRITE)
  2032. idetape_write_release(drive, minor);
  2033. if (tape->chrdev_dir == IDETAPE_DIR_READ) {
  2034. if (minor < 128)
  2035. ide_tape_discard_merge_buffer(drive, 1);
  2036. }
  2037. if (minor < 128 && test_bit(IDETAPE_FLAG_MEDIUM_PRESENT, &tape->flags))
  2038. (void) idetape_rewind_tape(drive);
  2039. if (tape->chrdev_dir == IDETAPE_DIR_NONE) {
  2040. if (tape->door_locked == DOOR_LOCKED) {
  2041. if (idetape_create_prevent_cmd(drive, &pc, 0)) {
  2042. if (!idetape_queue_pc_tail(drive, &pc))
  2043. tape->door_locked = DOOR_UNLOCKED;
  2044. }
  2045. }
  2046. }
  2047. clear_bit(IDETAPE_FLAG_BUSY, &tape->flags);
  2048. ide_tape_put(tape);
  2049. unlock_kernel();
  2050. return 0;
  2051. }
  2052. /*
  2053. * check the contents of the ATAPI IDENTIFY command results. We return:
  2054. *
  2055. * 1 - If the tape can be supported by us, based on the information we have so
  2056. * far.
  2057. *
  2058. * 0 - If this tape driver is not currently supported by us.
  2059. */
  2060. static int idetape_identify_device(ide_drive_t *drive)
  2061. {
  2062. u8 gcw[2], protocol, device_type, removable, packet_size;
  2063. if (drive->id_read == 0)
  2064. return 1;
  2065. *((unsigned short *) &gcw) = drive->id->config;
  2066. protocol = (gcw[1] & 0xC0) >> 6;
  2067. device_type = gcw[1] & 0x1F;
  2068. removable = !!(gcw[0] & 0x80);
  2069. packet_size = gcw[0] & 0x3;
  2070. /* Check that we can support this device */
  2071. if (protocol != 2)
  2072. printk(KERN_ERR "ide-tape: Protocol (0x%02x) is not ATAPI\n",
  2073. protocol);
  2074. else if (device_type != 1)
  2075. printk(KERN_ERR "ide-tape: Device type (0x%02x) is not set "
  2076. "to tape\n", device_type);
  2077. else if (!removable)
  2078. printk(KERN_ERR "ide-tape: The removable flag is not set\n");
  2079. else if (packet_size != 0) {
  2080. printk(KERN_ERR "ide-tape: Packet size (0x%02x) is not 12"
  2081. " bytes\n", packet_size);
  2082. } else
  2083. return 1;
  2084. return 0;
  2085. }
  2086. static void idetape_get_inquiry_results(ide_drive_t *drive)
  2087. {
  2088. idetape_tape_t *tape = drive->driver_data;
  2089. struct ide_atapi_pc pc;
  2090. char fw_rev[6], vendor_id[10], product_id[18];
  2091. idetape_create_inquiry_cmd(&pc);
  2092. if (idetape_queue_pc_tail(drive, &pc)) {
  2093. printk(KERN_ERR "ide-tape: %s: can't get INQUIRY results\n",
  2094. tape->name);
  2095. return;
  2096. }
  2097. memcpy(vendor_id, &pc.buf[8], 8);
  2098. memcpy(product_id, &pc.buf[16], 16);
  2099. memcpy(fw_rev, &pc.buf[32], 4);
  2100. ide_fixstring(vendor_id, 10, 0);
  2101. ide_fixstring(product_id, 18, 0);
  2102. ide_fixstring(fw_rev, 6, 0);
  2103. printk(KERN_INFO "ide-tape: %s <-> %s: %s %s rev %s\n",
  2104. drive->name, tape->name, vendor_id, product_id, fw_rev);
  2105. }
  2106. /*
  2107. * Ask the tape about its various parameters. In particular, we will adjust our
  2108. * data transfer buffer size to the recommended value as returned by the tape.
  2109. */
  2110. static void idetape_get_mode_sense_results(ide_drive_t *drive)
  2111. {
  2112. idetape_tape_t *tape = drive->driver_data;
  2113. struct ide_atapi_pc pc;
  2114. u8 *caps;
  2115. u8 speed, max_speed;
  2116. idetape_create_mode_sense_cmd(&pc, IDETAPE_CAPABILITIES_PAGE);
  2117. if (idetape_queue_pc_tail(drive, &pc)) {
  2118. printk(KERN_ERR "ide-tape: Can't get tape parameters - assuming"
  2119. " some default values\n");
  2120. tape->blk_size = 512;
  2121. put_unaligned(52, (u16 *)&tape->caps[12]);
  2122. put_unaligned(540, (u16 *)&tape->caps[14]);
  2123. put_unaligned(6*52, (u16 *)&tape->caps[16]);
  2124. return;
  2125. }
  2126. caps = pc.buf + 4 + pc.buf[3];
  2127. /* convert to host order and save for later use */
  2128. speed = be16_to_cpu(*(u16 *)&caps[14]);
  2129. max_speed = be16_to_cpu(*(u16 *)&caps[8]);
  2130. put_unaligned(max_speed, (u16 *)&caps[8]);
  2131. put_unaligned(be16_to_cpu(*(u16 *)&caps[12]), (u16 *)&caps[12]);
  2132. put_unaligned(speed, (u16 *)&caps[14]);
  2133. put_unaligned(be16_to_cpu(*(u16 *)&caps[16]), (u16 *)&caps[16]);
  2134. if (!speed) {
  2135. printk(KERN_INFO "ide-tape: %s: invalid tape speed "
  2136. "(assuming 650KB/sec)\n", drive->name);
  2137. put_unaligned(650, (u16 *)&caps[14]);
  2138. }
  2139. if (!max_speed) {
  2140. printk(KERN_INFO "ide-tape: %s: invalid max_speed "
  2141. "(assuming 650KB/sec)\n", drive->name);
  2142. put_unaligned(650, (u16 *)&caps[8]);
  2143. }
  2144. memcpy(&tape->caps, caps, 20);
  2145. if (caps[7] & 0x02)
  2146. tape->blk_size = 512;
  2147. else if (caps[7] & 0x04)
  2148. tape->blk_size = 1024;
  2149. }
  2150. #ifdef CONFIG_IDE_PROC_FS
  2151. static void idetape_add_settings(ide_drive_t *drive)
  2152. {
  2153. idetape_tape_t *tape = drive->driver_data;
  2154. ide_add_setting(drive, "buffer", SETTING_READ, TYPE_SHORT, 0, 0xffff,
  2155. 1, 2, (u16 *)&tape->caps[16], NULL);
  2156. ide_add_setting(drive, "speed", SETTING_READ, TYPE_SHORT, 0, 0xffff,
  2157. 1, 1, (u16 *)&tape->caps[14], NULL);
  2158. ide_add_setting(drive, "buffer_size", SETTING_READ, TYPE_INT, 0, 0xffff,
  2159. 1, 1024, &tape->buffer_size, NULL);
  2160. ide_add_setting(drive, "tdsc", SETTING_RW, TYPE_INT, IDETAPE_DSC_RW_MIN,
  2161. IDETAPE_DSC_RW_MAX, 1000, HZ, &tape->best_dsc_rw_freq,
  2162. NULL);
  2163. ide_add_setting(drive, "dsc_overlap", SETTING_RW, TYPE_BYTE, 0, 1, 1,
  2164. 1, &drive->dsc_overlap, NULL);
  2165. ide_add_setting(drive, "avg_speed", SETTING_READ, TYPE_INT, 0, 0xffff,
  2166. 1, 1, &tape->avg_speed, NULL);
  2167. ide_add_setting(drive, "debug_mask", SETTING_RW, TYPE_INT, 0, 0xffff, 1,
  2168. 1, &tape->debug_mask, NULL);
  2169. }
  2170. #else
  2171. static inline void idetape_add_settings(ide_drive_t *drive) { ; }
  2172. #endif
  2173. /*
  2174. * The function below is called to:
  2175. *
  2176. * 1. Initialize our various state variables.
  2177. * 2. Ask the tape for its capabilities.
  2178. * 3. Allocate a buffer which will be used for data transfer. The buffer size
  2179. * is chosen based on the recommendation which we received in step 2.
  2180. *
  2181. * Note that at this point ide.c already assigned us an irq, so that we can
  2182. * queue requests here and wait for their completion.
  2183. */
  2184. static void idetape_setup(ide_drive_t *drive, idetape_tape_t *tape, int minor)
  2185. {
  2186. unsigned long t;
  2187. int speed;
  2188. int buffer_size;
  2189. u8 gcw[2];
  2190. u16 *ctl = (u16 *)&tape->caps[12];
  2191. spin_lock_init(&tape->lock);
  2192. drive->dsc_overlap = 1;
  2193. if (drive->hwif->host_flags & IDE_HFLAG_NO_DSC) {
  2194. printk(KERN_INFO "ide-tape: %s: disabling DSC overlap\n",
  2195. tape->name);
  2196. drive->dsc_overlap = 0;
  2197. }
  2198. /* Seagate Travan drives do not support DSC overlap. */
  2199. if (strstr(drive->id->model, "Seagate STT3401"))
  2200. drive->dsc_overlap = 0;
  2201. tape->minor = minor;
  2202. tape->name[0] = 'h';
  2203. tape->name[1] = 't';
  2204. tape->name[2] = '0' + minor;
  2205. tape->chrdev_dir = IDETAPE_DIR_NONE;
  2206. tape->pc = tape->pc_stack;
  2207. *((unsigned short *) &gcw) = drive->id->config;
  2208. /* Command packet DRQ type */
  2209. if (((gcw[0] & 0x60) >> 5) == 1)
  2210. set_bit(IDETAPE_FLAG_DRQ_INTERRUPT, &tape->flags);
  2211. idetape_get_inquiry_results(drive);
  2212. idetape_get_mode_sense_results(drive);
  2213. ide_tape_get_bsize_from_bdesc(drive);
  2214. tape->user_bs_factor = 1;
  2215. tape->buffer_size = *ctl * tape->blk_size;
  2216. while (tape->buffer_size > 0xffff) {
  2217. printk(KERN_NOTICE "ide-tape: decreasing stage size\n");
  2218. *ctl /= 2;
  2219. tape->buffer_size = *ctl * tape->blk_size;
  2220. }
  2221. buffer_size = tape->buffer_size;
  2222. tape->pages_per_buffer = buffer_size / PAGE_SIZE;
  2223. if (buffer_size % PAGE_SIZE) {
  2224. tape->pages_per_buffer++;
  2225. tape->excess_bh_size = PAGE_SIZE - buffer_size % PAGE_SIZE;
  2226. }
  2227. /* select the "best" DSC read/write polling freq */
  2228. speed = max(*(u16 *)&tape->caps[14], *(u16 *)&tape->caps[8]);
  2229. t = (IDETAPE_FIFO_THRESHOLD * tape->buffer_size * HZ) / (speed * 1000);
  2230. /*
  2231. * Ensure that the number we got makes sense; limit it within
  2232. * IDETAPE_DSC_RW_MIN and IDETAPE_DSC_RW_MAX.
  2233. */
  2234. tape->best_dsc_rw_freq = clamp_t(unsigned long, t, IDETAPE_DSC_RW_MIN,
  2235. IDETAPE_DSC_RW_MAX);
  2236. printk(KERN_INFO "ide-tape: %s <-> %s: %dKBps, %d*%dkB buffer, "
  2237. "%lums tDSC%s\n",
  2238. drive->name, tape->name, *(u16 *)&tape->caps[14],
  2239. (*(u16 *)&tape->caps[16] * 512) / tape->buffer_size,
  2240. tape->buffer_size / 1024,
  2241. tape->best_dsc_rw_freq * 1000 / HZ,
  2242. drive->using_dma ? ", DMA":"");
  2243. idetape_add_settings(drive);
  2244. }
  2245. static void ide_tape_remove(ide_drive_t *drive)
  2246. {
  2247. idetape_tape_t *tape = drive->driver_data;
  2248. ide_proc_unregister_driver(drive, tape->driver);
  2249. ide_unregister_region(tape->disk);
  2250. ide_tape_put(tape);
  2251. }
  2252. static void ide_tape_release(struct kref *kref)
  2253. {
  2254. struct ide_tape_obj *tape = to_ide_tape(kref);
  2255. ide_drive_t *drive = tape->drive;
  2256. struct gendisk *g = tape->disk;
  2257. BUG_ON(tape->merge_bh_size);
  2258. drive->dsc_overlap = 0;
  2259. drive->driver_data = NULL;
  2260. device_destroy(idetape_sysfs_class, MKDEV(IDETAPE_MAJOR, tape->minor));
  2261. device_destroy(idetape_sysfs_class,
  2262. MKDEV(IDETAPE_MAJOR, tape->minor + 128));
  2263. idetape_devs[tape->minor] = NULL;
  2264. g->private_data = NULL;
  2265. put_disk(g);
  2266. kfree(tape);
  2267. }
  2268. #ifdef CONFIG_IDE_PROC_FS
  2269. static int proc_idetape_read_name
  2270. (char *page, char **start, off_t off, int count, int *eof, void *data)
  2271. {
  2272. ide_drive_t *drive = (ide_drive_t *) data;
  2273. idetape_tape_t *tape = drive->driver_data;
  2274. char *out = page;
  2275. int len;
  2276. len = sprintf(out, "%s\n", tape->name);
  2277. PROC_IDE_READ_RETURN(page, start, off, count, eof, len);
  2278. }
  2279. static ide_proc_entry_t idetape_proc[] = {
  2280. { "capacity", S_IFREG|S_IRUGO, proc_ide_read_capacity, NULL },
  2281. { "name", S_IFREG|S_IRUGO, proc_idetape_read_name, NULL },
  2282. { NULL, 0, NULL, NULL }
  2283. };
  2284. #endif
  2285. static int ide_tape_probe(ide_drive_t *);
  2286. static ide_driver_t idetape_driver = {
  2287. .gen_driver = {
  2288. .owner = THIS_MODULE,
  2289. .name = "ide-tape",
  2290. .bus = &ide_bus_type,
  2291. },
  2292. .probe = ide_tape_probe,
  2293. .remove = ide_tape_remove,
  2294. .version = IDETAPE_VERSION,
  2295. .media = ide_tape,
  2296. .supports_dsc_overlap = 1,
  2297. .do_request = idetape_do_request,
  2298. .end_request = idetape_end_request,
  2299. .error = __ide_error,
  2300. .abort = __ide_abort,
  2301. #ifdef CONFIG_IDE_PROC_FS
  2302. .proc = idetape_proc,
  2303. #endif
  2304. };
  2305. /* Our character device supporting functions, passed to register_chrdev. */
  2306. static const struct file_operations idetape_fops = {
  2307. .owner = THIS_MODULE,
  2308. .read = idetape_chrdev_read,
  2309. .write = idetape_chrdev_write,
  2310. .ioctl = idetape_chrdev_ioctl,
  2311. .open = idetape_chrdev_open,
  2312. .release = idetape_chrdev_release,
  2313. };
  2314. static int idetape_open(struct inode *inode, struct file *filp)
  2315. {
  2316. struct gendisk *disk = inode->i_bdev->bd_disk;
  2317. struct ide_tape_obj *tape;
  2318. tape = ide_tape_get(disk);
  2319. if (!tape)
  2320. return -ENXIO;
  2321. return 0;
  2322. }
  2323. static int idetape_release(struct inode *inode, struct file *filp)
  2324. {
  2325. struct gendisk *disk = inode->i_bdev->bd_disk;
  2326. struct ide_tape_obj *tape = ide_tape_g(disk);
  2327. ide_tape_put(tape);
  2328. return 0;
  2329. }
  2330. static int idetape_ioctl(struct inode *inode, struct file *file,
  2331. unsigned int cmd, unsigned long arg)
  2332. {
  2333. struct block_device *bdev = inode->i_bdev;
  2334. struct ide_tape_obj *tape = ide_tape_g(bdev->bd_disk);
  2335. ide_drive_t *drive = tape->drive;
  2336. int err = generic_ide_ioctl(drive, file, bdev, cmd, arg);
  2337. if (err == -EINVAL)
  2338. err = idetape_blkdev_ioctl(drive, cmd, arg);
  2339. return err;
  2340. }
  2341. static struct block_device_operations idetape_block_ops = {
  2342. .owner = THIS_MODULE,
  2343. .open = idetape_open,
  2344. .release = idetape_release,
  2345. .ioctl = idetape_ioctl,
  2346. };
  2347. static int ide_tape_probe(ide_drive_t *drive)
  2348. {
  2349. idetape_tape_t *tape;
  2350. struct gendisk *g;
  2351. int minor;
  2352. if (!strstr("ide-tape", drive->driver_req))
  2353. goto failed;
  2354. if (!drive->present)
  2355. goto failed;
  2356. if (drive->media != ide_tape)
  2357. goto failed;
  2358. if (!idetape_identify_device(drive)) {
  2359. printk(KERN_ERR "ide-tape: %s: not supported by this version of"
  2360. " the driver\n", drive->name);
  2361. goto failed;
  2362. }
  2363. tape = kzalloc(sizeof(idetape_tape_t), GFP_KERNEL);
  2364. if (tape == NULL) {
  2365. printk(KERN_ERR "ide-tape: %s: Can't allocate a tape struct\n",
  2366. drive->name);
  2367. goto failed;
  2368. }
  2369. g = alloc_disk(1 << PARTN_BITS);
  2370. if (!g)
  2371. goto out_free_tape;
  2372. ide_init_disk(g, drive);
  2373. ide_proc_register_driver(drive, &idetape_driver);
  2374. kref_init(&tape->kref);
  2375. tape->drive = drive;
  2376. tape->driver = &idetape_driver;
  2377. tape->disk = g;
  2378. g->private_data = &tape->driver;
  2379. drive->driver_data = tape;
  2380. mutex_lock(&idetape_ref_mutex);
  2381. for (minor = 0; idetape_devs[minor]; minor++)
  2382. ;
  2383. idetape_devs[minor] = tape;
  2384. mutex_unlock(&idetape_ref_mutex);
  2385. idetape_setup(drive, tape, minor);
  2386. device_create(idetape_sysfs_class, &drive->gendev,
  2387. MKDEV(IDETAPE_MAJOR, minor), "%s", tape->name);
  2388. device_create(idetape_sysfs_class, &drive->gendev,
  2389. MKDEV(IDETAPE_MAJOR, minor + 128), "n%s", tape->name);
  2390. g->fops = &idetape_block_ops;
  2391. ide_register_region(g);
  2392. return 0;
  2393. out_free_tape:
  2394. kfree(tape);
  2395. failed:
  2396. return -ENODEV;
  2397. }
  2398. static void __exit idetape_exit(void)
  2399. {
  2400. driver_unregister(&idetape_driver.gen_driver);
  2401. class_destroy(idetape_sysfs_class);
  2402. unregister_chrdev(IDETAPE_MAJOR, "ht");
  2403. }
  2404. static int __init idetape_init(void)
  2405. {
  2406. int error = 1;
  2407. idetape_sysfs_class = class_create(THIS_MODULE, "ide_tape");
  2408. if (IS_ERR(idetape_sysfs_class)) {
  2409. idetape_sysfs_class = NULL;
  2410. printk(KERN_ERR "Unable to create sysfs class for ide tapes\n");
  2411. error = -EBUSY;
  2412. goto out;
  2413. }
  2414. if (register_chrdev(IDETAPE_MAJOR, "ht", &idetape_fops)) {
  2415. printk(KERN_ERR "ide-tape: Failed to register chrdev"
  2416. " interface\n");
  2417. error = -EBUSY;
  2418. goto out_free_class;
  2419. }
  2420. error = driver_register(&idetape_driver.gen_driver);
  2421. if (error)
  2422. goto out_free_driver;
  2423. return 0;
  2424. out_free_driver:
  2425. driver_unregister(&idetape_driver.gen_driver);
  2426. out_free_class:
  2427. class_destroy(idetape_sysfs_class);
  2428. out:
  2429. return error;
  2430. }
  2431. MODULE_ALIAS("ide:*m-tape*");
  2432. module_init(idetape_init);
  2433. module_exit(idetape_exit);
  2434. MODULE_ALIAS_CHARDEV_MAJOR(IDETAPE_MAJOR);
  2435. MODULE_DESCRIPTION("ATAPI Streaming TAPE Driver");
  2436. MODULE_LICENSE("GPL");