blktrace.c 39 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724
  1. /*
  2. * Copyright (C) 2006 Jens Axboe <axboe@kernel.dk>
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License version 2 as
  6. * published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program; if not, write to the Free Software
  15. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
  16. *
  17. */
  18. #include <linux/kernel.h>
  19. #include <linux/blkdev.h>
  20. #include <linux/blktrace_api.h>
  21. #include <linux/percpu.h>
  22. #include <linux/init.h>
  23. #include <linux/mutex.h>
  24. #include <linux/debugfs.h>
  25. #include <linux/smp_lock.h>
  26. #include <linux/time.h>
  27. #include <linux/uaccess.h>
  28. #include <trace/events/block.h>
  29. #include "trace_output.h"
  30. #ifdef CONFIG_BLK_DEV_IO_TRACE
  31. static unsigned int blktrace_seq __read_mostly = 1;
  32. static struct trace_array *blk_tr;
  33. static bool blk_tracer_enabled __read_mostly;
  34. /* Select an alternative, minimalistic output than the original one */
  35. #define TRACE_BLK_OPT_CLASSIC 0x1
  36. static struct tracer_opt blk_tracer_opts[] = {
  37. /* Default disable the minimalistic output */
  38. { TRACER_OPT(blk_classic, TRACE_BLK_OPT_CLASSIC) },
  39. { }
  40. };
  41. static struct tracer_flags blk_tracer_flags = {
  42. .val = 0,
  43. .opts = blk_tracer_opts,
  44. };
  45. /* Global reference count of probes */
  46. static atomic_t blk_probes_ref = ATOMIC_INIT(0);
  47. static void blk_register_tracepoints(void);
  48. static void blk_unregister_tracepoints(void);
  49. /*
  50. * Send out a notify message.
  51. */
  52. static void trace_note(struct blk_trace *bt, pid_t pid, int action,
  53. const void *data, size_t len)
  54. {
  55. struct blk_io_trace *t;
  56. struct ring_buffer_event *event = NULL;
  57. int pc = 0;
  58. int cpu = smp_processor_id();
  59. bool blk_tracer = blk_tracer_enabled;
  60. if (blk_tracer) {
  61. pc = preempt_count();
  62. event = trace_buffer_lock_reserve(blk_tr, TRACE_BLK,
  63. sizeof(*t) + len,
  64. 0, pc);
  65. if (!event)
  66. return;
  67. t = ring_buffer_event_data(event);
  68. goto record_it;
  69. }
  70. if (!bt->rchan)
  71. return;
  72. t = relay_reserve(bt->rchan, sizeof(*t) + len);
  73. if (t) {
  74. t->magic = BLK_IO_TRACE_MAGIC | BLK_IO_TRACE_VERSION;
  75. t->time = ktime_to_ns(ktime_get());
  76. record_it:
  77. t->device = bt->dev;
  78. t->action = action;
  79. t->pid = pid;
  80. t->cpu = cpu;
  81. t->pdu_len = len;
  82. memcpy((void *) t + sizeof(*t), data, len);
  83. if (blk_tracer)
  84. trace_buffer_unlock_commit(blk_tr, event, 0, pc);
  85. }
  86. }
  87. /*
  88. * Send out a notify for this process, if we haven't done so since a trace
  89. * started
  90. */
  91. static void trace_note_tsk(struct blk_trace *bt, struct task_struct *tsk)
  92. {
  93. tsk->btrace_seq = blktrace_seq;
  94. trace_note(bt, tsk->pid, BLK_TN_PROCESS, tsk->comm, sizeof(tsk->comm));
  95. }
  96. static void trace_note_time(struct blk_trace *bt)
  97. {
  98. struct timespec now;
  99. unsigned long flags;
  100. u32 words[2];
  101. getnstimeofday(&now);
  102. words[0] = now.tv_sec;
  103. words[1] = now.tv_nsec;
  104. local_irq_save(flags);
  105. trace_note(bt, 0, BLK_TN_TIMESTAMP, words, sizeof(words));
  106. local_irq_restore(flags);
  107. }
  108. void __trace_note_message(struct blk_trace *bt, const char *fmt, ...)
  109. {
  110. int n;
  111. va_list args;
  112. unsigned long flags;
  113. char *buf;
  114. if (unlikely(bt->trace_state != Blktrace_running &&
  115. !blk_tracer_enabled))
  116. return;
  117. local_irq_save(flags);
  118. buf = per_cpu_ptr(bt->msg_data, smp_processor_id());
  119. va_start(args, fmt);
  120. n = vscnprintf(buf, BLK_TN_MAX_MSG, fmt, args);
  121. va_end(args);
  122. trace_note(bt, 0, BLK_TN_MESSAGE, buf, n);
  123. local_irq_restore(flags);
  124. }
  125. EXPORT_SYMBOL_GPL(__trace_note_message);
  126. static int act_log_check(struct blk_trace *bt, u32 what, sector_t sector,
  127. pid_t pid)
  128. {
  129. if (((bt->act_mask << BLK_TC_SHIFT) & what) == 0)
  130. return 1;
  131. if (sector && (sector < bt->start_lba || sector > bt->end_lba))
  132. return 1;
  133. if (bt->pid && pid != bt->pid)
  134. return 1;
  135. return 0;
  136. }
  137. /*
  138. * Data direction bit lookup
  139. */
  140. static const u32 ddir_act[2] = { BLK_TC_ACT(BLK_TC_READ),
  141. BLK_TC_ACT(BLK_TC_WRITE) };
  142. /* The ilog2() calls fall out because they're constant */
  143. #define MASK_TC_BIT(rw, __name) ((rw & (1 << BIO_RW_ ## __name)) << \
  144. (ilog2(BLK_TC_ ## __name) + BLK_TC_SHIFT - BIO_RW_ ## __name))
  145. /*
  146. * The worker for the various blk_add_trace*() types. Fills out a
  147. * blk_io_trace structure and places it in a per-cpu subbuffer.
  148. */
  149. static void __blk_add_trace(struct blk_trace *bt, sector_t sector, int bytes,
  150. int rw, u32 what, int error, int pdu_len, void *pdu_data)
  151. {
  152. struct task_struct *tsk = current;
  153. struct ring_buffer_event *event = NULL;
  154. struct blk_io_trace *t;
  155. unsigned long flags = 0;
  156. unsigned long *sequence;
  157. pid_t pid;
  158. int cpu, pc = 0;
  159. bool blk_tracer = blk_tracer_enabled;
  160. if (unlikely(bt->trace_state != Blktrace_running && !blk_tracer))
  161. return;
  162. what |= ddir_act[rw & WRITE];
  163. what |= MASK_TC_BIT(rw, BARRIER);
  164. what |= MASK_TC_BIT(rw, SYNCIO);
  165. what |= MASK_TC_BIT(rw, AHEAD);
  166. what |= MASK_TC_BIT(rw, META);
  167. what |= MASK_TC_BIT(rw, DISCARD);
  168. pid = tsk->pid;
  169. if (act_log_check(bt, what, sector, pid))
  170. return;
  171. cpu = raw_smp_processor_id();
  172. if (blk_tracer) {
  173. tracing_record_cmdline(current);
  174. pc = preempt_count();
  175. event = trace_buffer_lock_reserve(blk_tr, TRACE_BLK,
  176. sizeof(*t) + pdu_len,
  177. 0, pc);
  178. if (!event)
  179. return;
  180. t = ring_buffer_event_data(event);
  181. goto record_it;
  182. }
  183. /*
  184. * A word about the locking here - we disable interrupts to reserve
  185. * some space in the relay per-cpu buffer, to prevent an irq
  186. * from coming in and stepping on our toes.
  187. */
  188. local_irq_save(flags);
  189. if (unlikely(tsk->btrace_seq != blktrace_seq))
  190. trace_note_tsk(bt, tsk);
  191. t = relay_reserve(bt->rchan, sizeof(*t) + pdu_len);
  192. if (t) {
  193. sequence = per_cpu_ptr(bt->sequence, cpu);
  194. t->magic = BLK_IO_TRACE_MAGIC | BLK_IO_TRACE_VERSION;
  195. t->sequence = ++(*sequence);
  196. t->time = ktime_to_ns(ktime_get());
  197. record_it:
  198. /*
  199. * These two are not needed in ftrace as they are in the
  200. * generic trace_entry, filled by tracing_generic_entry_update,
  201. * but for the trace_event->bin() synthesizer benefit we do it
  202. * here too.
  203. */
  204. t->cpu = cpu;
  205. t->pid = pid;
  206. t->sector = sector;
  207. t->bytes = bytes;
  208. t->action = what;
  209. t->device = bt->dev;
  210. t->error = error;
  211. t->pdu_len = pdu_len;
  212. if (pdu_len)
  213. memcpy((void *) t + sizeof(*t), pdu_data, pdu_len);
  214. if (blk_tracer) {
  215. trace_buffer_unlock_commit(blk_tr, event, 0, pc);
  216. return;
  217. }
  218. }
  219. local_irq_restore(flags);
  220. }
  221. static struct dentry *blk_tree_root;
  222. static DEFINE_MUTEX(blk_tree_mutex);
  223. static void blk_trace_free(struct blk_trace *bt)
  224. {
  225. debugfs_remove(bt->msg_file);
  226. debugfs_remove(bt->dropped_file);
  227. relay_close(bt->rchan);
  228. debugfs_remove(bt->dir);
  229. free_percpu(bt->sequence);
  230. free_percpu(bt->msg_data);
  231. kfree(bt);
  232. }
  233. static void blk_trace_cleanup(struct blk_trace *bt)
  234. {
  235. blk_trace_free(bt);
  236. if (atomic_dec_and_test(&blk_probes_ref))
  237. blk_unregister_tracepoints();
  238. }
  239. int blk_trace_remove(struct request_queue *q)
  240. {
  241. struct blk_trace *bt;
  242. bt = xchg(&q->blk_trace, NULL);
  243. if (!bt)
  244. return -EINVAL;
  245. if (bt->trace_state != Blktrace_running)
  246. blk_trace_cleanup(bt);
  247. return 0;
  248. }
  249. EXPORT_SYMBOL_GPL(blk_trace_remove);
  250. static int blk_dropped_open(struct inode *inode, struct file *filp)
  251. {
  252. filp->private_data = inode->i_private;
  253. return 0;
  254. }
  255. static ssize_t blk_dropped_read(struct file *filp, char __user *buffer,
  256. size_t count, loff_t *ppos)
  257. {
  258. struct blk_trace *bt = filp->private_data;
  259. char buf[16];
  260. snprintf(buf, sizeof(buf), "%u\n", atomic_read(&bt->dropped));
  261. return simple_read_from_buffer(buffer, count, ppos, buf, strlen(buf));
  262. }
  263. static const struct file_operations blk_dropped_fops = {
  264. .owner = THIS_MODULE,
  265. .open = blk_dropped_open,
  266. .read = blk_dropped_read,
  267. };
  268. static int blk_msg_open(struct inode *inode, struct file *filp)
  269. {
  270. filp->private_data = inode->i_private;
  271. return 0;
  272. }
  273. static ssize_t blk_msg_write(struct file *filp, const char __user *buffer,
  274. size_t count, loff_t *ppos)
  275. {
  276. char *msg;
  277. struct blk_trace *bt;
  278. if (count >= BLK_TN_MAX_MSG)
  279. return -EINVAL;
  280. msg = kmalloc(count + 1, GFP_KERNEL);
  281. if (msg == NULL)
  282. return -ENOMEM;
  283. if (copy_from_user(msg, buffer, count)) {
  284. kfree(msg);
  285. return -EFAULT;
  286. }
  287. msg[count] = '\0';
  288. bt = filp->private_data;
  289. __trace_note_message(bt, "%s", msg);
  290. kfree(msg);
  291. return count;
  292. }
  293. static const struct file_operations blk_msg_fops = {
  294. .owner = THIS_MODULE,
  295. .open = blk_msg_open,
  296. .write = blk_msg_write,
  297. };
  298. /*
  299. * Keep track of how many times we encountered a full subbuffer, to aid
  300. * the user space app in telling how many lost events there were.
  301. */
  302. static int blk_subbuf_start_callback(struct rchan_buf *buf, void *subbuf,
  303. void *prev_subbuf, size_t prev_padding)
  304. {
  305. struct blk_trace *bt;
  306. if (!relay_buf_full(buf))
  307. return 1;
  308. bt = buf->chan->private_data;
  309. atomic_inc(&bt->dropped);
  310. return 0;
  311. }
  312. static int blk_remove_buf_file_callback(struct dentry *dentry)
  313. {
  314. debugfs_remove(dentry);
  315. return 0;
  316. }
  317. static struct dentry *blk_create_buf_file_callback(const char *filename,
  318. struct dentry *parent,
  319. int mode,
  320. struct rchan_buf *buf,
  321. int *is_global)
  322. {
  323. return debugfs_create_file(filename, mode, parent, buf,
  324. &relay_file_operations);
  325. }
  326. static struct rchan_callbacks blk_relay_callbacks = {
  327. .subbuf_start = blk_subbuf_start_callback,
  328. .create_buf_file = blk_create_buf_file_callback,
  329. .remove_buf_file = blk_remove_buf_file_callback,
  330. };
  331. static void blk_trace_setup_lba(struct blk_trace *bt,
  332. struct block_device *bdev)
  333. {
  334. struct hd_struct *part = NULL;
  335. if (bdev)
  336. part = bdev->bd_part;
  337. if (part) {
  338. bt->start_lba = part->start_sect;
  339. bt->end_lba = part->start_sect + part->nr_sects;
  340. } else {
  341. bt->start_lba = 0;
  342. bt->end_lba = -1ULL;
  343. }
  344. }
  345. /*
  346. * Setup everything required to start tracing
  347. */
  348. int do_blk_trace_setup(struct request_queue *q, char *name, dev_t dev,
  349. struct block_device *bdev,
  350. struct blk_user_trace_setup *buts)
  351. {
  352. struct blk_trace *old_bt, *bt = NULL;
  353. struct dentry *dir = NULL;
  354. int ret, i;
  355. if (!buts->buf_size || !buts->buf_nr)
  356. return -EINVAL;
  357. strncpy(buts->name, name, BLKTRACE_BDEV_SIZE);
  358. buts->name[BLKTRACE_BDEV_SIZE - 1] = '\0';
  359. /*
  360. * some device names have larger paths - convert the slashes
  361. * to underscores for this to work as expected
  362. */
  363. for (i = 0; i < strlen(buts->name); i++)
  364. if (buts->name[i] == '/')
  365. buts->name[i] = '_';
  366. bt = kzalloc(sizeof(*bt), GFP_KERNEL);
  367. if (!bt)
  368. return -ENOMEM;
  369. ret = -ENOMEM;
  370. bt->sequence = alloc_percpu(unsigned long);
  371. if (!bt->sequence)
  372. goto err;
  373. bt->msg_data = __alloc_percpu(BLK_TN_MAX_MSG, __alignof__(char));
  374. if (!bt->msg_data)
  375. goto err;
  376. ret = -ENOENT;
  377. mutex_lock(&blk_tree_mutex);
  378. if (!blk_tree_root) {
  379. blk_tree_root = debugfs_create_dir("block", NULL);
  380. if (!blk_tree_root) {
  381. mutex_unlock(&blk_tree_mutex);
  382. goto err;
  383. }
  384. }
  385. mutex_unlock(&blk_tree_mutex);
  386. dir = debugfs_create_dir(buts->name, blk_tree_root);
  387. if (!dir)
  388. goto err;
  389. bt->dir = dir;
  390. bt->dev = dev;
  391. atomic_set(&bt->dropped, 0);
  392. ret = -EIO;
  393. bt->dropped_file = debugfs_create_file("dropped", 0444, dir, bt,
  394. &blk_dropped_fops);
  395. if (!bt->dropped_file)
  396. goto err;
  397. bt->msg_file = debugfs_create_file("msg", 0222, dir, bt, &blk_msg_fops);
  398. if (!bt->msg_file)
  399. goto err;
  400. bt->rchan = relay_open("trace", dir, buts->buf_size,
  401. buts->buf_nr, &blk_relay_callbacks, bt);
  402. if (!bt->rchan)
  403. goto err;
  404. bt->act_mask = buts->act_mask;
  405. if (!bt->act_mask)
  406. bt->act_mask = (u16) -1;
  407. blk_trace_setup_lba(bt, bdev);
  408. /* overwrite with user settings */
  409. if (buts->start_lba)
  410. bt->start_lba = buts->start_lba;
  411. if (buts->end_lba)
  412. bt->end_lba = buts->end_lba;
  413. bt->pid = buts->pid;
  414. bt->trace_state = Blktrace_setup;
  415. ret = -EBUSY;
  416. old_bt = xchg(&q->blk_trace, bt);
  417. if (old_bt) {
  418. (void) xchg(&q->blk_trace, old_bt);
  419. goto err;
  420. }
  421. if (atomic_inc_return(&blk_probes_ref) == 1)
  422. blk_register_tracepoints();
  423. return 0;
  424. err:
  425. blk_trace_free(bt);
  426. return ret;
  427. }
  428. int blk_trace_setup(struct request_queue *q, char *name, dev_t dev,
  429. struct block_device *bdev,
  430. char __user *arg)
  431. {
  432. struct blk_user_trace_setup buts;
  433. int ret;
  434. ret = copy_from_user(&buts, arg, sizeof(buts));
  435. if (ret)
  436. return -EFAULT;
  437. ret = do_blk_trace_setup(q, name, dev, bdev, &buts);
  438. if (ret)
  439. return ret;
  440. if (copy_to_user(arg, &buts, sizeof(buts)))
  441. return -EFAULT;
  442. return 0;
  443. }
  444. EXPORT_SYMBOL_GPL(blk_trace_setup);
  445. int blk_trace_startstop(struct request_queue *q, int start)
  446. {
  447. int ret;
  448. struct blk_trace *bt = q->blk_trace;
  449. if (bt == NULL)
  450. return -EINVAL;
  451. /*
  452. * For starting a trace, we can transition from a setup or stopped
  453. * trace. For stopping a trace, the state must be running
  454. */
  455. ret = -EINVAL;
  456. if (start) {
  457. if (bt->trace_state == Blktrace_setup ||
  458. bt->trace_state == Blktrace_stopped) {
  459. blktrace_seq++;
  460. smp_mb();
  461. bt->trace_state = Blktrace_running;
  462. trace_note_time(bt);
  463. ret = 0;
  464. }
  465. } else {
  466. if (bt->trace_state == Blktrace_running) {
  467. bt->trace_state = Blktrace_stopped;
  468. relay_flush(bt->rchan);
  469. ret = 0;
  470. }
  471. }
  472. return ret;
  473. }
  474. EXPORT_SYMBOL_GPL(blk_trace_startstop);
  475. /**
  476. * blk_trace_ioctl: - handle the ioctls associated with tracing
  477. * @bdev: the block device
  478. * @cmd: the ioctl cmd
  479. * @arg: the argument data, if any
  480. *
  481. **/
  482. int blk_trace_ioctl(struct block_device *bdev, unsigned cmd, char __user *arg)
  483. {
  484. struct request_queue *q;
  485. int ret, start = 0;
  486. char b[BDEVNAME_SIZE];
  487. q = bdev_get_queue(bdev);
  488. if (!q)
  489. return -ENXIO;
  490. mutex_lock(&bdev->bd_mutex);
  491. switch (cmd) {
  492. case BLKTRACESETUP:
  493. bdevname(bdev, b);
  494. ret = blk_trace_setup(q, b, bdev->bd_dev, bdev, arg);
  495. break;
  496. case BLKTRACESTART:
  497. start = 1;
  498. case BLKTRACESTOP:
  499. ret = blk_trace_startstop(q, start);
  500. break;
  501. case BLKTRACETEARDOWN:
  502. ret = blk_trace_remove(q);
  503. break;
  504. default:
  505. ret = -ENOTTY;
  506. break;
  507. }
  508. mutex_unlock(&bdev->bd_mutex);
  509. return ret;
  510. }
  511. /**
  512. * blk_trace_shutdown: - stop and cleanup trace structures
  513. * @q: the request queue associated with the device
  514. *
  515. **/
  516. void blk_trace_shutdown(struct request_queue *q)
  517. {
  518. if (q->blk_trace) {
  519. blk_trace_startstop(q, 0);
  520. blk_trace_remove(q);
  521. }
  522. }
  523. /*
  524. * blktrace probes
  525. */
  526. /**
  527. * blk_add_trace_rq - Add a trace for a request oriented action
  528. * @q: queue the io is for
  529. * @rq: the source request
  530. * @what: the action
  531. *
  532. * Description:
  533. * Records an action against a request. Will log the bio offset + size.
  534. *
  535. **/
  536. static void blk_add_trace_rq(struct request_queue *q, struct request *rq,
  537. u32 what)
  538. {
  539. struct blk_trace *bt = q->blk_trace;
  540. int rw = rq->cmd_flags & 0x03;
  541. if (likely(!bt))
  542. return;
  543. if (blk_discard_rq(rq))
  544. rw |= (1 << BIO_RW_DISCARD);
  545. if (blk_pc_request(rq)) {
  546. what |= BLK_TC_ACT(BLK_TC_PC);
  547. __blk_add_trace(bt, 0, blk_rq_bytes(rq), rw,
  548. what, rq->errors, rq->cmd_len, rq->cmd);
  549. } else {
  550. what |= BLK_TC_ACT(BLK_TC_FS);
  551. __blk_add_trace(bt, blk_rq_pos(rq), blk_rq_bytes(rq), rw,
  552. what, rq->errors, 0, NULL);
  553. }
  554. }
  555. static void blk_add_trace_rq_abort(struct request_queue *q, struct request *rq)
  556. {
  557. blk_add_trace_rq(q, rq, BLK_TA_ABORT);
  558. }
  559. static void blk_add_trace_rq_insert(struct request_queue *q, struct request *rq)
  560. {
  561. blk_add_trace_rq(q, rq, BLK_TA_INSERT);
  562. }
  563. static void blk_add_trace_rq_issue(struct request_queue *q, struct request *rq)
  564. {
  565. blk_add_trace_rq(q, rq, BLK_TA_ISSUE);
  566. }
  567. static void blk_add_trace_rq_requeue(struct request_queue *q,
  568. struct request *rq)
  569. {
  570. blk_add_trace_rq(q, rq, BLK_TA_REQUEUE);
  571. }
  572. static void blk_add_trace_rq_complete(struct request_queue *q,
  573. struct request *rq)
  574. {
  575. blk_add_trace_rq(q, rq, BLK_TA_COMPLETE);
  576. }
  577. /**
  578. * blk_add_trace_bio - Add a trace for a bio oriented action
  579. * @q: queue the io is for
  580. * @bio: the source bio
  581. * @what: the action
  582. *
  583. * Description:
  584. * Records an action against a bio. Will log the bio offset + size.
  585. *
  586. **/
  587. static void blk_add_trace_bio(struct request_queue *q, struct bio *bio,
  588. u32 what)
  589. {
  590. struct blk_trace *bt = q->blk_trace;
  591. if (likely(!bt))
  592. return;
  593. __blk_add_trace(bt, bio->bi_sector, bio->bi_size, bio->bi_rw, what,
  594. !bio_flagged(bio, BIO_UPTODATE), 0, NULL);
  595. }
  596. static void blk_add_trace_bio_bounce(struct request_queue *q, struct bio *bio)
  597. {
  598. blk_add_trace_bio(q, bio, BLK_TA_BOUNCE);
  599. }
  600. static void blk_add_trace_bio_complete(struct request_queue *q, struct bio *bio)
  601. {
  602. blk_add_trace_bio(q, bio, BLK_TA_COMPLETE);
  603. }
  604. static void blk_add_trace_bio_backmerge(struct request_queue *q,
  605. struct bio *bio)
  606. {
  607. blk_add_trace_bio(q, bio, BLK_TA_BACKMERGE);
  608. }
  609. static void blk_add_trace_bio_frontmerge(struct request_queue *q,
  610. struct bio *bio)
  611. {
  612. blk_add_trace_bio(q, bio, BLK_TA_FRONTMERGE);
  613. }
  614. static void blk_add_trace_bio_queue(struct request_queue *q, struct bio *bio)
  615. {
  616. blk_add_trace_bio(q, bio, BLK_TA_QUEUE);
  617. }
  618. static void blk_add_trace_getrq(struct request_queue *q,
  619. struct bio *bio, int rw)
  620. {
  621. if (bio)
  622. blk_add_trace_bio(q, bio, BLK_TA_GETRQ);
  623. else {
  624. struct blk_trace *bt = q->blk_trace;
  625. if (bt)
  626. __blk_add_trace(bt, 0, 0, rw, BLK_TA_GETRQ, 0, 0, NULL);
  627. }
  628. }
  629. static void blk_add_trace_sleeprq(struct request_queue *q,
  630. struct bio *bio, int rw)
  631. {
  632. if (bio)
  633. blk_add_trace_bio(q, bio, BLK_TA_SLEEPRQ);
  634. else {
  635. struct blk_trace *bt = q->blk_trace;
  636. if (bt)
  637. __blk_add_trace(bt, 0, 0, rw, BLK_TA_SLEEPRQ,
  638. 0, 0, NULL);
  639. }
  640. }
  641. static void blk_add_trace_plug(struct request_queue *q)
  642. {
  643. struct blk_trace *bt = q->blk_trace;
  644. if (bt)
  645. __blk_add_trace(bt, 0, 0, 0, BLK_TA_PLUG, 0, 0, NULL);
  646. }
  647. static void blk_add_trace_unplug_io(struct request_queue *q)
  648. {
  649. struct blk_trace *bt = q->blk_trace;
  650. if (bt) {
  651. unsigned int pdu = q->rq.count[READ] + q->rq.count[WRITE];
  652. __be64 rpdu = cpu_to_be64(pdu);
  653. __blk_add_trace(bt, 0, 0, 0, BLK_TA_UNPLUG_IO, 0,
  654. sizeof(rpdu), &rpdu);
  655. }
  656. }
  657. static void blk_add_trace_unplug_timer(struct request_queue *q)
  658. {
  659. struct blk_trace *bt = q->blk_trace;
  660. if (bt) {
  661. unsigned int pdu = q->rq.count[READ] + q->rq.count[WRITE];
  662. __be64 rpdu = cpu_to_be64(pdu);
  663. __blk_add_trace(bt, 0, 0, 0, BLK_TA_UNPLUG_TIMER, 0,
  664. sizeof(rpdu), &rpdu);
  665. }
  666. }
  667. static void blk_add_trace_split(struct request_queue *q, struct bio *bio,
  668. unsigned int pdu)
  669. {
  670. struct blk_trace *bt = q->blk_trace;
  671. if (bt) {
  672. __be64 rpdu = cpu_to_be64(pdu);
  673. __blk_add_trace(bt, bio->bi_sector, bio->bi_size, bio->bi_rw,
  674. BLK_TA_SPLIT, !bio_flagged(bio, BIO_UPTODATE),
  675. sizeof(rpdu), &rpdu);
  676. }
  677. }
  678. /**
  679. * blk_add_trace_remap - Add a trace for a remap operation
  680. * @q: queue the io is for
  681. * @bio: the source bio
  682. * @dev: target device
  683. * @from: source sector
  684. *
  685. * Description:
  686. * Device mapper or raid target sometimes need to split a bio because
  687. * it spans a stripe (or similar). Add a trace for that action.
  688. *
  689. **/
  690. static void blk_add_trace_remap(struct request_queue *q, struct bio *bio,
  691. dev_t dev, sector_t from)
  692. {
  693. struct blk_trace *bt = q->blk_trace;
  694. struct blk_io_trace_remap r;
  695. if (likely(!bt))
  696. return;
  697. r.device_from = cpu_to_be32(dev);
  698. r.device_to = cpu_to_be32(bio->bi_bdev->bd_dev);
  699. r.sector_from = cpu_to_be64(from);
  700. __blk_add_trace(bt, bio->bi_sector, bio->bi_size, bio->bi_rw,
  701. BLK_TA_REMAP, !bio_flagged(bio, BIO_UPTODATE),
  702. sizeof(r), &r);
  703. }
  704. /**
  705. * blk_add_driver_data - Add binary message with driver-specific data
  706. * @q: queue the io is for
  707. * @rq: io request
  708. * @data: driver-specific data
  709. * @len: length of driver-specific data
  710. *
  711. * Description:
  712. * Some drivers might want to write driver-specific data per request.
  713. *
  714. **/
  715. void blk_add_driver_data(struct request_queue *q,
  716. struct request *rq,
  717. void *data, size_t len)
  718. {
  719. struct blk_trace *bt = q->blk_trace;
  720. if (likely(!bt))
  721. return;
  722. if (blk_pc_request(rq))
  723. __blk_add_trace(bt, 0, blk_rq_bytes(rq), 0,
  724. BLK_TA_DRV_DATA, rq->errors, len, data);
  725. else
  726. __blk_add_trace(bt, blk_rq_pos(rq), blk_rq_bytes(rq), 0,
  727. BLK_TA_DRV_DATA, rq->errors, len, data);
  728. }
  729. EXPORT_SYMBOL_GPL(blk_add_driver_data);
  730. static void blk_register_tracepoints(void)
  731. {
  732. int ret;
  733. ret = register_trace_block_rq_abort(blk_add_trace_rq_abort);
  734. WARN_ON(ret);
  735. ret = register_trace_block_rq_insert(blk_add_trace_rq_insert);
  736. WARN_ON(ret);
  737. ret = register_trace_block_rq_issue(blk_add_trace_rq_issue);
  738. WARN_ON(ret);
  739. ret = register_trace_block_rq_requeue(blk_add_trace_rq_requeue);
  740. WARN_ON(ret);
  741. ret = register_trace_block_rq_complete(blk_add_trace_rq_complete);
  742. WARN_ON(ret);
  743. ret = register_trace_block_bio_bounce(blk_add_trace_bio_bounce);
  744. WARN_ON(ret);
  745. ret = register_trace_block_bio_complete(blk_add_trace_bio_complete);
  746. WARN_ON(ret);
  747. ret = register_trace_block_bio_backmerge(blk_add_trace_bio_backmerge);
  748. WARN_ON(ret);
  749. ret = register_trace_block_bio_frontmerge(blk_add_trace_bio_frontmerge);
  750. WARN_ON(ret);
  751. ret = register_trace_block_bio_queue(blk_add_trace_bio_queue);
  752. WARN_ON(ret);
  753. ret = register_trace_block_getrq(blk_add_trace_getrq);
  754. WARN_ON(ret);
  755. ret = register_trace_block_sleeprq(blk_add_trace_sleeprq);
  756. WARN_ON(ret);
  757. ret = register_trace_block_plug(blk_add_trace_plug);
  758. WARN_ON(ret);
  759. ret = register_trace_block_unplug_timer(blk_add_trace_unplug_timer);
  760. WARN_ON(ret);
  761. ret = register_trace_block_unplug_io(blk_add_trace_unplug_io);
  762. WARN_ON(ret);
  763. ret = register_trace_block_split(blk_add_trace_split);
  764. WARN_ON(ret);
  765. ret = register_trace_block_remap(blk_add_trace_remap);
  766. WARN_ON(ret);
  767. }
  768. static void blk_unregister_tracepoints(void)
  769. {
  770. unregister_trace_block_remap(blk_add_trace_remap);
  771. unregister_trace_block_split(blk_add_trace_split);
  772. unregister_trace_block_unplug_io(blk_add_trace_unplug_io);
  773. unregister_trace_block_unplug_timer(blk_add_trace_unplug_timer);
  774. unregister_trace_block_plug(blk_add_trace_plug);
  775. unregister_trace_block_sleeprq(blk_add_trace_sleeprq);
  776. unregister_trace_block_getrq(blk_add_trace_getrq);
  777. unregister_trace_block_bio_queue(blk_add_trace_bio_queue);
  778. unregister_trace_block_bio_frontmerge(blk_add_trace_bio_frontmerge);
  779. unregister_trace_block_bio_backmerge(blk_add_trace_bio_backmerge);
  780. unregister_trace_block_bio_complete(blk_add_trace_bio_complete);
  781. unregister_trace_block_bio_bounce(blk_add_trace_bio_bounce);
  782. unregister_trace_block_rq_complete(blk_add_trace_rq_complete);
  783. unregister_trace_block_rq_requeue(blk_add_trace_rq_requeue);
  784. unregister_trace_block_rq_issue(blk_add_trace_rq_issue);
  785. unregister_trace_block_rq_insert(blk_add_trace_rq_insert);
  786. unregister_trace_block_rq_abort(blk_add_trace_rq_abort);
  787. tracepoint_synchronize_unregister();
  788. }
  789. /*
  790. * struct blk_io_tracer formatting routines
  791. */
  792. static void fill_rwbs(char *rwbs, const struct blk_io_trace *t)
  793. {
  794. int i = 0;
  795. int tc = t->action >> BLK_TC_SHIFT;
  796. if (t->action == BLK_TN_MESSAGE) {
  797. rwbs[i++] = 'N';
  798. goto out;
  799. }
  800. if (tc & BLK_TC_DISCARD)
  801. rwbs[i++] = 'D';
  802. else if (tc & BLK_TC_WRITE)
  803. rwbs[i++] = 'W';
  804. else if (t->bytes)
  805. rwbs[i++] = 'R';
  806. else
  807. rwbs[i++] = 'N';
  808. if (tc & BLK_TC_AHEAD)
  809. rwbs[i++] = 'A';
  810. if (tc & BLK_TC_BARRIER)
  811. rwbs[i++] = 'B';
  812. if (tc & BLK_TC_SYNC)
  813. rwbs[i++] = 'S';
  814. if (tc & BLK_TC_META)
  815. rwbs[i++] = 'M';
  816. out:
  817. rwbs[i] = '\0';
  818. }
  819. static inline
  820. const struct blk_io_trace *te_blk_io_trace(const struct trace_entry *ent)
  821. {
  822. return (const struct blk_io_trace *)ent;
  823. }
  824. static inline const void *pdu_start(const struct trace_entry *ent)
  825. {
  826. return te_blk_io_trace(ent) + 1;
  827. }
  828. static inline u32 t_action(const struct trace_entry *ent)
  829. {
  830. return te_blk_io_trace(ent)->action;
  831. }
  832. static inline u32 t_bytes(const struct trace_entry *ent)
  833. {
  834. return te_blk_io_trace(ent)->bytes;
  835. }
  836. static inline u32 t_sec(const struct trace_entry *ent)
  837. {
  838. return te_blk_io_trace(ent)->bytes >> 9;
  839. }
  840. static inline unsigned long long t_sector(const struct trace_entry *ent)
  841. {
  842. return te_blk_io_trace(ent)->sector;
  843. }
  844. static inline __u16 t_error(const struct trace_entry *ent)
  845. {
  846. return te_blk_io_trace(ent)->error;
  847. }
  848. static __u64 get_pdu_int(const struct trace_entry *ent)
  849. {
  850. const __u64 *val = pdu_start(ent);
  851. return be64_to_cpu(*val);
  852. }
  853. static void get_pdu_remap(const struct trace_entry *ent,
  854. struct blk_io_trace_remap *r)
  855. {
  856. const struct blk_io_trace_remap *__r = pdu_start(ent);
  857. __u64 sector_from = __r->sector_from;
  858. r->device_from = be32_to_cpu(__r->device_from);
  859. r->device_to = be32_to_cpu(__r->device_to);
  860. r->sector_from = be64_to_cpu(sector_from);
  861. }
  862. typedef int (blk_log_action_t) (struct trace_iterator *iter, const char *act);
  863. static int blk_log_action_classic(struct trace_iterator *iter, const char *act)
  864. {
  865. char rwbs[6];
  866. unsigned long long ts = iter->ts;
  867. unsigned long nsec_rem = do_div(ts, NSEC_PER_SEC);
  868. unsigned secs = (unsigned long)ts;
  869. const struct blk_io_trace *t = te_blk_io_trace(iter->ent);
  870. fill_rwbs(rwbs, t);
  871. return trace_seq_printf(&iter->seq,
  872. "%3d,%-3d %2d %5d.%09lu %5u %2s %3s ",
  873. MAJOR(t->device), MINOR(t->device), iter->cpu,
  874. secs, nsec_rem, iter->ent->pid, act, rwbs);
  875. }
  876. static int blk_log_action(struct trace_iterator *iter, const char *act)
  877. {
  878. char rwbs[6];
  879. const struct blk_io_trace *t = te_blk_io_trace(iter->ent);
  880. fill_rwbs(rwbs, t);
  881. return trace_seq_printf(&iter->seq, "%3d,%-3d %2s %3s ",
  882. MAJOR(t->device), MINOR(t->device), act, rwbs);
  883. }
  884. static int blk_log_dump_pdu(struct trace_seq *s, const struct trace_entry *ent)
  885. {
  886. const unsigned char *pdu_buf;
  887. int pdu_len;
  888. int i, end, ret;
  889. pdu_buf = pdu_start(ent);
  890. pdu_len = te_blk_io_trace(ent)->pdu_len;
  891. if (!pdu_len)
  892. return 1;
  893. /* find the last zero that needs to be printed */
  894. for (end = pdu_len - 1; end >= 0; end--)
  895. if (pdu_buf[end])
  896. break;
  897. end++;
  898. if (!trace_seq_putc(s, '('))
  899. return 0;
  900. for (i = 0; i < pdu_len; i++) {
  901. ret = trace_seq_printf(s, "%s%02x",
  902. i == 0 ? "" : " ", pdu_buf[i]);
  903. if (!ret)
  904. return ret;
  905. /*
  906. * stop when the rest is just zeroes and indicate so
  907. * with a ".." appended
  908. */
  909. if (i == end && end != pdu_len - 1)
  910. return trace_seq_puts(s, " ..) ");
  911. }
  912. return trace_seq_puts(s, ") ");
  913. }
  914. static int blk_log_generic(struct trace_seq *s, const struct trace_entry *ent)
  915. {
  916. char cmd[TASK_COMM_LEN];
  917. trace_find_cmdline(ent->pid, cmd);
  918. if (t_action(ent) & BLK_TC_ACT(BLK_TC_PC)) {
  919. int ret;
  920. ret = trace_seq_printf(s, "%u ", t_bytes(ent));
  921. if (!ret)
  922. return 0;
  923. ret = blk_log_dump_pdu(s, ent);
  924. if (!ret)
  925. return 0;
  926. return trace_seq_printf(s, "[%s]\n", cmd);
  927. } else {
  928. if (t_sec(ent))
  929. return trace_seq_printf(s, "%llu + %u [%s]\n",
  930. t_sector(ent), t_sec(ent), cmd);
  931. return trace_seq_printf(s, "[%s]\n", cmd);
  932. }
  933. }
  934. static int blk_log_with_error(struct trace_seq *s,
  935. const struct trace_entry *ent)
  936. {
  937. if (t_action(ent) & BLK_TC_ACT(BLK_TC_PC)) {
  938. int ret;
  939. ret = blk_log_dump_pdu(s, ent);
  940. if (ret)
  941. return trace_seq_printf(s, "[%d]\n", t_error(ent));
  942. return 0;
  943. } else {
  944. if (t_sec(ent))
  945. return trace_seq_printf(s, "%llu + %u [%d]\n",
  946. t_sector(ent),
  947. t_sec(ent), t_error(ent));
  948. return trace_seq_printf(s, "%llu [%d]\n",
  949. t_sector(ent), t_error(ent));
  950. }
  951. }
  952. static int blk_log_remap(struct trace_seq *s, const struct trace_entry *ent)
  953. {
  954. struct blk_io_trace_remap r = { .device_from = 0, };
  955. get_pdu_remap(ent, &r);
  956. return trace_seq_printf(s, "%llu + %u <- (%d,%d) %llu\n",
  957. t_sector(ent), t_sec(ent),
  958. MAJOR(r.device_from), MINOR(r.device_from),
  959. (unsigned long long)r.sector_from);
  960. }
  961. static int blk_log_plug(struct trace_seq *s, const struct trace_entry *ent)
  962. {
  963. char cmd[TASK_COMM_LEN];
  964. trace_find_cmdline(ent->pid, cmd);
  965. return trace_seq_printf(s, "[%s]\n", cmd);
  966. }
  967. static int blk_log_unplug(struct trace_seq *s, const struct trace_entry *ent)
  968. {
  969. char cmd[TASK_COMM_LEN];
  970. trace_find_cmdline(ent->pid, cmd);
  971. return trace_seq_printf(s, "[%s] %llu\n", cmd, get_pdu_int(ent));
  972. }
  973. static int blk_log_split(struct trace_seq *s, const struct trace_entry *ent)
  974. {
  975. char cmd[TASK_COMM_LEN];
  976. trace_find_cmdline(ent->pid, cmd);
  977. return trace_seq_printf(s, "%llu / %llu [%s]\n", t_sector(ent),
  978. get_pdu_int(ent), cmd);
  979. }
  980. static int blk_log_msg(struct trace_seq *s, const struct trace_entry *ent)
  981. {
  982. int ret;
  983. const struct blk_io_trace *t = te_blk_io_trace(ent);
  984. ret = trace_seq_putmem(s, t + 1, t->pdu_len);
  985. if (ret)
  986. return trace_seq_putc(s, '\n');
  987. return ret;
  988. }
  989. /*
  990. * struct tracer operations
  991. */
  992. static void blk_tracer_print_header(struct seq_file *m)
  993. {
  994. if (!(blk_tracer_flags.val & TRACE_BLK_OPT_CLASSIC))
  995. return;
  996. seq_puts(m, "# DEV CPU TIMESTAMP PID ACT FLG\n"
  997. "# | | | | | |\n");
  998. }
  999. static void blk_tracer_start(struct trace_array *tr)
  1000. {
  1001. blk_tracer_enabled = true;
  1002. }
  1003. static int blk_tracer_init(struct trace_array *tr)
  1004. {
  1005. blk_tr = tr;
  1006. blk_tracer_start(tr);
  1007. return 0;
  1008. }
  1009. static void blk_tracer_stop(struct trace_array *tr)
  1010. {
  1011. blk_tracer_enabled = false;
  1012. }
  1013. static void blk_tracer_reset(struct trace_array *tr)
  1014. {
  1015. blk_tracer_stop(tr);
  1016. }
  1017. static const struct {
  1018. const char *act[2];
  1019. int (*print)(struct trace_seq *s, const struct trace_entry *ent);
  1020. } what2act[] = {
  1021. [__BLK_TA_QUEUE] = {{ "Q", "queue" }, blk_log_generic },
  1022. [__BLK_TA_BACKMERGE] = {{ "M", "backmerge" }, blk_log_generic },
  1023. [__BLK_TA_FRONTMERGE] = {{ "F", "frontmerge" }, blk_log_generic },
  1024. [__BLK_TA_GETRQ] = {{ "G", "getrq" }, blk_log_generic },
  1025. [__BLK_TA_SLEEPRQ] = {{ "S", "sleeprq" }, blk_log_generic },
  1026. [__BLK_TA_REQUEUE] = {{ "R", "requeue" }, blk_log_with_error },
  1027. [__BLK_TA_ISSUE] = {{ "D", "issue" }, blk_log_generic },
  1028. [__BLK_TA_COMPLETE] = {{ "C", "complete" }, blk_log_with_error },
  1029. [__BLK_TA_PLUG] = {{ "P", "plug" }, blk_log_plug },
  1030. [__BLK_TA_UNPLUG_IO] = {{ "U", "unplug_io" }, blk_log_unplug },
  1031. [__BLK_TA_UNPLUG_TIMER] = {{ "UT", "unplug_timer" }, blk_log_unplug },
  1032. [__BLK_TA_INSERT] = {{ "I", "insert" }, blk_log_generic },
  1033. [__BLK_TA_SPLIT] = {{ "X", "split" }, blk_log_split },
  1034. [__BLK_TA_BOUNCE] = {{ "B", "bounce" }, blk_log_generic },
  1035. [__BLK_TA_REMAP] = {{ "A", "remap" }, blk_log_remap },
  1036. };
  1037. static enum print_line_t print_one_line(struct trace_iterator *iter,
  1038. bool classic)
  1039. {
  1040. struct trace_seq *s = &iter->seq;
  1041. const struct blk_io_trace *t;
  1042. u16 what;
  1043. int ret;
  1044. bool long_act;
  1045. blk_log_action_t *log_action;
  1046. t = te_blk_io_trace(iter->ent);
  1047. what = t->action & ((1 << BLK_TC_SHIFT) - 1);
  1048. long_act = !!(trace_flags & TRACE_ITER_VERBOSE);
  1049. log_action = classic ? &blk_log_action_classic : &blk_log_action;
  1050. if (t->action == BLK_TN_MESSAGE) {
  1051. ret = log_action(iter, long_act ? "message" : "m");
  1052. if (ret)
  1053. ret = blk_log_msg(s, iter->ent);
  1054. goto out;
  1055. }
  1056. if (unlikely(what == 0 || what >= ARRAY_SIZE(what2act)))
  1057. ret = trace_seq_printf(s, "Unknown action %x\n", what);
  1058. else {
  1059. ret = log_action(iter, what2act[what].act[long_act]);
  1060. if (ret)
  1061. ret = what2act[what].print(s, iter->ent);
  1062. }
  1063. out:
  1064. return ret ? TRACE_TYPE_HANDLED : TRACE_TYPE_PARTIAL_LINE;
  1065. }
  1066. static enum print_line_t blk_trace_event_print(struct trace_iterator *iter,
  1067. int flags)
  1068. {
  1069. return print_one_line(iter, false);
  1070. }
  1071. static int blk_trace_synthesize_old_trace(struct trace_iterator *iter)
  1072. {
  1073. struct trace_seq *s = &iter->seq;
  1074. struct blk_io_trace *t = (struct blk_io_trace *)iter->ent;
  1075. const int offset = offsetof(struct blk_io_trace, sector);
  1076. struct blk_io_trace old = {
  1077. .magic = BLK_IO_TRACE_MAGIC | BLK_IO_TRACE_VERSION,
  1078. .time = iter->ts,
  1079. };
  1080. if (!trace_seq_putmem(s, &old, offset))
  1081. return 0;
  1082. return trace_seq_putmem(s, &t->sector,
  1083. sizeof(old) - offset + t->pdu_len);
  1084. }
  1085. static enum print_line_t
  1086. blk_trace_event_print_binary(struct trace_iterator *iter, int flags)
  1087. {
  1088. return blk_trace_synthesize_old_trace(iter) ?
  1089. TRACE_TYPE_HANDLED : TRACE_TYPE_PARTIAL_LINE;
  1090. }
  1091. static enum print_line_t blk_tracer_print_line(struct trace_iterator *iter)
  1092. {
  1093. if (!(blk_tracer_flags.val & TRACE_BLK_OPT_CLASSIC))
  1094. return TRACE_TYPE_UNHANDLED;
  1095. return print_one_line(iter, true);
  1096. }
  1097. static int blk_tracer_set_flag(u32 old_flags, u32 bit, int set)
  1098. {
  1099. /* don't output context-info for blk_classic output */
  1100. if (bit == TRACE_BLK_OPT_CLASSIC) {
  1101. if (set)
  1102. trace_flags &= ~TRACE_ITER_CONTEXT_INFO;
  1103. else
  1104. trace_flags |= TRACE_ITER_CONTEXT_INFO;
  1105. }
  1106. return 0;
  1107. }
  1108. static struct tracer blk_tracer __read_mostly = {
  1109. .name = "blk",
  1110. .init = blk_tracer_init,
  1111. .reset = blk_tracer_reset,
  1112. .start = blk_tracer_start,
  1113. .stop = blk_tracer_stop,
  1114. .print_header = blk_tracer_print_header,
  1115. .print_line = blk_tracer_print_line,
  1116. .flags = &blk_tracer_flags,
  1117. .set_flag = blk_tracer_set_flag,
  1118. };
  1119. static struct trace_event trace_blk_event = {
  1120. .type = TRACE_BLK,
  1121. .trace = blk_trace_event_print,
  1122. .binary = blk_trace_event_print_binary,
  1123. };
  1124. static int __init init_blk_tracer(void)
  1125. {
  1126. if (!register_ftrace_event(&trace_blk_event)) {
  1127. pr_warning("Warning: could not register block events\n");
  1128. return 1;
  1129. }
  1130. if (register_tracer(&blk_tracer) != 0) {
  1131. pr_warning("Warning: could not register the block tracer\n");
  1132. unregister_ftrace_event(&trace_blk_event);
  1133. return 1;
  1134. }
  1135. return 0;
  1136. }
  1137. device_initcall(init_blk_tracer);
  1138. static int blk_trace_remove_queue(struct request_queue *q)
  1139. {
  1140. struct blk_trace *bt;
  1141. bt = xchg(&q->blk_trace, NULL);
  1142. if (bt == NULL)
  1143. return -EINVAL;
  1144. if (atomic_dec_and_test(&blk_probes_ref))
  1145. blk_unregister_tracepoints();
  1146. blk_trace_free(bt);
  1147. return 0;
  1148. }
  1149. /*
  1150. * Setup everything required to start tracing
  1151. */
  1152. static int blk_trace_setup_queue(struct request_queue *q,
  1153. struct block_device *bdev)
  1154. {
  1155. struct blk_trace *old_bt, *bt = NULL;
  1156. int ret = -ENOMEM;
  1157. bt = kzalloc(sizeof(*bt), GFP_KERNEL);
  1158. if (!bt)
  1159. return -ENOMEM;
  1160. bt->msg_data = __alloc_percpu(BLK_TN_MAX_MSG, __alignof__(char));
  1161. if (!bt->msg_data)
  1162. goto free_bt;
  1163. bt->dev = bdev->bd_dev;
  1164. bt->act_mask = (u16)-1;
  1165. blk_trace_setup_lba(bt, bdev);
  1166. old_bt = xchg(&q->blk_trace, bt);
  1167. if (old_bt != NULL) {
  1168. (void)xchg(&q->blk_trace, old_bt);
  1169. ret = -EBUSY;
  1170. goto free_bt;
  1171. }
  1172. if (atomic_inc_return(&blk_probes_ref) == 1)
  1173. blk_register_tracepoints();
  1174. return 0;
  1175. free_bt:
  1176. blk_trace_free(bt);
  1177. return ret;
  1178. }
  1179. /*
  1180. * sysfs interface to enable and configure tracing
  1181. */
  1182. static ssize_t sysfs_blk_trace_attr_show(struct device *dev,
  1183. struct device_attribute *attr,
  1184. char *buf);
  1185. static ssize_t sysfs_blk_trace_attr_store(struct device *dev,
  1186. struct device_attribute *attr,
  1187. const char *buf, size_t count);
  1188. #define BLK_TRACE_DEVICE_ATTR(_name) \
  1189. DEVICE_ATTR(_name, S_IRUGO | S_IWUSR, \
  1190. sysfs_blk_trace_attr_show, \
  1191. sysfs_blk_trace_attr_store)
  1192. static BLK_TRACE_DEVICE_ATTR(enable);
  1193. static BLK_TRACE_DEVICE_ATTR(act_mask);
  1194. static BLK_TRACE_DEVICE_ATTR(pid);
  1195. static BLK_TRACE_DEVICE_ATTR(start_lba);
  1196. static BLK_TRACE_DEVICE_ATTR(end_lba);
  1197. static struct attribute *blk_trace_attrs[] = {
  1198. &dev_attr_enable.attr,
  1199. &dev_attr_act_mask.attr,
  1200. &dev_attr_pid.attr,
  1201. &dev_attr_start_lba.attr,
  1202. &dev_attr_end_lba.attr,
  1203. NULL
  1204. };
  1205. struct attribute_group blk_trace_attr_group = {
  1206. .name = "trace",
  1207. .attrs = blk_trace_attrs,
  1208. };
  1209. static const struct {
  1210. int mask;
  1211. const char *str;
  1212. } mask_maps[] = {
  1213. { BLK_TC_READ, "read" },
  1214. { BLK_TC_WRITE, "write" },
  1215. { BLK_TC_BARRIER, "barrier" },
  1216. { BLK_TC_SYNC, "sync" },
  1217. { BLK_TC_QUEUE, "queue" },
  1218. { BLK_TC_REQUEUE, "requeue" },
  1219. { BLK_TC_ISSUE, "issue" },
  1220. { BLK_TC_COMPLETE, "complete" },
  1221. { BLK_TC_FS, "fs" },
  1222. { BLK_TC_PC, "pc" },
  1223. { BLK_TC_AHEAD, "ahead" },
  1224. { BLK_TC_META, "meta" },
  1225. { BLK_TC_DISCARD, "discard" },
  1226. { BLK_TC_DRV_DATA, "drv_data" },
  1227. };
  1228. static int blk_trace_str2mask(const char *str)
  1229. {
  1230. int i;
  1231. int mask = 0;
  1232. char *buf, *s, *token;
  1233. buf = kstrdup(str, GFP_KERNEL);
  1234. if (buf == NULL)
  1235. return -ENOMEM;
  1236. s = strstrip(buf);
  1237. while (1) {
  1238. token = strsep(&s, ",");
  1239. if (token == NULL)
  1240. break;
  1241. if (*token == '\0')
  1242. continue;
  1243. for (i = 0; i < ARRAY_SIZE(mask_maps); i++) {
  1244. if (strcasecmp(token, mask_maps[i].str) == 0) {
  1245. mask |= mask_maps[i].mask;
  1246. break;
  1247. }
  1248. }
  1249. if (i == ARRAY_SIZE(mask_maps)) {
  1250. mask = -EINVAL;
  1251. break;
  1252. }
  1253. }
  1254. kfree(buf);
  1255. return mask;
  1256. }
  1257. static ssize_t blk_trace_mask2str(char *buf, int mask)
  1258. {
  1259. int i;
  1260. char *p = buf;
  1261. for (i = 0; i < ARRAY_SIZE(mask_maps); i++) {
  1262. if (mask & mask_maps[i].mask) {
  1263. p += sprintf(p, "%s%s",
  1264. (p == buf) ? "" : ",", mask_maps[i].str);
  1265. }
  1266. }
  1267. *p++ = '\n';
  1268. return p - buf;
  1269. }
  1270. static struct request_queue *blk_trace_get_queue(struct block_device *bdev)
  1271. {
  1272. if (bdev->bd_disk == NULL)
  1273. return NULL;
  1274. return bdev_get_queue(bdev);
  1275. }
  1276. static ssize_t sysfs_blk_trace_attr_show(struct device *dev,
  1277. struct device_attribute *attr,
  1278. char *buf)
  1279. {
  1280. struct hd_struct *p = dev_to_part(dev);
  1281. struct request_queue *q;
  1282. struct block_device *bdev;
  1283. ssize_t ret = -ENXIO;
  1284. lock_kernel();
  1285. bdev = bdget(part_devt(p));
  1286. if (bdev == NULL)
  1287. goto out_unlock_kernel;
  1288. q = blk_trace_get_queue(bdev);
  1289. if (q == NULL)
  1290. goto out_bdput;
  1291. mutex_lock(&bdev->bd_mutex);
  1292. if (attr == &dev_attr_enable) {
  1293. ret = sprintf(buf, "%u\n", !!q->blk_trace);
  1294. goto out_unlock_bdev;
  1295. }
  1296. if (q->blk_trace == NULL)
  1297. ret = sprintf(buf, "disabled\n");
  1298. else if (attr == &dev_attr_act_mask)
  1299. ret = blk_trace_mask2str(buf, q->blk_trace->act_mask);
  1300. else if (attr == &dev_attr_pid)
  1301. ret = sprintf(buf, "%u\n", q->blk_trace->pid);
  1302. else if (attr == &dev_attr_start_lba)
  1303. ret = sprintf(buf, "%llu\n", q->blk_trace->start_lba);
  1304. else if (attr == &dev_attr_end_lba)
  1305. ret = sprintf(buf, "%llu\n", q->blk_trace->end_lba);
  1306. out_unlock_bdev:
  1307. mutex_unlock(&bdev->bd_mutex);
  1308. out_bdput:
  1309. bdput(bdev);
  1310. out_unlock_kernel:
  1311. unlock_kernel();
  1312. return ret;
  1313. }
  1314. static ssize_t sysfs_blk_trace_attr_store(struct device *dev,
  1315. struct device_attribute *attr,
  1316. const char *buf, size_t count)
  1317. {
  1318. struct block_device *bdev;
  1319. struct request_queue *q;
  1320. struct hd_struct *p;
  1321. u64 value;
  1322. ssize_t ret = -EINVAL;
  1323. if (count == 0)
  1324. goto out;
  1325. if (attr == &dev_attr_act_mask) {
  1326. if (sscanf(buf, "%llx", &value) != 1) {
  1327. /* Assume it is a list of trace category names */
  1328. ret = blk_trace_str2mask(buf);
  1329. if (ret < 0)
  1330. goto out;
  1331. value = ret;
  1332. }
  1333. } else if (sscanf(buf, "%llu", &value) != 1)
  1334. goto out;
  1335. ret = -ENXIO;
  1336. lock_kernel();
  1337. p = dev_to_part(dev);
  1338. bdev = bdget(part_devt(p));
  1339. if (bdev == NULL)
  1340. goto out_unlock_kernel;
  1341. q = blk_trace_get_queue(bdev);
  1342. if (q == NULL)
  1343. goto out_bdput;
  1344. mutex_lock(&bdev->bd_mutex);
  1345. if (attr == &dev_attr_enable) {
  1346. if (value)
  1347. ret = blk_trace_setup_queue(q, bdev);
  1348. else
  1349. ret = blk_trace_remove_queue(q);
  1350. goto out_unlock_bdev;
  1351. }
  1352. ret = 0;
  1353. if (q->blk_trace == NULL)
  1354. ret = blk_trace_setup_queue(q, bdev);
  1355. if (ret == 0) {
  1356. if (attr == &dev_attr_act_mask)
  1357. q->blk_trace->act_mask = value;
  1358. else if (attr == &dev_attr_pid)
  1359. q->blk_trace->pid = value;
  1360. else if (attr == &dev_attr_start_lba)
  1361. q->blk_trace->start_lba = value;
  1362. else if (attr == &dev_attr_end_lba)
  1363. q->blk_trace->end_lba = value;
  1364. }
  1365. out_unlock_bdev:
  1366. mutex_unlock(&bdev->bd_mutex);
  1367. out_bdput:
  1368. bdput(bdev);
  1369. out_unlock_kernel:
  1370. unlock_kernel();
  1371. out:
  1372. return ret ? ret : count;
  1373. }
  1374. int blk_trace_init_sysfs(struct device *dev)
  1375. {
  1376. return sysfs_create_group(&dev->kobj, &blk_trace_attr_group);
  1377. }
  1378. #endif /* CONFIG_BLK_DEV_IO_TRACE */
  1379. #ifdef CONFIG_EVENT_TRACING
  1380. void blk_dump_cmd(char *buf, struct request *rq)
  1381. {
  1382. int i, end;
  1383. int len = rq->cmd_len;
  1384. unsigned char *cmd = rq->cmd;
  1385. if (!blk_pc_request(rq)) {
  1386. buf[0] = '\0';
  1387. return;
  1388. }
  1389. for (end = len - 1; end >= 0; end--)
  1390. if (cmd[end])
  1391. break;
  1392. end++;
  1393. for (i = 0; i < len; i++) {
  1394. buf += sprintf(buf, "%s%02x", i == 0 ? "" : " ", cmd[i]);
  1395. if (i == end && end != len - 1) {
  1396. sprintf(buf, " ..");
  1397. break;
  1398. }
  1399. }
  1400. }
  1401. void blk_fill_rwbs(char *rwbs, u32 rw, int bytes)
  1402. {
  1403. int i = 0;
  1404. if (rw & WRITE)
  1405. rwbs[i++] = 'W';
  1406. else if (rw & 1 << BIO_RW_DISCARD)
  1407. rwbs[i++] = 'D';
  1408. else if (bytes)
  1409. rwbs[i++] = 'R';
  1410. else
  1411. rwbs[i++] = 'N';
  1412. if (rw & 1 << BIO_RW_AHEAD)
  1413. rwbs[i++] = 'A';
  1414. if (rw & 1 << BIO_RW_BARRIER)
  1415. rwbs[i++] = 'B';
  1416. if (rw & 1 << BIO_RW_SYNCIO)
  1417. rwbs[i++] = 'S';
  1418. if (rw & 1 << BIO_RW_META)
  1419. rwbs[i++] = 'M';
  1420. rwbs[i] = '\0';
  1421. }
  1422. void blk_fill_rwbs_rq(char *rwbs, struct request *rq)
  1423. {
  1424. int rw = rq->cmd_flags & 0x03;
  1425. int bytes;
  1426. if (blk_discard_rq(rq))
  1427. rw |= (1 << BIO_RW_DISCARD);
  1428. bytes = blk_rq_bytes(rq);
  1429. blk_fill_rwbs(rwbs, rw, bytes);
  1430. }
  1431. #endif /* CONFIG_EVENT_TRACING */