]> git.proxmox.com Git - mirror_ubuntu-kernels.git/blob - tools/lib/traceevent/event-parse.c
projects / mirror_ubuntu-kernels.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge branches 'for-5.1/upstream-fixes', 'for-5.2/core', 'for-5.2/ish', 'for-5.2...
[mirror_ubuntu-kernels.git] / tools / lib / traceevent / event-parse.c
1 // SPDX-License-Identifier: LGPL-2.1
2 /*
3 * Copyright (C) 2009, 2010 Red Hat Inc, Steven Rostedt <srostedt@redhat.com>
4 *
5 *
6 * The parts for function graph printing was taken and modified from the
7 * Linux Kernel that were written by
8 * - Copyright (C) 2009 Frederic Weisbecker,
9 * Frederic Weisbecker gave his permission to relicense the code to
10 * the Lesser General Public License.
11 */
12 #include <inttypes.h>
13 #include <stdio.h>
14 #include <stdlib.h>
15 #include <string.h>
16 #include <stdarg.h>
17 #include <ctype.h>
18 #include <errno.h>
19 #include <stdint.h>
20 #include <limits.h>
21 #include <linux/time64.h>
22
23 #include <netinet/in.h>
24 #include "event-parse.h"
25
26 #include "event-parse-local.h"
27 #include "event-utils.h"
28 #include "trace-seq.h"
29
30 static const char *input_buf;
31 static unsigned long long input_buf_ptr;
32 static unsigned long long input_buf_siz;
33
34 static int is_flag_field;
35 static int is_symbolic_field;
36
37 static int show_warning = 1;
38
39 #define do_warning(fmt, ...) \
40 do { \
41 if (show_warning) \
42 warning(fmt, ##__VA_ARGS__); \
43 } while (0)
44
45 #define do_warning_event(event, fmt, ...) \
46 do { \
47 if (!show_warning) \
48 continue; \
49 \
50 if (event) \
51 warning("[%s:%s] " fmt, event->system, \
52 event->name, ##__VA_ARGS__); \
53 else \
54 warning(fmt, ##__VA_ARGS__); \
55 } while (0)
56
57 static void init_input_buf(const char *buf, unsigned long long size)
58 {
59 input_buf = buf;
60 input_buf_siz = size;
61 input_buf_ptr = 0;
62 }
63
64 const char *tep_get_input_buf(void)
65 {
66 return input_buf;
67 }
68
69 unsigned long long tep_get_input_buf_ptr(void)
70 {
71 return input_buf_ptr;
72 }
73
74 struct event_handler {
75 struct event_handler *next;
76 int id;
77 const char *sys_name;
78 const char *event_name;
79 tep_event_handler_func func;
80 void *context;
81 };
82
83 struct func_params {
84 struct func_params *next;
85 enum tep_func_arg_type type;
86 };
87
88 struct tep_function_handler {
89 struct tep_function_handler *next;
90 enum tep_func_arg_type ret_type;
91 char *name;
92 tep_func_handler func;
93 struct func_params *params;
94 int nr_args;
95 };
96
97 static unsigned long long
98 process_defined_func(struct trace_seq *s, void *data, int size,
99 struct tep_event *event, struct tep_print_arg *arg);
100
101 static void free_func_handle(struct tep_function_handler *func);
102
103 /**
104 * tep_buffer_init - init buffer for parsing
105 * @buf: buffer to parse
106 * @size: the size of the buffer
107 *
108 * For use with tep_read_token(), this initializes the internal
109 * buffer that tep_read_token() will parse.
110 */
111 void tep_buffer_init(const char *buf, unsigned long long size)
112 {
113 init_input_buf(buf, size);
114 }
115
116 void breakpoint(void)
117 {
118 static int x;
119 x++;
120 }
121
122 struct tep_print_arg *alloc_arg(void)
123 {
124 return calloc(1, sizeof(struct tep_print_arg));
125 }
126
127 struct tep_cmdline {
128 char *comm;
129 int pid;
130 };
131
132 static int cmdline_cmp(const void *a, const void *b)
133 {
134 const struct tep_cmdline *ca = a;
135 const struct tep_cmdline *cb = b;
136
137 if (ca->pid < cb->pid)
138 return -1;
139 if (ca->pid > cb->pid)
140 return 1;
141
142 return 0;
143 }
144
145 struct cmdline_list {
146 struct cmdline_list *next;
147 char *comm;
148 int pid;
149 };
150
151 static int cmdline_init(struct tep_handle *pevent)
152 {
153 struct cmdline_list *cmdlist = pevent->cmdlist;
154 struct cmdline_list *item;
155 struct tep_cmdline *cmdlines;
156 int i;
157
158 cmdlines = malloc(sizeof(*cmdlines) * pevent->cmdline_count);
159 if (!cmdlines)
160 return -1;
161
162 i = 0;
163 while (cmdlist) {
164 cmdlines[i].pid = cmdlist->pid;
165 cmdlines[i].comm = cmdlist->comm;
166 i++;
167 item = cmdlist;
168 cmdlist = cmdlist->next;
169 free(item);
170 }
171
172 qsort(cmdlines, pevent->cmdline_count, sizeof(*cmdlines), cmdline_cmp);
173
174 pevent->cmdlines = cmdlines;
175 pevent->cmdlist = NULL;
176
177 return 0;
178 }
179
180 static const char *find_cmdline(struct tep_handle *pevent, int pid)
181 {
182 const struct tep_cmdline *comm;
183 struct tep_cmdline key;
184
185 if (!pid)
186 return "<idle>";
187
188 if (!pevent->cmdlines && cmdline_init(pevent))
189 return "<not enough memory for cmdlines!>";
190
191 key.pid = pid;
192
193 comm = bsearch(&key, pevent->cmdlines, pevent->cmdline_count,
194 sizeof(*pevent->cmdlines), cmdline_cmp);
195
196 if (comm)
197 return comm->comm;
198 return "<...>";
199 }
200
201 /**
202 * tep_pid_is_registered - return if a pid has a cmdline registered
203 * @pevent: handle for the pevent
204 * @pid: The pid to check if it has a cmdline registered with.
205 *
206 * Returns 1 if the pid has a cmdline mapped to it
207 * 0 otherwise.
208 */
209 int tep_pid_is_registered(struct tep_handle *pevent, int pid)
210 {
211 const struct tep_cmdline *comm;
212 struct tep_cmdline key;
213
214 if (!pid)
215 return 1;
216
217 if (!pevent->cmdlines && cmdline_init(pevent))
218 return 0;
219
220 key.pid = pid;
221
222 comm = bsearch(&key, pevent->cmdlines, pevent->cmdline_count,
223 sizeof(*pevent->cmdlines), cmdline_cmp);
224
225 if (comm)
226 return 1;
227 return 0;
228 }
229
230 /*
231 * If the command lines have been converted to an array, then
232 * we must add this pid. This is much slower than when cmdlines
233 * are added before the array is initialized.
234 */
235 static int add_new_comm(struct tep_handle *pevent,
236 const char *comm, int pid, bool override)
237 {
238 struct tep_cmdline *cmdlines = pevent->cmdlines;
239 struct tep_cmdline *cmdline;
240 struct tep_cmdline key;
241 char *new_comm;
242
243 if (!pid)
244 return 0;
245
246 /* avoid duplicates */
247 key.pid = pid;
248
249 cmdline = bsearch(&key, pevent->cmdlines, pevent->cmdline_count,
250 sizeof(*pevent->cmdlines), cmdline_cmp);
251 if (cmdline) {
252 if (!override) {
253 errno = EEXIST;
254 return -1;
255 }
256 new_comm = strdup(comm);
257 if (!new_comm) {
258 errno = ENOMEM;
259 return -1;
260 }
261 free(cmdline->comm);
262 cmdline->comm = new_comm;
263
264 return 0;
265 }
266
267 cmdlines = realloc(cmdlines, sizeof(*cmdlines) * (pevent->cmdline_count + 1));
268 if (!cmdlines) {
269 errno = ENOMEM;
270 return -1;
271 }
272
273 cmdlines[pevent->cmdline_count].comm = strdup(comm);
274 if (!cmdlines[pevent->cmdline_count].comm) {
275 free(cmdlines);
276 errno = ENOMEM;
277 return -1;
278 }
279
280 cmdlines[pevent->cmdline_count].pid = pid;
281
282 if (cmdlines[pevent->cmdline_count].comm)
283 pevent->cmdline_count++;
284
285 qsort(cmdlines, pevent->cmdline_count, sizeof(*cmdlines), cmdline_cmp);
286 pevent->cmdlines = cmdlines;
287
288 return 0;
289 }
290
291 static int _tep_register_comm(struct tep_handle *pevent,
292 const char *comm, int pid, bool override)
293 {
294 struct cmdline_list *item;
295
296 if (pevent->cmdlines)
297 return add_new_comm(pevent, comm, pid, override);
298
299 item = malloc(sizeof(*item));
300 if (!item)
301 return -1;
302
303 if (comm)
304 item->comm = strdup(comm);
305 else
306 item->comm = strdup("<...>");
307 if (!item->comm) {
308 free(item);
309 return -1;
310 }
311 item->pid = pid;
312 item->next = pevent->cmdlist;
313
314 pevent->cmdlist = item;
315 pevent->cmdline_count++;
316
317 return 0;
318 }
319
320 /**
321 * tep_register_comm - register a pid / comm mapping
322 * @pevent: handle for the pevent
323 * @comm: the command line to register
324 * @pid: the pid to map the command line to
325 *
326 * This adds a mapping to search for command line names with
327 * a given pid. The comm is duplicated. If a command with the same pid
328 * already exist, -1 is returned and errno is set to EEXIST
329 */
330 int tep_register_comm(struct tep_handle *pevent, const char *comm, int pid)
331 {
332 return _tep_register_comm(pevent, comm, pid, false);
333 }
334
335 /**
336 * tep_override_comm - register a pid / comm mapping
337 * @pevent: handle for the pevent
338 * @comm: the command line to register
339 * @pid: the pid to map the command line to
340 *
341 * This adds a mapping to search for command line names with
342 * a given pid. The comm is duplicated. If a command with the same pid
343 * already exist, the command string is udapted with the new one
344 */
345 int tep_override_comm(struct tep_handle *pevent, const char *comm, int pid)
346 {
347 if (!pevent->cmdlines && cmdline_init(pevent)) {
348 errno = ENOMEM;
349 return -1;
350 }
351 return _tep_register_comm(pevent, comm, pid, true);
352 }
353
354 int tep_register_trace_clock(struct tep_handle *pevent, const char *trace_clock)
355 {
356 pevent->trace_clock = strdup(trace_clock);
357 if (!pevent->trace_clock) {
358 errno = ENOMEM;
359 return -1;
360 }
361 return 0;
362 }
363
364 struct func_map {
365 unsigned long long addr;
366 char *func;
367 char *mod;
368 };
369
370 struct func_list {
371 struct func_list *next;
372 unsigned long long addr;
373 char *func;
374 char *mod;
375 };
376
377 static int func_cmp(const void *a, const void *b)
378 {
379 const struct func_map *fa = a;
380 const struct func_map *fb = b;
381
382 if (fa->addr < fb->addr)
383 return -1;
384 if (fa->addr > fb->addr)
385 return 1;
386
387 return 0;
388 }
389
390 /*
391 * We are searching for a record in between, not an exact
392 * match.
393 */
394 static int func_bcmp(const void *a, const void *b)
395 {
396 const struct func_map *fa = a;
397 const struct func_map *fb = b;
398
399 if ((fa->addr == fb->addr) ||
400
401 (fa->addr > fb->addr &&
402 fa->addr < (fb+1)->addr))
403 return 0;
404
405 if (fa->addr < fb->addr)
406 return -1;
407
408 return 1;
409 }
410
411 static int func_map_init(struct tep_handle *pevent)
412 {
413 struct func_list *funclist;
414 struct func_list *item;
415 struct func_map *func_map;
416 int i;
417
418 func_map = malloc(sizeof(*func_map) * (pevent->func_count + 1));
419 if (!func_map)
420 return -1;
421
422 funclist = pevent->funclist;
423
424 i = 0;
425 while (funclist) {
426 func_map[i].func = funclist->func;
427 func_map[i].addr = funclist->addr;
428 func_map[i].mod = funclist->mod;
429 i++;
430 item = funclist;
431 funclist = funclist->next;
432 free(item);
433 }
434
435 qsort(func_map, pevent->func_count, sizeof(*func_map), func_cmp);
436
437 /*
438 * Add a special record at the end.
439 */
440 func_map[pevent->func_count].func = NULL;
441 func_map[pevent->func_count].addr = 0;
442 func_map[pevent->func_count].mod = NULL;
443
444 pevent->func_map = func_map;
445 pevent->funclist = NULL;
446
447 return 0;
448 }
449
450 static struct func_map *
451 __find_func(struct tep_handle *pevent, unsigned long long addr)
452 {
453 struct func_map *func;
454 struct func_map key;
455
456 if (!pevent->func_map)
457 func_map_init(pevent);
458
459 key.addr = addr;
460
461 func = bsearch(&key, pevent->func_map, pevent->func_count,
462 sizeof(*pevent->func_map), func_bcmp);
463
464 return func;
465 }
466
467 struct func_resolver {
468 tep_func_resolver_t *func;
469 void *priv;
470 struct func_map map;
471 };
472
473 /**
474 * tep_set_function_resolver - set an alternative function resolver
475 * @pevent: handle for the pevent
476 * @resolver: function to be used
477 * @priv: resolver function private state.
478 *
479 * Some tools may have already a way to resolve kernel functions, allow them to
480 * keep using it instead of duplicating all the entries inside
481 * pevent->funclist.
482 */
483 int tep_set_function_resolver(struct tep_handle *pevent,
484 tep_func_resolver_t *func, void *priv)
485 {
486 struct func_resolver *resolver = malloc(sizeof(*resolver));
487
488 if (resolver == NULL)
489 return -1;
490
491 resolver->func = func;
492 resolver->priv = priv;
493
494 free(pevent->func_resolver);
495 pevent->func_resolver = resolver;
496
497 return 0;
498 }
499
500 /**
501 * tep_reset_function_resolver - reset alternative function resolver
502 * @pevent: handle for the pevent
503 *
504 * Stop using whatever alternative resolver was set, use the default
505 * one instead.
506 */
507 void tep_reset_function_resolver(struct tep_handle *pevent)
508 {
509 free(pevent->func_resolver);
510 pevent->func_resolver = NULL;
511 }
512
513 static struct func_map *
514 find_func(struct tep_handle *pevent, unsigned long long addr)
515 {
516 struct func_map *map;
517
518 if (!pevent->func_resolver)
519 return __find_func(pevent, addr);
520
521 map = &pevent->func_resolver->map;
522 map->mod = NULL;
523 map->addr = addr;
524 map->func = pevent->func_resolver->func(pevent->func_resolver->priv,
525 &map->addr, &map->mod);
526 if (map->func == NULL)
527 return NULL;
528
529 return map;
530 }
531
532 /**
533 * tep_find_function - find a function by a given address
534 * @pevent: handle for the pevent
535 * @addr: the address to find the function with
536 *
537 * Returns a pointer to the function stored that has the given
538 * address. Note, the address does not have to be exact, it
539 * will select the function that would contain the address.
540 */
541 const char *tep_find_function(struct tep_handle *pevent, unsigned long long addr)
542 {
543 struct func_map *map;
544
545 map = find_func(pevent, addr);
546 if (!map)
547 return NULL;
548
549 return map->func;
550 }
551
552 /**
553 * tep_find_function_address - find a function address by a given address
554 * @pevent: handle for the pevent
555 * @addr: the address to find the function with
556 *
557 * Returns the address the function starts at. This can be used in
558 * conjunction with tep_find_function to print both the function
559 * name and the function offset.
560 */
561 unsigned long long
562 tep_find_function_address(struct tep_handle *pevent, unsigned long long addr)
563 {
564 struct func_map *map;
565
566 map = find_func(pevent, addr);
567 if (!map)
568 return 0;
569
570 return map->addr;
571 }
572
573 /**
574 * tep_register_function - register a function with a given address
575 * @pevent: handle for the pevent
576 * @function: the function name to register
577 * @addr: the address the function starts at
578 * @mod: the kernel module the function may be in (NULL for none)
579 *
580 * This registers a function name with an address and module.
581 * The @func passed in is duplicated.
582 */
583 int tep_register_function(struct tep_handle *pevent, char *func,
584 unsigned long long addr, char *mod)
585 {
586 struct func_list *item = malloc(sizeof(*item));
587
588 if (!item)
589 return -1;
590
591 item->next = pevent->funclist;
592 item->func = strdup(func);
593 if (!item->func)
594 goto out_free;
595
596 if (mod) {
597 item->mod = strdup(mod);
598 if (!item->mod)
599 goto out_free_func;
600 } else
601 item->mod = NULL;
602 item->addr = addr;
603
604 pevent->funclist = item;
605 pevent->func_count++;
606
607 return 0;
608
609 out_free_func:
610 free(item->func);
611 item->func = NULL;
612 out_free:
613 free(item);
614 errno = ENOMEM;
615 return -1;
616 }
617
618 /**
619 * tep_print_funcs - print out the stored functions
620 * @pevent: handle for the pevent
621 *
622 * This prints out the stored functions.
623 */
624 void tep_print_funcs(struct tep_handle *pevent)
625 {
626 int i;
627
628 if (!pevent->func_map)
629 func_map_init(pevent);
630
631 for (i = 0; i < (int)pevent->func_count; i++) {
632 printf("%016llx %s",
633 pevent->func_map[i].addr,
634 pevent->func_map[i].func);
635 if (pevent->func_map[i].mod)
636 printf(" [%s]\n", pevent->func_map[i].mod);
637 else
638 printf("\n");
639 }
640 }
641
642 struct printk_map {
643 unsigned long long addr;
644 char *printk;
645 };
646
647 struct printk_list {
648 struct printk_list *next;
649 unsigned long long addr;
650 char *printk;
651 };
652
653 static int printk_cmp(const void *a, const void *b)
654 {
655 const struct printk_map *pa = a;
656 const struct printk_map *pb = b;
657
658 if (pa->addr < pb->addr)
659 return -1;
660 if (pa->addr > pb->addr)
661 return 1;
662
663 return 0;
664 }
665
666 static int printk_map_init(struct tep_handle *pevent)
667 {
668 struct printk_list *printklist;
669 struct printk_list *item;
670 struct printk_map *printk_map;
671 int i;
672
673 printk_map = malloc(sizeof(*printk_map) * (pevent->printk_count + 1));
674 if (!printk_map)
675 return -1;
676
677 printklist = pevent->printklist;
678
679 i = 0;
680 while (printklist) {
681 printk_map[i].printk = printklist->printk;
682 printk_map[i].addr = printklist->addr;
683 i++;
684 item = printklist;
685 printklist = printklist->next;
686 free(item);
687 }
688
689 qsort(printk_map, pevent->printk_count, sizeof(*printk_map), printk_cmp);
690
691 pevent->printk_map = printk_map;
692 pevent->printklist = NULL;
693
694 return 0;
695 }
696
697 static struct printk_map *
698 find_printk(struct tep_handle *pevent, unsigned long long addr)
699 {
700 struct printk_map *printk;
701 struct printk_map key;
702
703 if (!pevent->printk_map && printk_map_init(pevent))
704 return NULL;
705
706 key.addr = addr;
707
708 printk = bsearch(&key, pevent->printk_map, pevent->printk_count,
709 sizeof(*pevent->printk_map), printk_cmp);
710
711 return printk;
712 }
713
714 /**
715 * tep_register_print_string - register a string by its address
716 * @pevent: handle for the pevent
717 * @fmt: the string format to register
718 * @addr: the address the string was located at
719 *
720 * This registers a string by the address it was stored in the kernel.
721 * The @fmt passed in is duplicated.
722 */
723 int tep_register_print_string(struct tep_handle *pevent, const char *fmt,
724 unsigned long long addr)
725 {
726 struct printk_list *item = malloc(sizeof(*item));
727 char *p;
728
729 if (!item)
730 return -1;
731
732 item->next = pevent->printklist;
733 item->addr = addr;
734
735 /* Strip off quotes and '\n' from the end */
736 if (fmt[0] == '"')
737 fmt++;
738 item->printk = strdup(fmt);
739 if (!item->printk)
740 goto out_free;
741
742 p = item->printk + strlen(item->printk) - 1;
743 if (*p == '"')
744 *p = 0;
745
746 p -= 2;
747 if (strcmp(p, "\\n") == 0)
748 *p = 0;
749
750 pevent->printklist = item;
751 pevent->printk_count++;
752
753 return 0;
754
755 out_free:
756 free(item);
757 errno = ENOMEM;
758 return -1;
759 }
760
761 /**
762 * tep_print_printk - print out the stored strings
763 * @pevent: handle for the pevent
764 *
765 * This prints the string formats that were stored.
766 */
767 void tep_print_printk(struct tep_handle *pevent)
768 {
769 int i;
770
771 if (!pevent->printk_map)
772 printk_map_init(pevent);
773
774 for (i = 0; i < (int)pevent->printk_count; i++) {
775 printf("%016llx %s\n",
776 pevent->printk_map[i].addr,
777 pevent->printk_map[i].printk);
778 }
779 }
780
781 static struct tep_event *alloc_event(void)
782 {
783 return calloc(1, sizeof(struct tep_event));
784 }
785
786 static int add_event(struct tep_handle *pevent, struct tep_event *event)
787 {
788 int i;
789 struct tep_event **events = realloc(pevent->events, sizeof(event) *
790 (pevent->nr_events + 1));
791 if (!events)
792 return -1;
793
794 pevent->events = events;
795
796 for (i = 0; i < pevent->nr_events; i++) {
797 if (pevent->events[i]->id > event->id)
798 break;
799 }
800 if (i < pevent->nr_events)
801 memmove(&pevent->events[i + 1],
802 &pevent->events[i],
803 sizeof(event) * (pevent->nr_events - i));
804
805 pevent->events[i] = event;
806 pevent->nr_events++;
807
808 event->pevent = pevent;
809
810 return 0;
811 }
812
813 static int event_item_type(enum tep_event_type type)
814 {
815 switch (type) {
816 case TEP_EVENT_ITEM ... TEP_EVENT_SQUOTE:
817 return 1;
818 case TEP_EVENT_ERROR ... TEP_EVENT_DELIM:
819 default:
820 return 0;
821 }
822 }
823
824 static void free_flag_sym(struct tep_print_flag_sym *fsym)
825 {
826 struct tep_print_flag_sym *next;
827
828 while (fsym) {
829 next = fsym->next;
830 free(fsym->value);
831 free(fsym->str);
832 free(fsym);
833 fsym = next;
834 }
835 }
836
837 static void free_arg(struct tep_print_arg *arg)
838 {
839 struct tep_print_arg *farg;
840
841 if (!arg)
842 return;
843
844 switch (arg->type) {
845 case TEP_PRINT_ATOM:
846 free(arg->atom.atom);
847 break;
848 case TEP_PRINT_FIELD:
849 free(arg->field.name);
850 break;
851 case TEP_PRINT_FLAGS:
852 free_arg(arg->flags.field);
853 free(arg->flags.delim);
854 free_flag_sym(arg->flags.flags);
855 break;
856 case TEP_PRINT_SYMBOL:
857 free_arg(arg->symbol.field);
858 free_flag_sym(arg->symbol.symbols);
859 break;
860 case TEP_PRINT_HEX:
861 case TEP_PRINT_HEX_STR:
862 free_arg(arg->hex.field);
863 free_arg(arg->hex.size);
864 break;
865 case TEP_PRINT_INT_ARRAY:
866 free_arg(arg->int_array.field);
867 free_arg(arg->int_array.count);
868 free_arg(arg->int_array.el_size);
869 break;
870 case TEP_PRINT_TYPE:
871 free(arg->typecast.type);
872 free_arg(arg->typecast.item);
873 break;
874 case TEP_PRINT_STRING:
875 case TEP_PRINT_BSTRING:
876 free(arg->string.string);
877 break;
878 case TEP_PRINT_BITMASK:
879 free(arg->bitmask.bitmask);
880 break;
881 case TEP_PRINT_DYNAMIC_ARRAY:
882 case TEP_PRINT_DYNAMIC_ARRAY_LEN:
883 free(arg->dynarray.index);
884 break;
885 case TEP_PRINT_OP:
886 free(arg->op.op);
887 free_arg(arg->op.left);
888 free_arg(arg->op.right);
889 break;
890 case TEP_PRINT_FUNC:
891 while (arg->func.args) {
892 farg = arg->func.args;
893 arg->func.args = farg->next;
894 free_arg(farg);
895 }
896 break;
897
898 case TEP_PRINT_NULL:
899 default:
900 break;
901 }
902
903 free(arg);
904 }
905
906 static enum tep_event_type get_type(int ch)
907 {
908 if (ch == '\n')
909 return TEP_EVENT_NEWLINE;
910 if (isspace(ch))
911 return TEP_EVENT_SPACE;
912 if (isalnum(ch) || ch == '_')
913 return TEP_EVENT_ITEM;
914 if (ch == '\'')
915 return TEP_EVENT_SQUOTE;
916 if (ch == '"')
917 return TEP_EVENT_DQUOTE;
918 if (!isprint(ch))
919 return TEP_EVENT_NONE;
920 if (ch == '(' || ch == ')' || ch == ',')
921 return TEP_EVENT_DELIM;
922
923 return TEP_EVENT_OP;
924 }
925
926 static int __read_char(void)
927 {
928 if (input_buf_ptr >= input_buf_siz)
929 return -1;
930
931 return input_buf[input_buf_ptr++];
932 }
933
934 static int __peek_char(void)
935 {
936 if (input_buf_ptr >= input_buf_siz)
937 return -1;
938
939 return input_buf[input_buf_ptr];
940 }
941
942 /**
943 * tep_peek_char - peek at the next character that will be read
944 *
945 * Returns the next character read, or -1 if end of buffer.
946 */
947 int tep_peek_char(void)
948 {
949 return __peek_char();
950 }
951
952 static int extend_token(char **tok, char *buf, int size)
953 {
954 char *newtok = realloc(*tok, size);
955
956 if (!newtok) {
957 free(*tok);
958 *tok = NULL;
959 return -1;
960 }
961
962 if (!*tok)
963 strcpy(newtok, buf);
964 else
965 strcat(newtok, buf);
966 *tok = newtok;
967
968 return 0;
969 }
970
971 static enum tep_event_type force_token(const char *str, char **tok);
972
973 static enum tep_event_type __read_token(char **tok)
974 {
975 char buf[BUFSIZ];
976 int ch, last_ch, quote_ch, next_ch;
977 int i = 0;
978 int tok_size = 0;
979 enum tep_event_type type;
980
981 *tok = NULL;
982
983
984 ch = __read_char();
985 if (ch < 0)
986 return TEP_EVENT_NONE;
987
988 type = get_type(ch);
989 if (type == TEP_EVENT_NONE)
990 return type;
991
992 buf[i++] = ch;
993
994 switch (type) {
995 case TEP_EVENT_NEWLINE:
996 case TEP_EVENT_DELIM:
997 if (asprintf(tok, "%c", ch) < 0)
998 return TEP_EVENT_ERROR;
999
1000 return type;
1001
1002 case TEP_EVENT_OP:
1003 switch (ch) {
1004 case '-':
1005 next_ch = __peek_char();
1006 if (next_ch == '>') {
1007 buf[i++] = __read_char();
1008 break;
1009 }
1010 /* fall through */
1011 case '+':
1012 case '|':
1013 case '&':
1014 case '>':
1015 case '<':
1016 last_ch = ch;
1017 ch = __peek_char();
1018 if (ch != last_ch)
1019 goto test_equal;
1020 buf[i++] = __read_char();
1021 switch (last_ch) {
1022 case '>':
1023 case '<':
1024 goto test_equal;
1025 default:
1026 break;
1027 }
1028 break;
1029 case '!':
1030 case '=':
1031 goto test_equal;
1032 default: /* what should we do instead? */
1033 break;
1034 }
1035 buf[i] = 0;
1036 *tok = strdup(buf);
1037 return type;
1038
1039 test_equal:
1040 ch = __peek_char();
1041 if (ch == '=')
1042 buf[i++] = __read_char();
1043 goto out;
1044
1045 case TEP_EVENT_DQUOTE:
1046 case TEP_EVENT_SQUOTE:
1047 /* don't keep quotes */
1048 i--;
1049 quote_ch = ch;
1050 last_ch = 0;
1051 concat:
1052 do {
1053 if (i == (BUFSIZ - 1)) {
1054 buf[i] = 0;
1055 tok_size += BUFSIZ;
1056
1057 if (extend_token(tok, buf, tok_size) < 0)
1058 return TEP_EVENT_NONE;
1059 i = 0;
1060 }
1061 last_ch = ch;
1062 ch = __read_char();
1063 buf[i++] = ch;
1064 /* the '\' '\' will cancel itself */
1065 if (ch == '\\' && last_ch == '\\')
1066 last_ch = 0;
1067 } while (ch != quote_ch || last_ch == '\\');
1068 /* remove the last quote */
1069 i--;
1070
1071 /*
1072 * For strings (double quotes) check the next token.
1073 * If it is another string, concatinate the two.
1074 */
1075 if (type == TEP_EVENT_DQUOTE) {
1076 unsigned long long save_input_buf_ptr = input_buf_ptr;
1077
1078 do {
1079 ch = __read_char();
1080 } while (isspace(ch));
1081 if (ch == '"')
1082 goto concat;
1083 input_buf_ptr = save_input_buf_ptr;
1084 }
1085
1086 goto out;
1087
1088 case TEP_EVENT_ERROR ... TEP_EVENT_SPACE:
1089 case TEP_EVENT_ITEM:
1090 default:
1091 break;
1092 }
1093
1094 while (get_type(__peek_char()) == type) {
1095 if (i == (BUFSIZ - 1)) {
1096 buf[i] = 0;
1097 tok_size += BUFSIZ;
1098
1099 if (extend_token(tok, buf, tok_size) < 0)
1100 return TEP_EVENT_NONE;
1101 i = 0;
1102 }
1103 ch = __read_char();
1104 buf[i++] = ch;
1105 }
1106
1107 out:
1108 buf[i] = 0;
1109 if (extend_token(tok, buf, tok_size + i + 1) < 0)
1110 return TEP_EVENT_NONE;
1111
1112 if (type == TEP_EVENT_ITEM) {
1113 /*
1114 * Older versions of the kernel has a bug that
1115 * creates invalid symbols and will break the mac80211
1116 * parsing. This is a work around to that bug.
1117 *
1118 * See Linux kernel commit:
1119 * 811cb50baf63461ce0bdb234927046131fc7fa8b
1120 */
1121 if (strcmp(*tok, "LOCAL_PR_FMT") == 0) {
1122 free(*tok);
1123 *tok = NULL;
1124 return force_token("\"%s\" ", tok);
1125 } else if (strcmp(*tok, "STA_PR_FMT") == 0) {
1126 free(*tok);
1127 *tok = NULL;
1128 return force_token("\" sta:%pM\" ", tok);
1129 } else if (strcmp(*tok, "VIF_PR_FMT") == 0) {
1130 free(*tok);
1131 *tok = NULL;
1132 return force_token("\" vif:%p(%d)\" ", tok);
1133 }
1134 }
1135
1136 return type;
1137 }
1138
1139 static enum tep_event_type force_token(const char *str, char **tok)
1140 {
1141 const char *save_input_buf;
1142 unsigned long long save_input_buf_ptr;
1143 unsigned long long save_input_buf_siz;
1144 enum tep_event_type type;
1145
1146 /* save off the current input pointers */
1147 save_input_buf = input_buf;
1148 save_input_buf_ptr = input_buf_ptr;
1149 save_input_buf_siz = input_buf_siz;
1150
1151 init_input_buf(str, strlen(str));
1152
1153 type = __read_token(tok);
1154
1155 /* reset back to original token */
1156 input_buf = save_input_buf;
1157 input_buf_ptr = save_input_buf_ptr;
1158 input_buf_siz = save_input_buf_siz;
1159
1160 return type;
1161 }
1162
1163 static void free_token(char *tok)
1164 {
1165 if (tok)
1166 free(tok);
1167 }
1168
1169 static enum tep_event_type read_token(char **tok)
1170 {
1171 enum tep_event_type type;
1172
1173 for (;;) {
1174 type = __read_token(tok);
1175 if (type != TEP_EVENT_SPACE)
1176 return type;
1177
1178 free_token(*tok);
1179 }
1180
1181 /* not reached */
1182 *tok = NULL;
1183 return TEP_EVENT_NONE;
1184 }
1185
1186 /**
1187 * tep_read_token - access to utilities to use the pevent parser
1188 * @tok: The token to return
1189 *
1190 * This will parse tokens from the string given by
1191 * tep_init_data().
1192 *
1193 * Returns the token type.
1194 */
1195 enum tep_event_type tep_read_token(char **tok)
1196 {
1197 return read_token(tok);
1198 }
1199
1200 /**
1201 * tep_free_token - free a token returned by tep_read_token
1202 * @token: the token to free
1203 */
1204 void tep_free_token(char *token)
1205 {
1206 free_token(token);
1207 }
1208
1209 /* no newline */
1210 static enum tep_event_type read_token_item(char **tok)
1211 {
1212 enum tep_event_type type;
1213
1214 for (;;) {
1215 type = __read_token(tok);
1216 if (type != TEP_EVENT_SPACE && type != TEP_EVENT_NEWLINE)
1217 return type;
1218 free_token(*tok);
1219 *tok = NULL;
1220 }
1221
1222 /* not reached */
1223 *tok = NULL;
1224 return TEP_EVENT_NONE;
1225 }
1226
1227 static int test_type(enum tep_event_type type, enum tep_event_type expect)
1228 {
1229 if (type != expect) {
1230 do_warning("Error: expected type %d but read %d",
1231 expect, type);
1232 return -1;
1233 }
1234 return 0;
1235 }
1236
1237 static int test_type_token(enum tep_event_type type, const char *token,
1238 enum tep_event_type expect, const char *expect_tok)
1239 {
1240 if (type != expect) {
1241 do_warning("Error: expected type %d but read %d",
1242 expect, type);
1243 return -1;
1244 }
1245
1246 if (strcmp(token, expect_tok) != 0) {
1247 do_warning("Error: expected '%s' but read '%s'",
1248 expect_tok, token);
1249 return -1;
1250 }
1251 return 0;
1252 }
1253
1254 static int __read_expect_type(enum tep_event_type expect, char **tok, int newline_ok)
1255 {
1256 enum tep_event_type type;
1257
1258 if (newline_ok)
1259 type = read_token(tok);
1260 else
1261 type = read_token_item(tok);
1262 return test_type(type, expect);
1263 }
1264
1265 static int read_expect_type(enum tep_event_type expect, char **tok)
1266 {
1267 return __read_expect_type(expect, tok, 1);
1268 }
1269
1270 static int __read_expected(enum tep_event_type expect, const char *str,
1271 int newline_ok)
1272 {
1273 enum tep_event_type type;
1274 char *token;
1275 int ret;
1276
1277 if (newline_ok)
1278 type = read_token(&token);
1279 else
1280 type = read_token_item(&token);
1281
1282 ret = test_type_token(type, token, expect, str);
1283
1284 free_token(token);
1285
1286 return ret;
1287 }
1288
1289 static int read_expected(enum tep_event_type expect, const char *str)
1290 {
1291 return __read_expected(expect, str, 1);
1292 }
1293
1294 static int read_expected_item(enum tep_event_type expect, const char *str)
1295 {
1296 return __read_expected(expect, str, 0);
1297 }
1298
1299 static char *event_read_name(void)
1300 {
1301 char *token;
1302
1303 if (read_expected(TEP_EVENT_ITEM, "name") < 0)
1304 return NULL;
1305
1306 if (read_expected(TEP_EVENT_OP, ":") < 0)
1307 return NULL;
1308
1309 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
1310 goto fail;
1311
1312 return token;
1313
1314 fail:
1315 free_token(token);
1316 return NULL;
1317 }
1318
1319 static int event_read_id(void)
1320 {
1321 char *token;
1322 int id;
1323
1324 if (read_expected_item(TEP_EVENT_ITEM, "ID") < 0)
1325 return -1;
1326
1327 if (read_expected(TEP_EVENT_OP, ":") < 0)
1328 return -1;
1329
1330 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
1331 goto fail;
1332
1333 id = strtoul(token, NULL, 0);
1334 free_token(token);
1335 return id;
1336
1337 fail:
1338 free_token(token);
1339 return -1;
1340 }
1341
1342 static int field_is_string(struct tep_format_field *field)
1343 {
1344 if ((field->flags & TEP_FIELD_IS_ARRAY) &&
1345 (strstr(field->type, "char") || strstr(field->type, "u8") ||
1346 strstr(field->type, "s8")))
1347 return 1;
1348
1349 return 0;
1350 }
1351
1352 static int field_is_dynamic(struct tep_format_field *field)
1353 {
1354 if (strncmp(field->type, "__data_loc", 10) == 0)
1355 return 1;
1356
1357 return 0;
1358 }
1359
1360 static int field_is_long(struct tep_format_field *field)
1361 {
1362 /* includes long long */
1363 if (strstr(field->type, "long"))
1364 return 1;
1365
1366 return 0;
1367 }
1368
1369 static unsigned int type_size(const char *name)
1370 {
1371 /* This covers all TEP_FIELD_IS_STRING types. */
1372 static struct {
1373 const char *type;
1374 unsigned int size;
1375 } table[] = {
1376 { "u8", 1 },
1377 { "u16", 2 },
1378 { "u32", 4 },
1379 { "u64", 8 },
1380 { "s8", 1 },
1381 { "s16", 2 },
1382 { "s32", 4 },
1383 { "s64", 8 },
1384 { "char", 1 },
1385 { },
1386 };
1387 int i;
1388
1389 for (i = 0; table[i].type; i++) {
1390 if (!strcmp(table[i].type, name))
1391 return table[i].size;
1392 }
1393
1394 return 0;
1395 }
1396
1397 static int event_read_fields(struct tep_event *event, struct tep_format_field **fields)
1398 {
1399 struct tep_format_field *field = NULL;
1400 enum tep_event_type type;
1401 char *token;
1402 char *last_token;
1403 int count = 0;
1404
1405 do {
1406 unsigned int size_dynamic = 0;
1407
1408 type = read_token(&token);
1409 if (type == TEP_EVENT_NEWLINE) {
1410 free_token(token);
1411 return count;
1412 }
1413
1414 count++;
1415
1416 if (test_type_token(type, token, TEP_EVENT_ITEM, "field"))
1417 goto fail;
1418 free_token(token);
1419
1420 type = read_token(&token);
1421 /*
1422 * The ftrace fields may still use the "special" name.
1423 * Just ignore it.
1424 */
1425 if (event->flags & TEP_EVENT_FL_ISFTRACE &&
1426 type == TEP_EVENT_ITEM && strcmp(token, "special") == 0) {
1427 free_token(token);
1428 type = read_token(&token);
1429 }
1430
1431 if (test_type_token(type, token, TEP_EVENT_OP, ":") < 0)
1432 goto fail;
1433
1434 free_token(token);
1435 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
1436 goto fail;
1437
1438 last_token = token;
1439
1440 field = calloc(1, sizeof(*field));
1441 if (!field)
1442 goto fail;
1443
1444 field->event = event;
1445
1446 /* read the rest of the type */
1447 for (;;) {
1448 type = read_token(&token);
1449 if (type == TEP_EVENT_ITEM ||
1450 (type == TEP_EVENT_OP && strcmp(token, "*") == 0) ||
1451 /*
1452 * Some of the ftrace fields are broken and have
1453 * an illegal "." in them.
1454 */
1455 (event->flags & TEP_EVENT_FL_ISFTRACE &&
1456 type == TEP_EVENT_OP && strcmp(token, ".") == 0)) {
1457
1458 if (strcmp(token, "*") == 0)
1459 field->flags |= TEP_FIELD_IS_POINTER;
1460
1461 if (field->type) {
1462 char *new_type;
1463 new_type = realloc(field->type,
1464 strlen(field->type) +
1465 strlen(last_token) + 2);
1466 if (!new_type) {
1467 free(last_token);
1468 goto fail;
1469 }
1470 field->type = new_type;
1471 strcat(field->type, " ");
1472 strcat(field->type, last_token);
1473 free(last_token);
1474 } else
1475 field->type = last_token;
1476 last_token = token;
1477 continue;
1478 }
1479
1480 break;
1481 }
1482
1483 if (!field->type) {
1484 do_warning_event(event, "%s: no type found", __func__);
1485 goto fail;
1486 }
1487 field->name = field->alias = last_token;
1488
1489 if (test_type(type, TEP_EVENT_OP))
1490 goto fail;
1491
1492 if (strcmp(token, "[") == 0) {
1493 enum tep_event_type last_type = type;
1494 char *brackets = token;
1495 char *new_brackets;
1496 int len;
1497
1498 field->flags |= TEP_FIELD_IS_ARRAY;
1499
1500 type = read_token(&token);
1501
1502 if (type == TEP_EVENT_ITEM)
1503 field->arraylen = strtoul(token, NULL, 0);
1504 else
1505 field->arraylen = 0;
1506
1507 while (strcmp(token, "]") != 0) {
1508 if (last_type == TEP_EVENT_ITEM &&
1509 type == TEP_EVENT_ITEM)
1510 len = 2;
1511 else
1512 len = 1;
1513 last_type = type;
1514
1515 new_brackets = realloc(brackets,
1516 strlen(brackets) +
1517 strlen(token) + len);
1518 if (!new_brackets) {
1519 free(brackets);
1520 goto fail;
1521 }
1522 brackets = new_brackets;
1523 if (len == 2)
1524 strcat(brackets, " ");
1525 strcat(brackets, token);
1526 /* We only care about the last token */
1527 field->arraylen = strtoul(token, NULL, 0);
1528 free_token(token);
1529 type = read_token(&token);
1530 if (type == TEP_EVENT_NONE) {
1531 do_warning_event(event, "failed to find token");
1532 goto fail;
1533 }
1534 }
1535
1536 free_token(token);
1537
1538 new_brackets = realloc(brackets, strlen(brackets) + 2);
1539 if (!new_brackets) {
1540 free(brackets);
1541 goto fail;
1542 }
1543 brackets = new_brackets;
1544 strcat(brackets, "]");
1545
1546 /* add brackets to type */
1547
1548 type = read_token(&token);
1549 /*
1550 * If the next token is not an OP, then it is of
1551 * the format: type [] item;
1552 */
1553 if (type == TEP_EVENT_ITEM) {
1554 char *new_type;
1555 new_type = realloc(field->type,
1556 strlen(field->type) +
1557 strlen(field->name) +
1558 strlen(brackets) + 2);
1559 if (!new_type) {
1560 free(brackets);
1561 goto fail;
1562 }
1563 field->type = new_type;
1564 strcat(field->type, " ");
1565 strcat(field->type, field->name);
1566 size_dynamic = type_size(field->name);
1567 free_token(field->name);
1568 strcat(field->type, brackets);
1569 field->name = field->alias = token;
1570 type = read_token(&token);
1571 } else {
1572 char *new_type;
1573 new_type = realloc(field->type,
1574 strlen(field->type) +
1575 strlen(brackets) + 1);
1576 if (!new_type) {
1577 free(brackets);
1578 goto fail;
1579 }
1580 field->type = new_type;
1581 strcat(field->type, brackets);
1582 }
1583 free(brackets);
1584 }
1585
1586 if (field_is_string(field))
1587 field->flags |= TEP_FIELD_IS_STRING;
1588 if (field_is_dynamic(field))
1589 field->flags |= TEP_FIELD_IS_DYNAMIC;
1590 if (field_is_long(field))
1591 field->flags |= TEP_FIELD_IS_LONG;
1592
1593 if (test_type_token(type, token, TEP_EVENT_OP, ";"))
1594 goto fail;
1595 free_token(token);
1596
1597 if (read_expected(TEP_EVENT_ITEM, "offset") < 0)
1598 goto fail_expect;
1599
1600 if (read_expected(TEP_EVENT_OP, ":") < 0)
1601 goto fail_expect;
1602
1603 if (read_expect_type(TEP_EVENT_ITEM, &token))
1604 goto fail;
1605 field->offset = strtoul(token, NULL, 0);
1606 free_token(token);
1607
1608 if (read_expected(TEP_EVENT_OP, ";") < 0)
1609 goto fail_expect;
1610
1611 if (read_expected(TEP_EVENT_ITEM, "size") < 0)
1612 goto fail_expect;
1613
1614 if (read_expected(TEP_EVENT_OP, ":") < 0)
1615 goto fail_expect;
1616
1617 if (read_expect_type(TEP_EVENT_ITEM, &token))
1618 goto fail;
1619 field->size = strtoul(token, NULL, 0);
1620 free_token(token);
1621
1622 if (read_expected(TEP_EVENT_OP, ";") < 0)
1623 goto fail_expect;
1624
1625 type = read_token(&token);
1626 if (type != TEP_EVENT_NEWLINE) {
1627 /* newer versions of the kernel have a "signed" type */
1628 if (test_type_token(type, token, TEP_EVENT_ITEM, "signed"))
1629 goto fail;
1630
1631 free_token(token);
1632
1633 if (read_expected(TEP_EVENT_OP, ":") < 0)
1634 goto fail_expect;
1635
1636 if (read_expect_type(TEP_EVENT_ITEM, &token))
1637 goto fail;
1638
1639 if (strtoul(token, NULL, 0))
1640 field->flags |= TEP_FIELD_IS_SIGNED;
1641
1642 free_token(token);
1643 if (read_expected(TEP_EVENT_OP, ";") < 0)
1644 goto fail_expect;
1645
1646 if (read_expect_type(TEP_EVENT_NEWLINE, &token))
1647 goto fail;
1648 }
1649
1650 free_token(token);
1651
1652 if (field->flags & TEP_FIELD_IS_ARRAY) {
1653 if (field->arraylen)
1654 field->elementsize = field->size / field->arraylen;
1655 else if (field->flags & TEP_FIELD_IS_DYNAMIC)
1656 field->elementsize = size_dynamic;
1657 else if (field->flags & TEP_FIELD_IS_STRING)
1658 field->elementsize = 1;
1659 else if (field->flags & TEP_FIELD_IS_LONG)
1660 field->elementsize = event->pevent ?
1661 event->pevent->long_size :
1662 sizeof(long);
1663 } else
1664 field->elementsize = field->size;
1665
1666 *fields = field;
1667 fields = &field->next;
1668
1669 } while (1);
1670
1671 return 0;
1672
1673 fail:
1674 free_token(token);
1675 fail_expect:
1676 if (field) {
1677 free(field->type);
1678 free(field->name);
1679 free(field);
1680 }
1681 return -1;
1682 }
1683
1684 static int event_read_format(struct tep_event *event)
1685 {
1686 char *token;
1687 int ret;
1688
1689 if (read_expected_item(TEP_EVENT_ITEM, "format") < 0)
1690 return -1;
1691
1692 if (read_expected(TEP_EVENT_OP, ":") < 0)
1693 return -1;
1694
1695 if (read_expect_type(TEP_EVENT_NEWLINE, &token))
1696 goto fail;
1697 free_token(token);
1698
1699 ret = event_read_fields(event, &event->format.common_fields);
1700 if (ret < 0)
1701 return ret;
1702 event->format.nr_common = ret;
1703
1704 ret = event_read_fields(event, &event->format.fields);
1705 if (ret < 0)
1706 return ret;
1707 event->format.nr_fields = ret;
1708
1709 return 0;
1710
1711 fail:
1712 free_token(token);
1713 return -1;
1714 }
1715
1716 static enum tep_event_type
1717 process_arg_token(struct tep_event *event, struct tep_print_arg *arg,
1718 char **tok, enum tep_event_type type);
1719
1720 static enum tep_event_type
1721 process_arg(struct tep_event *event, struct tep_print_arg *arg, char **tok)
1722 {
1723 enum tep_event_type type;
1724 char *token;
1725
1726 type = read_token(&token);
1727 *tok = token;
1728
1729 return process_arg_token(event, arg, tok, type);
1730 }
1731
1732 static enum tep_event_type
1733 process_op(struct tep_event *event, struct tep_print_arg *arg, char **tok);
1734
1735 /*
1736 * For __print_symbolic() and __print_flags, we need to completely
1737 * evaluate the first argument, which defines what to print next.
1738 */
1739 static enum tep_event_type
1740 process_field_arg(struct tep_event *event, struct tep_print_arg *arg, char **tok)
1741 {
1742 enum tep_event_type type;
1743
1744 type = process_arg(event, arg, tok);
1745
1746 while (type == TEP_EVENT_OP) {
1747 type = process_op(event, arg, tok);
1748 }
1749
1750 return type;
1751 }
1752
1753 static enum tep_event_type
1754 process_cond(struct tep_event *event, struct tep_print_arg *top, char **tok)
1755 {
1756 struct tep_print_arg *arg, *left, *right;
1757 enum tep_event_type type;
1758 char *token = NULL;
1759
1760 arg = alloc_arg();
1761 left = alloc_arg();
1762 right = alloc_arg();
1763
1764 if (!arg || !left || !right) {
1765 do_warning_event(event, "%s: not enough memory!", __func__);
1766 /* arg will be freed at out_free */
1767 free_arg(left);
1768 free_arg(right);
1769 goto out_free;
1770 }
1771
1772 arg->type = TEP_PRINT_OP;
1773 arg->op.left = left;
1774 arg->op.right = right;
1775
1776 *tok = NULL;
1777 type = process_arg(event, left, &token);
1778
1779 again:
1780 if (type == TEP_EVENT_ERROR)
1781 goto out_free;
1782
1783 /* Handle other operations in the arguments */
1784 if (type == TEP_EVENT_OP && strcmp(token, ":") != 0) {
1785 type = process_op(event, left, &token);
1786 goto again;
1787 }
1788
1789 if (test_type_token(type, token, TEP_EVENT_OP, ":"))
1790 goto out_free;
1791
1792 arg->op.op = token;
1793
1794 type = process_arg(event, right, &token);
1795
1796 top->op.right = arg;
1797
1798 *tok = token;
1799 return type;
1800
1801 out_free:
1802 /* Top may point to itself */
1803 top->op.right = NULL;
1804 free_token(token);
1805 free_arg(arg);
1806 return TEP_EVENT_ERROR;
1807 }
1808
1809 static enum tep_event_type
1810 process_array(struct tep_event *event, struct tep_print_arg *top, char **tok)
1811 {
1812 struct tep_print_arg *arg;
1813 enum tep_event_type type;
1814 char *token = NULL;
1815
1816 arg = alloc_arg();
1817 if (!arg) {
1818 do_warning_event(event, "%s: not enough memory!", __func__);
1819 /* '*tok' is set to top->op.op. No need to free. */
1820 *tok = NULL;
1821 return TEP_EVENT_ERROR;
1822 }
1823
1824 *tok = NULL;
1825 type = process_arg(event, arg, &token);
1826 if (test_type_token(type, token, TEP_EVENT_OP, "]"))
1827 goto out_free;
1828
1829 top->op.right = arg;
1830
1831 free_token(token);
1832 type = read_token_item(&token);
1833 *tok = token;
1834
1835 return type;
1836
1837 out_free:
1838 free_token(token);
1839 free_arg(arg);
1840 return TEP_EVENT_ERROR;
1841 }
1842
1843 static int get_op_prio(char *op)
1844 {
1845 if (!op[1]) {
1846 switch (op[0]) {
1847 case '~':
1848 case '!':
1849 return 4;
1850 case '*':
1851 case '/':
1852 case '%':
1853 return 6;
1854 case '+':
1855 case '-':
1856 return 7;
1857 /* '>>' and '<<' are 8 */
1858 case '<':
1859 case '>':
1860 return 9;
1861 /* '==' and '!=' are 10 */
1862 case '&':
1863 return 11;
1864 case '^':
1865 return 12;
1866 case '|':
1867 return 13;
1868 case '?':
1869 return 16;
1870 default:
1871 do_warning("unknown op '%c'", op[0]);
1872 return -1;
1873 }
1874 } else {
1875 if (strcmp(op, "++") == 0 ||
1876 strcmp(op, "--") == 0) {
1877 return 3;
1878 } else if (strcmp(op, ">>") == 0 ||
1879 strcmp(op, "<<") == 0) {
1880 return 8;
1881 } else if (strcmp(op, ">=") == 0 ||
1882 strcmp(op, "<=") == 0) {
1883 return 9;
1884 } else if (strcmp(op, "==") == 0 ||
1885 strcmp(op, "!=") == 0) {
1886 return 10;
1887 } else if (strcmp(op, "&&") == 0) {
1888 return 14;
1889 } else if (strcmp(op, "||") == 0) {
1890 return 15;
1891 } else {
1892 do_warning("unknown op '%s'", op);
1893 return -1;
1894 }
1895 }
1896 }
1897
1898 static int set_op_prio(struct tep_print_arg *arg)
1899 {
1900
1901 /* single ops are the greatest */
1902 if (!arg->op.left || arg->op.left->type == TEP_PRINT_NULL)
1903 arg->op.prio = 0;
1904 else
1905 arg->op.prio = get_op_prio(arg->op.op);
1906
1907 return arg->op.prio;
1908 }
1909
1910 /* Note, *tok does not get freed, but will most likely be saved */
1911 static enum tep_event_type
1912 process_op(struct tep_event *event, struct tep_print_arg *arg, char **tok)
1913 {
1914 struct tep_print_arg *left, *right = NULL;
1915 enum tep_event_type type;
1916 char *token;
1917
1918 /* the op is passed in via tok */
1919 token = *tok;
1920
1921 if (arg->type == TEP_PRINT_OP && !arg->op.left) {
1922 /* handle single op */
1923 if (token[1]) {
1924 do_warning_event(event, "bad op token %s", token);
1925 goto out_free;
1926 }
1927 switch (token[0]) {
1928 case '~':
1929 case '!':
1930 case '+':
1931 case '-':
1932 break;
1933 default:
1934 do_warning_event(event, "bad op token %s", token);
1935 goto out_free;
1936
1937 }
1938
1939 /* make an empty left */
1940 left = alloc_arg();
1941 if (!left)
1942 goto out_warn_free;
1943
1944 left->type = TEP_PRINT_NULL;
1945 arg->op.left = left;
1946
1947 right = alloc_arg();
1948 if (!right)
1949 goto out_warn_free;
1950
1951 arg->op.right = right;
1952
1953 /* do not free the token, it belongs to an op */
1954 *tok = NULL;
1955 type = process_arg(event, right, tok);
1956
1957 } else if (strcmp(token, "?") == 0) {
1958
1959 left = alloc_arg();
1960 if (!left)
1961 goto out_warn_free;
1962
1963 /* copy the top arg to the left */
1964 *left = *arg;
1965
1966 arg->type = TEP_PRINT_OP;
1967 arg->op.op = token;
1968 arg->op.left = left;
1969 arg->op.prio = 0;
1970
1971 /* it will set arg->op.right */
1972 type = process_cond(event, arg, tok);
1973
1974 } else if (strcmp(token, ">>") == 0 ||
1975 strcmp(token, "<<") == 0 ||
1976 strcmp(token, "&") == 0 ||
1977 strcmp(token, "|") == 0 ||
1978 strcmp(token, "&&") == 0 ||
1979 strcmp(token, "||") == 0 ||
1980 strcmp(token, "-") == 0 ||
1981 strcmp(token, "+") == 0 ||
1982 strcmp(token, "*") == 0 ||
1983 strcmp(token, "^") == 0 ||
1984 strcmp(token, "/") == 0 ||
1985 strcmp(token, "%") == 0 ||
1986 strcmp(token, "<") == 0 ||
1987 strcmp(token, ">") == 0 ||
1988 strcmp(token, "<=") == 0 ||
1989 strcmp(token, ">=") == 0 ||
1990 strcmp(token, "==") == 0 ||
1991 strcmp(token, "!=") == 0) {
1992
1993 left = alloc_arg();
1994 if (!left)
1995 goto out_warn_free;
1996
1997 /* copy the top arg to the left */
1998 *left = *arg;
1999
2000 arg->type = TEP_PRINT_OP;
2001 arg->op.op = token;
2002 arg->op.left = left;
2003 arg->op.right = NULL;
2004
2005 if (set_op_prio(arg) == -1) {
2006 event->flags |= TEP_EVENT_FL_FAILED;
2007 /* arg->op.op (= token) will be freed at out_free */
2008 arg->op.op = NULL;
2009 goto out_free;
2010 }
2011
2012 type = read_token_item(&token);
2013 *tok = token;
2014
2015 /* could just be a type pointer */
2016 if ((strcmp(arg->op.op, "*") == 0) &&
2017 type == TEP_EVENT_DELIM && (strcmp(token, ")") == 0)) {
2018 char *new_atom;
2019
2020 if (left->type != TEP_PRINT_ATOM) {
2021 do_warning_event(event, "bad pointer type");
2022 goto out_free;
2023 }
2024 new_atom = realloc(left->atom.atom,
2025 strlen(left->atom.atom) + 3);
2026 if (!new_atom)
2027 goto out_warn_free;
2028
2029 left->atom.atom = new_atom;
2030 strcat(left->atom.atom, " *");
2031 free(arg->op.op);
2032 *arg = *left;
2033 free(left);
2034
2035 return type;
2036 }
2037
2038 right = alloc_arg();
2039 if (!right)
2040 goto out_warn_free;
2041
2042 type = process_arg_token(event, right, tok, type);
2043 if (type == TEP_EVENT_ERROR) {
2044 free_arg(right);
2045 /* token was freed in process_arg_token() via *tok */
2046 token = NULL;
2047 goto out_free;
2048 }
2049
2050 if (right->type == TEP_PRINT_OP &&
2051 get_op_prio(arg->op.op) < get_op_prio(right->op.op)) {
2052 struct tep_print_arg tmp;
2053
2054 /* rotate ops according to the priority */
2055 arg->op.right = right->op.left;
2056
2057 tmp = *arg;
2058 *arg = *right;
2059 *right = tmp;
2060
2061 arg->op.left = right;
2062 } else {
2063 arg->op.right = right;
2064 }
2065
2066 } else if (strcmp(token, "[") == 0) {
2067
2068 left = alloc_arg();
2069 if (!left)
2070 goto out_warn_free;
2071
2072 *left = *arg;
2073
2074 arg->type = TEP_PRINT_OP;
2075 arg->op.op = token;
2076 arg->op.left = left;
2077
2078 arg->op.prio = 0;
2079
2080 /* it will set arg->op.right */
2081 type = process_array(event, arg, tok);
2082
2083 } else {
2084 do_warning_event(event, "unknown op '%s'", token);
2085 event->flags |= TEP_EVENT_FL_FAILED;
2086 /* the arg is now the left side */
2087 goto out_free;
2088 }
2089
2090 if (type == TEP_EVENT_OP && strcmp(*tok, ":") != 0) {
2091 int prio;
2092
2093 /* higher prios need to be closer to the root */
2094 prio = get_op_prio(*tok);
2095
2096 if (prio > arg->op.prio)
2097 return process_op(event, arg, tok);
2098
2099 return process_op(event, right, tok);
2100 }
2101
2102 return type;
2103
2104 out_warn_free:
2105 do_warning_event(event, "%s: not enough memory!", __func__);
2106 out_free:
2107 free_token(token);
2108 *tok = NULL;
2109 return TEP_EVENT_ERROR;
2110 }
2111
2112 static enum tep_event_type
2113 process_entry(struct tep_event *event __maybe_unused, struct tep_print_arg *arg,
2114 char **tok)
2115 {
2116 enum tep_event_type type;
2117 char *field;
2118 char *token;
2119
2120 if (read_expected(TEP_EVENT_OP, "->") < 0)
2121 goto out_err;
2122
2123 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
2124 goto out_free;
2125 field = token;
2126
2127 arg->type = TEP_PRINT_FIELD;
2128 arg->field.name = field;
2129
2130 if (is_flag_field) {
2131 arg->field.field = tep_find_any_field(event, arg->field.name);
2132 arg->field.field->flags |= TEP_FIELD_IS_FLAG;
2133 is_flag_field = 0;
2134 } else if (is_symbolic_field) {
2135 arg->field.field = tep_find_any_field(event, arg->field.name);
2136 arg->field.field->flags |= TEP_FIELD_IS_SYMBOLIC;
2137 is_symbolic_field = 0;
2138 }
2139
2140 type = read_token(&token);
2141 *tok = token;
2142
2143 return type;
2144
2145 out_free:
2146 free_token(token);
2147 out_err:
2148 *tok = NULL;
2149 return TEP_EVENT_ERROR;
2150 }
2151
2152 static int alloc_and_process_delim(struct tep_event *event, char *next_token,
2153 struct tep_print_arg **print_arg)
2154 {
2155 struct tep_print_arg *field;
2156 enum tep_event_type type;
2157 char *token;
2158 int ret = 0;
2159
2160 field = alloc_arg();
2161 if (!field) {
2162 do_warning_event(event, "%s: not enough memory!", __func__);
2163 errno = ENOMEM;
2164 return -1;
2165 }
2166
2167 type = process_arg(event, field, &token);
2168
2169 if (test_type_token(type, token, TEP_EVENT_DELIM, next_token)) {
2170 errno = EINVAL;
2171 ret = -1;
2172 free_arg(field);
2173 goto out_free_token;
2174 }
2175
2176 *print_arg = field;
2177
2178 out_free_token:
2179 free_token(token);
2180
2181 return ret;
2182 }
2183
2184 static char *arg_eval (struct tep_print_arg *arg);
2185
2186 static unsigned long long
2187 eval_type_str(unsigned long long val, const char *type, int pointer)
2188 {
2189 int sign = 0;
2190 char *ref;
2191 int len;
2192
2193 len = strlen(type);
2194
2195 if (pointer) {
2196
2197 if (type[len-1] != '*') {
2198 do_warning("pointer expected with non pointer type");
2199 return val;
2200 }
2201
2202 ref = malloc(len);
2203 if (!ref) {
2204 do_warning("%s: not enough memory!", __func__);
2205 return val;
2206 }
2207 memcpy(ref, type, len);
2208
2209 /* chop off the " *" */
2210 ref[len - 2] = 0;
2211
2212 val = eval_type_str(val, ref, 0);
2213 free(ref);
2214 return val;
2215 }
2216
2217 /* check if this is a pointer */
2218 if (type[len - 1] == '*')
2219 return val;
2220
2221 /* Try to figure out the arg size*/
2222 if (strncmp(type, "struct", 6) == 0)
2223 /* all bets off */
2224 return val;
2225
2226 if (strcmp(type, "u8") == 0)
2227 return val & 0xff;
2228
2229 if (strcmp(type, "u16") == 0)
2230 return val & 0xffff;
2231
2232 if (strcmp(type, "u32") == 0)
2233 return val & 0xffffffff;
2234
2235 if (strcmp(type, "u64") == 0 ||
2236 strcmp(type, "s64"))
2237 return val;
2238
2239 if (strcmp(type, "s8") == 0)
2240 return (unsigned long long)(char)val & 0xff;
2241
2242 if (strcmp(type, "s16") == 0)
2243 return (unsigned long long)(short)val & 0xffff;
2244
2245 if (strcmp(type, "s32") == 0)
2246 return (unsigned long long)(int)val & 0xffffffff;
2247
2248 if (strncmp(type, "unsigned ", 9) == 0) {
2249 sign = 0;
2250 type += 9;
2251 }
2252
2253 if (strcmp(type, "char") == 0) {
2254 if (sign)
2255 return (unsigned long long)(char)val & 0xff;
2256 else
2257 return val & 0xff;
2258 }
2259
2260 if (strcmp(type, "short") == 0) {
2261 if (sign)
2262 return (unsigned long long)(short)val & 0xffff;
2263 else
2264 return val & 0xffff;
2265 }
2266
2267 if (strcmp(type, "int") == 0) {
2268 if (sign)
2269 return (unsigned long long)(int)val & 0xffffffff;
2270 else
2271 return val & 0xffffffff;
2272 }
2273
2274 return val;
2275 }
2276
2277 /*
2278 * Try to figure out the type.
2279 */
2280 static unsigned long long
2281 eval_type(unsigned long long val, struct tep_print_arg *arg, int pointer)
2282 {
2283 if (arg->type != TEP_PRINT_TYPE) {
2284 do_warning("expected type argument");
2285 return 0;
2286 }
2287
2288 return eval_type_str(val, arg->typecast.type, pointer);
2289 }
2290
2291 static int arg_num_eval(struct tep_print_arg *arg, long long *val)
2292 {
2293 long long left, right;
2294 int ret = 1;
2295
2296 switch (arg->type) {
2297 case TEP_PRINT_ATOM:
2298 *val = strtoll(arg->atom.atom, NULL, 0);
2299 break;
2300 case TEP_PRINT_TYPE:
2301 ret = arg_num_eval(arg->typecast.item, val);
2302 if (!ret)
2303 break;
2304 *val = eval_type(*val, arg, 0);
2305 break;
2306 case TEP_PRINT_OP:
2307 switch (arg->op.op[0]) {
2308 case '|':
2309 ret = arg_num_eval(arg->op.left, &left);
2310 if (!ret)
2311 break;
2312 ret = arg_num_eval(arg->op.right, &right);
2313 if (!ret)
2314 break;
2315 if (arg->op.op[1])
2316 *val = left || right;
2317 else
2318 *val = left | right;
2319 break;
2320 case '&':
2321 ret = arg_num_eval(arg->op.left, &left);
2322 if (!ret)
2323 break;
2324 ret = arg_num_eval(arg->op.right, &right);
2325 if (!ret)
2326 break;
2327 if (arg->op.op[1])
2328 *val = left && right;
2329 else
2330 *val = left & right;
2331 break;
2332 case '<':
2333 ret = arg_num_eval(arg->op.left, &left);
2334 if (!ret)
2335 break;
2336 ret = arg_num_eval(arg->op.right, &right);
2337 if (!ret)
2338 break;
2339 switch (arg->op.op[1]) {
2340 case 0:
2341 *val = left < right;
2342 break;
2343 case '<':
2344 *val = left << right;
2345 break;
2346 case '=':
2347 *val = left <= right;
2348 break;
2349 default:
2350 do_warning("unknown op '%s'", arg->op.op);
2351 ret = 0;
2352 }
2353 break;
2354 case '>':
2355 ret = arg_num_eval(arg->op.left, &left);
2356 if (!ret)
2357 break;
2358 ret = arg_num_eval(arg->op.right, &right);
2359 if (!ret)
2360 break;
2361 switch (arg->op.op[1]) {
2362 case 0:
2363 *val = left > right;
2364 break;
2365 case '>':
2366 *val = left >> right;
2367 break;
2368 case '=':
2369 *val = left >= right;
2370 break;
2371 default:
2372 do_warning("unknown op '%s'", arg->op.op);
2373 ret = 0;
2374 }
2375 break;
2376 case '=':
2377 ret = arg_num_eval(arg->op.left, &left);
2378 if (!ret)
2379 break;
2380 ret = arg_num_eval(arg->op.right, &right);
2381 if (!ret)
2382 break;
2383
2384 if (arg->op.op[1] != '=') {
2385 do_warning("unknown op '%s'", arg->op.op);
2386 ret = 0;
2387 } else
2388 *val = left == right;
2389 break;
2390 case '!':
2391 ret = arg_num_eval(arg->op.left, &left);
2392 if (!ret)
2393 break;
2394 ret = arg_num_eval(arg->op.right, &right);
2395 if (!ret)
2396 break;
2397
2398 switch (arg->op.op[1]) {
2399 case '=':
2400 *val = left != right;
2401 break;
2402 default:
2403 do_warning("unknown op '%s'", arg->op.op);
2404 ret = 0;
2405 }
2406 break;
2407 case '-':
2408 /* check for negative */
2409 if (arg->op.left->type == TEP_PRINT_NULL)
2410 left = 0;
2411 else
2412 ret = arg_num_eval(arg->op.left, &left);
2413 if (!ret)
2414 break;
2415 ret = arg_num_eval(arg->op.right, &right);
2416 if (!ret)
2417 break;
2418 *val = left - right;
2419 break;
2420 case '+':
2421 if (arg->op.left->type == TEP_PRINT_NULL)
2422 left = 0;
2423 else
2424 ret = arg_num_eval(arg->op.left, &left);
2425 if (!ret)
2426 break;
2427 ret = arg_num_eval(arg->op.right, &right);
2428 if (!ret)
2429 break;
2430 *val = left + right;
2431 break;
2432 case '~':
2433 ret = arg_num_eval(arg->op.right, &right);
2434 if (!ret)
2435 break;
2436 *val = ~right;
2437 break;
2438 default:
2439 do_warning("unknown op '%s'", arg->op.op);
2440 ret = 0;
2441 }
2442 break;
2443
2444 case TEP_PRINT_NULL:
2445 case TEP_PRINT_FIELD ... TEP_PRINT_SYMBOL:
2446 case TEP_PRINT_STRING:
2447 case TEP_PRINT_BSTRING:
2448 case TEP_PRINT_BITMASK:
2449 default:
2450 do_warning("invalid eval type %d", arg->type);
2451 ret = 0;
2452
2453 }
2454 return ret;
2455 }
2456
2457 static char *arg_eval (struct tep_print_arg *arg)
2458 {
2459 long long val;
2460 static char buf[24];
2461
2462 switch (arg->type) {
2463 case TEP_PRINT_ATOM:
2464 return arg->atom.atom;
2465 case TEP_PRINT_TYPE:
2466 return arg_eval(arg->typecast.item);
2467 case TEP_PRINT_OP:
2468 if (!arg_num_eval(arg, &val))
2469 break;
2470 sprintf(buf, "%lld", val);
2471 return buf;
2472
2473 case TEP_PRINT_NULL:
2474 case TEP_PRINT_FIELD ... TEP_PRINT_SYMBOL:
2475 case TEP_PRINT_STRING:
2476 case TEP_PRINT_BSTRING:
2477 case TEP_PRINT_BITMASK:
2478 default:
2479 do_warning("invalid eval type %d", arg->type);
2480 break;
2481 }
2482
2483 return NULL;
2484 }
2485
2486 static enum tep_event_type
2487 process_fields(struct tep_event *event, struct tep_print_flag_sym **list, char **tok)
2488 {
2489 enum tep_event_type type;
2490 struct tep_print_arg *arg = NULL;
2491 struct tep_print_flag_sym *field;
2492 char *token = *tok;
2493 char *value;
2494
2495 do {
2496 free_token(token);
2497 type = read_token_item(&token);
2498 if (test_type_token(type, token, TEP_EVENT_OP, "{"))
2499 break;
2500
2501 arg = alloc_arg();
2502 if (!arg)
2503 goto out_free;
2504
2505 free_token(token);
2506 type = process_arg(event, arg, &token);
2507
2508 if (type == TEP_EVENT_OP)
2509 type = process_op(event, arg, &token);
2510
2511 if (type == TEP_EVENT_ERROR)
2512 goto out_free;
2513
2514 if (test_type_token(type, token, TEP_EVENT_DELIM, ","))
2515 goto out_free;
2516
2517 field = calloc(1, sizeof(*field));
2518 if (!field)
2519 goto out_free;
2520
2521 value = arg_eval(arg);
2522 if (value == NULL)
2523 goto out_free_field;
2524 field->value = strdup(value);
2525 if (field->value == NULL)
2526 goto out_free_field;
2527
2528 free_arg(arg);
2529 arg = alloc_arg();
2530 if (!arg)
2531 goto out_free;
2532
2533 free_token(token);
2534 type = process_arg(event, arg, &token);
2535 if (test_type_token(type, token, TEP_EVENT_OP, "}"))
2536 goto out_free_field;
2537
2538 value = arg_eval(arg);
2539 if (value == NULL)
2540 goto out_free_field;
2541 field->str = strdup(value);
2542 if (field->str == NULL)
2543 goto out_free_field;
2544 free_arg(arg);
2545 arg = NULL;
2546
2547 *list = field;
2548 list = &field->next;
2549
2550 free_token(token);
2551 type = read_token_item(&token);
2552 } while (type == TEP_EVENT_DELIM && strcmp(token, ",") == 0);
2553
2554 *tok = token;
2555 return type;
2556
2557 out_free_field:
2558 free_flag_sym(field);
2559 out_free:
2560 free_arg(arg);
2561 free_token(token);
2562 *tok = NULL;
2563
2564 return TEP_EVENT_ERROR;
2565 }
2566
2567 static enum tep_event_type
2568 process_flags(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2569 {
2570 struct tep_print_arg *field;
2571 enum tep_event_type type;
2572 char *token = NULL;
2573
2574 memset(arg, 0, sizeof(*arg));
2575 arg->type = TEP_PRINT_FLAGS;
2576
2577 field = alloc_arg();
2578 if (!field) {
2579 do_warning_event(event, "%s: not enough memory!", __func__);
2580 goto out_free;
2581 }
2582
2583 type = process_field_arg(event, field, &token);
2584
2585 /* Handle operations in the first argument */
2586 while (type == TEP_EVENT_OP)
2587 type = process_op(event, field, &token);
2588
2589 if (test_type_token(type, token, TEP_EVENT_DELIM, ","))
2590 goto out_free_field;
2591 free_token(token);
2592
2593 arg->flags.field = field;
2594
2595 type = read_token_item(&token);
2596 if (event_item_type(type)) {
2597 arg->flags.delim = token;
2598 type = read_token_item(&token);
2599 }
2600
2601 if (test_type_token(type, token, TEP_EVENT_DELIM, ","))
2602 goto out_free;
2603
2604 type = process_fields(event, &arg->flags.flags, &token);
2605 if (test_type_token(type, token, TEP_EVENT_DELIM, ")"))
2606 goto out_free;
2607
2608 free_token(token);
2609 type = read_token_item(tok);
2610 return type;
2611
2612 out_free_field:
2613 free_arg(field);
2614 out_free:
2615 free_token(token);
2616 *tok = NULL;
2617 return TEP_EVENT_ERROR;
2618 }
2619
2620 static enum tep_event_type
2621 process_symbols(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2622 {
2623 struct tep_print_arg *field;
2624 enum tep_event_type type;
2625 char *token = NULL;
2626
2627 memset(arg, 0, sizeof(*arg));
2628 arg->type = TEP_PRINT_SYMBOL;
2629
2630 field = alloc_arg();
2631 if (!field) {
2632 do_warning_event(event, "%s: not enough memory!", __func__);
2633 goto out_free;
2634 }
2635
2636 type = process_field_arg(event, field, &token);
2637
2638 if (test_type_token(type, token, TEP_EVENT_DELIM, ","))
2639 goto out_free_field;
2640
2641 arg->symbol.field = field;
2642
2643 type = process_fields(event, &arg->symbol.symbols, &token);
2644 if (test_type_token(type, token, TEP_EVENT_DELIM, ")"))
2645 goto out_free;
2646
2647 free_token(token);
2648 type = read_token_item(tok);
2649 return type;
2650
2651 out_free_field:
2652 free_arg(field);
2653 out_free:
2654 free_token(token);
2655 *tok = NULL;
2656 return TEP_EVENT_ERROR;
2657 }
2658
2659 static enum tep_event_type
2660 process_hex_common(struct tep_event *event, struct tep_print_arg *arg,
2661 char **tok, enum tep_print_arg_type type)
2662 {
2663 memset(arg, 0, sizeof(*arg));
2664 arg->type = type;
2665
2666 if (alloc_and_process_delim(event, ",", &arg->hex.field))
2667 goto out;
2668
2669 if (alloc_and_process_delim(event, ")", &arg->hex.size))
2670 goto free_field;
2671
2672 return read_token_item(tok);
2673
2674 free_field:
2675 free_arg(arg->hex.field);
2676 arg->hex.field = NULL;
2677 out:
2678 *tok = NULL;
2679 return TEP_EVENT_ERROR;
2680 }
2681
2682 static enum tep_event_type
2683 process_hex(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2684 {
2685 return process_hex_common(event, arg, tok, TEP_PRINT_HEX);
2686 }
2687
2688 static enum tep_event_type
2689 process_hex_str(struct tep_event *event, struct tep_print_arg *arg,
2690 char **tok)
2691 {
2692 return process_hex_common(event, arg, tok, TEP_PRINT_HEX_STR);
2693 }
2694
2695 static enum tep_event_type
2696 process_int_array(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2697 {
2698 memset(arg, 0, sizeof(*arg));
2699 arg->type = TEP_PRINT_INT_ARRAY;
2700
2701 if (alloc_and_process_delim(event, ",", &arg->int_array.field))
2702 goto out;
2703
2704 if (alloc_and_process_delim(event, ",", &arg->int_array.count))
2705 goto free_field;
2706
2707 if (alloc_and_process_delim(event, ")", &arg->int_array.el_size))
2708 goto free_size;
2709
2710 return read_token_item(tok);
2711
2712 free_size:
2713 free_arg(arg->int_array.count);
2714 arg->int_array.count = NULL;
2715 free_field:
2716 free_arg(arg->int_array.field);
2717 arg->int_array.field = NULL;
2718 out:
2719 *tok = NULL;
2720 return TEP_EVENT_ERROR;
2721 }
2722
2723 static enum tep_event_type
2724 process_dynamic_array(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2725 {
2726 struct tep_format_field *field;
2727 enum tep_event_type type;
2728 char *token;
2729
2730 memset(arg, 0, sizeof(*arg));
2731 arg->type = TEP_PRINT_DYNAMIC_ARRAY;
2732
2733 /*
2734 * The item within the parenthesis is another field that holds
2735 * the index into where the array starts.
2736 */
2737 type = read_token(&token);
2738 *tok = token;
2739 if (type != TEP_EVENT_ITEM)
2740 goto out_free;
2741
2742 /* Find the field */
2743
2744 field = tep_find_field(event, token);
2745 if (!field)
2746 goto out_free;
2747
2748 arg->dynarray.field = field;
2749 arg->dynarray.index = 0;
2750
2751 if (read_expected(TEP_EVENT_DELIM, ")") < 0)
2752 goto out_free;
2753
2754 free_token(token);
2755 type = read_token_item(&token);
2756 *tok = token;
2757 if (type != TEP_EVENT_OP || strcmp(token, "[") != 0)
2758 return type;
2759
2760 free_token(token);
2761 arg = alloc_arg();
2762 if (!arg) {
2763 do_warning_event(event, "%s: not enough memory!", __func__);
2764 *tok = NULL;
2765 return TEP_EVENT_ERROR;
2766 }
2767
2768 type = process_arg(event, arg, &token);
2769 if (type == TEP_EVENT_ERROR)
2770 goto out_free_arg;
2771
2772 if (!test_type_token(type, token, TEP_EVENT_OP, "]"))
2773 goto out_free_arg;
2774
2775 free_token(token);
2776 type = read_token_item(tok);
2777 return type;
2778
2779 out_free_arg:
2780 free_arg(arg);
2781 out_free:
2782 free_token(token);
2783 *tok = NULL;
2784 return TEP_EVENT_ERROR;
2785 }
2786
2787 static enum tep_event_type
2788 process_dynamic_array_len(struct tep_event *event, struct tep_print_arg *arg,
2789 char **tok)
2790 {
2791 struct tep_format_field *field;
2792 enum tep_event_type type;
2793 char *token;
2794
2795 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
2796 goto out_free;
2797
2798 arg->type = TEP_PRINT_DYNAMIC_ARRAY_LEN;
2799
2800 /* Find the field */
2801 field = tep_find_field(event, token);
2802 if (!field)
2803 goto out_free;
2804
2805 arg->dynarray.field = field;
2806 arg->dynarray.index = 0;
2807
2808 if (read_expected(TEP_EVENT_DELIM, ")") < 0)
2809 goto out_err;
2810
2811 type = read_token(&token);
2812 *tok = token;
2813
2814 return type;
2815
2816 out_free:
2817 free_token(token);
2818 out_err:
2819 *tok = NULL;
2820 return TEP_EVENT_ERROR;
2821 }
2822
2823 static enum tep_event_type
2824 process_paren(struct tep_event *event, struct tep_print_arg *arg, char **tok)
2825 {
2826 struct tep_print_arg *item_arg;
2827 enum tep_event_type type;
2828 char *token;
2829
2830 type = process_arg(event, arg, &token);
2831
2832 if (type == TEP_EVENT_ERROR)
2833 goto out_free;
2834
2835 if (type == TEP_EVENT_OP)
2836 type = process_op(event, arg, &token);
2837
2838 if (type == TEP_EVENT_ERROR)
2839 goto out_free;
2840
2841 if (test_type_token(type, token, TEP_EVENT_DELIM, ")"))
2842 goto out_free;
2843
2844 free_token(token);
2845 type = read_token_item(&token);
2846
2847 /*
2848 * If the next token is an item or another open paren, then
2849 * this was a typecast.
2850 */
2851 if (event_item_type(type) ||
2852 (type == TEP_EVENT_DELIM && strcmp(token, "(") == 0)) {
2853
2854 /* make this a typecast and contine */
2855
2856 /* prevous must be an atom */
2857 if (arg->type != TEP_PRINT_ATOM) {
2858 do_warning_event(event, "previous needed to be TEP_PRINT_ATOM");
2859 goto out_free;
2860 }
2861
2862 item_arg = alloc_arg();
2863 if (!item_arg) {
2864 do_warning_event(event, "%s: not enough memory!",
2865 __func__);
2866 goto out_free;
2867 }
2868
2869 arg->type = TEP_PRINT_TYPE;
2870 arg->typecast.type = arg->atom.atom;
2871 arg->typecast.item = item_arg;
2872 type = process_arg_token(event, item_arg, &token, type);
2873
2874 }
2875
2876 *tok = token;
2877 return type;
2878
2879 out_free:
2880 free_token(token);
2881 *tok = NULL;
2882 return TEP_EVENT_ERROR;
2883 }
2884
2885
2886 static enum tep_event_type
2887 process_str(struct tep_event *event __maybe_unused, struct tep_print_arg *arg,
2888 char **tok)
2889 {
2890 enum tep_event_type type;
2891 char *token;
2892
2893 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
2894 goto out_free;
2895
2896 arg->type = TEP_PRINT_STRING;
2897 arg->string.string = token;
2898 arg->string.offset = -1;
2899
2900 if (read_expected(TEP_EVENT_DELIM, ")") < 0)
2901 goto out_err;
2902
2903 type = read_token(&token);
2904 *tok = token;
2905
2906 return type;
2907
2908 out_free:
2909 free_token(token);
2910 out_err:
2911 *tok = NULL;
2912 return TEP_EVENT_ERROR;
2913 }
2914
2915 static enum tep_event_type
2916 process_bitmask(struct tep_event *event __maybe_unused, struct tep_print_arg *arg,
2917 char **tok)
2918 {
2919 enum tep_event_type type;
2920 char *token;
2921
2922 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
2923 goto out_free;
2924
2925 arg->type = TEP_PRINT_BITMASK;
2926 arg->bitmask.bitmask = token;
2927 arg->bitmask.offset = -1;
2928
2929 if (read_expected(TEP_EVENT_DELIM, ")") < 0)
2930 goto out_err;
2931
2932 type = read_token(&token);
2933 *tok = token;
2934
2935 return type;
2936
2937 out_free:
2938 free_token(token);
2939 out_err:
2940 *tok = NULL;
2941 return TEP_EVENT_ERROR;
2942 }
2943
2944 static struct tep_function_handler *
2945 find_func_handler(struct tep_handle *pevent, char *func_name)
2946 {
2947 struct tep_function_handler *func;
2948
2949 if (!pevent)
2950 return NULL;
2951
2952 for (func = pevent->func_handlers; func; func = func->next) {
2953 if (strcmp(func->name, func_name) == 0)
2954 break;
2955 }
2956
2957 return func;
2958 }
2959
2960 static void remove_func_handler(struct tep_handle *pevent, char *func_name)
2961 {
2962 struct tep_function_handler *func;
2963 struct tep_function_handler **next;
2964
2965 next = &pevent->func_handlers;
2966 while ((func = *next)) {
2967 if (strcmp(func->name, func_name) == 0) {
2968 *next = func->next;
2969 free_func_handle(func);
2970 break;
2971 }
2972 next = &func->next;
2973 }
2974 }
2975
2976 static enum tep_event_type
2977 process_func_handler(struct tep_event *event, struct tep_function_handler *func,
2978 struct tep_print_arg *arg, char **tok)
2979 {
2980 struct tep_print_arg **next_arg;
2981 struct tep_print_arg *farg;
2982 enum tep_event_type type;
2983 char *token;
2984 int i;
2985
2986 arg->type = TEP_PRINT_FUNC;
2987 arg->func.func = func;
2988
2989 *tok = NULL;
2990
2991 next_arg = &(arg->func.args);
2992 for (i = 0; i < func->nr_args; i++) {
2993 farg = alloc_arg();
2994 if (!farg) {
2995 do_warning_event(event, "%s: not enough memory!",
2996 __func__);
2997 return TEP_EVENT_ERROR;
2998 }
2999
3000 type = process_arg(event, farg, &token);
3001 if (i < (func->nr_args - 1)) {
3002 if (type != TEP_EVENT_DELIM || strcmp(token, ",") != 0) {
3003 do_warning_event(event,
3004 "Error: function '%s()' expects %d arguments but event %s only uses %d",
3005 func->name, func->nr_args,
3006 event->name, i + 1);
3007 goto err;
3008 }
3009 } else {
3010 if (type != TEP_EVENT_DELIM || strcmp(token, ")") != 0) {
3011 do_warning_event(event,
3012 "Error: function '%s()' only expects %d arguments but event %s has more",
3013 func->name, func->nr_args, event->name);
3014 goto err;
3015 }
3016 }
3017
3018 *next_arg = farg;
3019 next_arg = &(farg->next);
3020 free_token(token);
3021 }
3022
3023 type = read_token(&token);
3024 *tok = token;
3025
3026 return type;
3027
3028 err:
3029 free_arg(farg);
3030 free_token(token);
3031 return TEP_EVENT_ERROR;
3032 }
3033
3034 static enum tep_event_type
3035 process_function(struct tep_event *event, struct tep_print_arg *arg,
3036 char *token, char **tok)
3037 {
3038 struct tep_function_handler *func;
3039
3040 if (strcmp(token, "__print_flags") == 0) {
3041 free_token(token);
3042 is_flag_field = 1;
3043 return process_flags(event, arg, tok);
3044 }
3045 if (strcmp(token, "__print_symbolic") == 0) {
3046 free_token(token);
3047 is_symbolic_field = 1;
3048 return process_symbols(event, arg, tok);
3049 }
3050 if (strcmp(token, "__print_hex") == 0) {
3051 free_token(token);
3052 return process_hex(event, arg, tok);
3053 }
3054 if (strcmp(token, "__print_hex_str") == 0) {
3055 free_token(token);
3056 return process_hex_str(event, arg, tok);
3057 }
3058 if (strcmp(token, "__print_array") == 0) {
3059 free_token(token);
3060 return process_int_array(event, arg, tok);
3061 }
3062 if (strcmp(token, "__get_str") == 0) {
3063 free_token(token);
3064 return process_str(event, arg, tok);
3065 }
3066 if (strcmp(token, "__get_bitmask") == 0) {
3067 free_token(token);
3068 return process_bitmask(event, arg, tok);
3069 }
3070 if (strcmp(token, "__get_dynamic_array") == 0) {
3071 free_token(token);
3072 return process_dynamic_array(event, arg, tok);
3073 }
3074 if (strcmp(token, "__get_dynamic_array_len") == 0) {
3075 free_token(token);
3076 return process_dynamic_array_len(event, arg, tok);
3077 }
3078
3079 func = find_func_handler(event->pevent, token);
3080 if (func) {
3081 free_token(token);
3082 return process_func_handler(event, func, arg, tok);
3083 }
3084
3085 do_warning_event(event, "function %s not defined", token);
3086 free_token(token);
3087 return TEP_EVENT_ERROR;
3088 }
3089
3090 static enum tep_event_type
3091 process_arg_token(struct tep_event *event, struct tep_print_arg *arg,
3092 char **tok, enum tep_event_type type)
3093 {
3094 char *token;
3095 char *atom;
3096
3097 token = *tok;
3098
3099 switch (type) {
3100 case TEP_EVENT_ITEM:
3101 if (strcmp(token, "REC") == 0) {
3102 free_token(token);
3103 type = process_entry(event, arg, &token);
3104 break;
3105 }
3106 atom = token;
3107 /* test the next token */
3108 type = read_token_item(&token);
3109
3110 /*
3111 * If the next token is a parenthesis, then this
3112 * is a function.
3113 */
3114 if (type == TEP_EVENT_DELIM && strcmp(token, "(") == 0) {
3115 free_token(token);
3116 token = NULL;
3117 /* this will free atom. */
3118 type = process_function(event, arg, atom, &token);
3119 break;
3120 }
3121 /* atoms can be more than one token long */
3122 while (type == TEP_EVENT_ITEM) {
3123 char *new_atom;
3124 new_atom = realloc(atom,
3125 strlen(atom) + strlen(token) + 2);
3126 if (!new_atom) {
3127 free(atom);
3128 *tok = NULL;
3129 free_token(token);
3130 return TEP_EVENT_ERROR;
3131 }
3132 atom = new_atom;
3133 strcat(atom, " ");
3134 strcat(atom, token);
3135 free_token(token);
3136 type = read_token_item(&token);
3137 }
3138
3139 arg->type = TEP_PRINT_ATOM;
3140 arg->atom.atom = atom;
3141 break;
3142
3143 case TEP_EVENT_DQUOTE:
3144 case TEP_EVENT_SQUOTE:
3145 arg->type = TEP_PRINT_ATOM;
3146 arg->atom.atom = token;
3147 type = read_token_item(&token);
3148 break;
3149 case TEP_EVENT_DELIM:
3150 if (strcmp(token, "(") == 0) {
3151 free_token(token);
3152 type = process_paren(event, arg, &token);
3153 break;
3154 }
3155 case TEP_EVENT_OP:
3156 /* handle single ops */
3157 arg->type = TEP_PRINT_OP;
3158 arg->op.op = token;
3159 arg->op.left = NULL;
3160 type = process_op(event, arg, &token);
3161
3162 /* On error, the op is freed */
3163 if (type == TEP_EVENT_ERROR)
3164 arg->op.op = NULL;
3165
3166 /* return error type if errored */
3167 break;
3168
3169 case TEP_EVENT_ERROR ... TEP_EVENT_NEWLINE:
3170 default:
3171 do_warning_event(event, "unexpected type %d", type);
3172 return TEP_EVENT_ERROR;
3173 }
3174 *tok = token;
3175
3176 return type;
3177 }
3178
3179 static int event_read_print_args(struct tep_event *event, struct tep_print_arg **list)
3180 {
3181 enum tep_event_type type = TEP_EVENT_ERROR;
3182 struct tep_print_arg *arg;
3183 char *token;
3184 int args = 0;
3185
3186 do {
3187 if (type == TEP_EVENT_NEWLINE) {
3188 type = read_token_item(&token);
3189 continue;
3190 }
3191
3192 arg = alloc_arg();
3193 if (!arg) {
3194 do_warning_event(event, "%s: not enough memory!",
3195 __func__);
3196 return -1;
3197 }
3198
3199 type = process_arg(event, arg, &token);
3200
3201 if (type == TEP_EVENT_ERROR) {
3202 free_token(token);
3203 free_arg(arg);
3204 return -1;
3205 }
3206
3207 *list = arg;
3208 args++;
3209
3210 if (type == TEP_EVENT_OP) {
3211 type = process_op(event, arg, &token);
3212 free_token(token);
3213 if (type == TEP_EVENT_ERROR) {
3214 *list = NULL;
3215 free_arg(arg);
3216 return -1;
3217 }
3218 list = &arg->next;
3219 continue;
3220 }
3221
3222 if (type == TEP_EVENT_DELIM && strcmp(token, ",") == 0) {
3223 free_token(token);
3224 *list = arg;
3225 list = &arg->next;
3226 continue;
3227 }
3228 break;
3229 } while (type != TEP_EVENT_NONE);
3230
3231 if (type != TEP_EVENT_NONE && type != TEP_EVENT_ERROR)
3232 free_token(token);
3233
3234 return args;
3235 }
3236
3237 static int event_read_print(struct tep_event *event)
3238 {
3239 enum tep_event_type type;
3240 char *token;
3241 int ret;
3242
3243 if (read_expected_item(TEP_EVENT_ITEM, "print") < 0)
3244 return -1;
3245
3246 if (read_expected(TEP_EVENT_ITEM, "fmt") < 0)
3247 return -1;
3248
3249 if (read_expected(TEP_EVENT_OP, ":") < 0)
3250 return -1;
3251
3252 if (read_expect_type(TEP_EVENT_DQUOTE, &token) < 0)
3253 goto fail;
3254
3255 concat:
3256 event->print_fmt.format = token;
3257 event->print_fmt.args = NULL;
3258
3259 /* ok to have no arg */
3260 type = read_token_item(&token);
3261
3262 if (type == TEP_EVENT_NONE)
3263 return 0;
3264
3265 /* Handle concatenation of print lines */
3266 if (type == TEP_EVENT_DQUOTE) {
3267 char *cat;
3268
3269 if (asprintf(&cat, "%s%s", event->print_fmt.format, token) < 0)
3270 goto fail;
3271 free_token(token);
3272 free_token(event->print_fmt.format);
3273 event->print_fmt.format = NULL;
3274 token = cat;
3275 goto concat;
3276 }
3277
3278 if (test_type_token(type, token, TEP_EVENT_DELIM, ","))
3279 goto fail;
3280
3281 free_token(token);
3282
3283 ret = event_read_print_args(event, &event->print_fmt.args);
3284 if (ret < 0)
3285 return -1;
3286
3287 return ret;
3288
3289 fail:
3290 free_token(token);
3291 return -1;
3292 }
3293
3294 /**
3295 * tep_find_common_field - return a common field by event
3296 * @event: handle for the event
3297 * @name: the name of the common field to return
3298 *
3299 * Returns a common field from the event by the given @name.
3300 * This only searches the common fields and not all field.
3301 */
3302 struct tep_format_field *
3303 tep_find_common_field(struct tep_event *event, const char *name)
3304 {
3305 struct tep_format_field *format;
3306
3307 for (format = event->format.common_fields;
3308 format; format = format->next) {
3309 if (strcmp(format->name, name) == 0)
3310 break;
3311 }
3312
3313 return format;
3314 }
3315
3316 /**
3317 * tep_find_field - find a non-common field
3318 * @event: handle for the event
3319 * @name: the name of the non-common field
3320 *
3321 * Returns a non-common field by the given @name.
3322 * This does not search common fields.
3323 */
3324 struct tep_format_field *
3325 tep_find_field(struct tep_event *event, const char *name)
3326 {
3327 struct tep_format_field *format;
3328
3329 for (format = event->format.fields;
3330 format; format = format->next) {
3331 if (strcmp(format->name, name) == 0)
3332 break;
3333 }
3334
3335 return format;
3336 }
3337
3338 /**
3339 * tep_find_any_field - find any field by name
3340 * @event: handle for the event
3341 * @name: the name of the field
3342 *
3343 * Returns a field by the given @name.
3344 * This searches the common field names first, then
3345 * the non-common ones if a common one was not found.
3346 */
3347 struct tep_format_field *
3348 tep_find_any_field(struct tep_event *event, const char *name)
3349 {
3350 struct tep_format_field *format;
3351
3352 format = tep_find_common_field(event, name);
3353 if (format)
3354 return format;
3355 return tep_find_field(event, name);
3356 }
3357
3358 /**
3359 * tep_read_number - read a number from data
3360 * @pevent: handle for the pevent
3361 * @ptr: the raw data
3362 * @size: the size of the data that holds the number
3363 *
3364 * Returns the number (converted to host) from the
3365 * raw data.
3366 */
3367 unsigned long long tep_read_number(struct tep_handle *pevent,
3368 const void *ptr, int size)
3369 {
3370 unsigned long long val;
3371
3372 switch (size) {
3373 case 1:
3374 return *(unsigned char *)ptr;
3375 case 2:
3376 return tep_data2host2(pevent, *(unsigned short *)ptr);
3377 case 4:
3378 return tep_data2host4(pevent, *(unsigned int *)ptr);
3379 case 8:
3380 memcpy(&val, (ptr), sizeof(unsigned long long));
3381 return tep_data2host8(pevent, val);
3382 default:
3383 /* BUG! */
3384 return 0;
3385 }
3386 }
3387
3388 /**
3389 * tep_read_number_field - read a number from data
3390 * @field: a handle to the field
3391 * @data: the raw data to read
3392 * @value: the value to place the number in
3393 *
3394 * Reads raw data according to a field offset and size,
3395 * and translates it into @value.
3396 *
3397 * Returns 0 on success, -1 otherwise.
3398 */
3399 int tep_read_number_field(struct tep_format_field *field, const void *data,
3400 unsigned long long *value)
3401 {
3402 if (!field)
3403 return -1;
3404 switch (field->size) {
3405 case 1:
3406 case 2:
3407 case 4:
3408 case 8:
3409 *value = tep_read_number(field->event->pevent,
3410 data + field->offset, field->size);
3411 return 0;
3412 default:
3413 return -1;
3414 }
3415 }
3416
3417 static int get_common_info(struct tep_handle *pevent,
3418 const char *type, int *offset, int *size)
3419 {
3420 struct tep_event *event;
3421 struct tep_format_field *field;
3422
3423 /*
3424 * All events should have the same common elements.
3425 * Pick any event to find where the type is;
3426 */
3427 if (!pevent->events) {
3428 do_warning("no event_list!");
3429 return -1;
3430 }
3431
3432 event = pevent->events[0];
3433 field = tep_find_common_field(event, type);
3434 if (!field)
3435 return -1;
3436
3437 *offset = field->offset;
3438 *size = field->size;
3439
3440 return 0;
3441 }
3442
3443 static int __parse_common(struct tep_handle *pevent, void *data,
3444 int *size, int *offset, const char *name)
3445 {
3446 int ret;
3447
3448 if (!*size) {
3449 ret = get_common_info(pevent, name, offset, size);
3450 if (ret < 0)
3451 return ret;
3452 }
3453 return tep_read_number(pevent, data + *offset, *size);
3454 }
3455
3456 static int trace_parse_common_type(struct tep_handle *pevent, void *data)
3457 {
3458 return __parse_common(pevent, data,
3459 &pevent->type_size, &pevent->type_offset,
3460 "common_type");
3461 }
3462
3463 static int parse_common_pid(struct tep_handle *pevent, void *data)
3464 {
3465 return __parse_common(pevent, data,
3466 &pevent->pid_size, &pevent->pid_offset,
3467 "common_pid");
3468 }
3469
3470 static int parse_common_pc(struct tep_handle *pevent, void *data)
3471 {
3472 return __parse_common(pevent, data,
3473 &pevent->pc_size, &pevent->pc_offset,
3474 "common_preempt_count");
3475 }
3476
3477 static int parse_common_flags(struct tep_handle *pevent, void *data)
3478 {
3479 return __parse_common(pevent, data,
3480 &pevent->flags_size, &pevent->flags_offset,
3481 "common_flags");
3482 }
3483
3484 static int parse_common_lock_depth(struct tep_handle *pevent, void *data)
3485 {
3486 return __parse_common(pevent, data,
3487 &pevent->ld_size, &pevent->ld_offset,
3488 "common_lock_depth");
3489 }
3490
3491 static int parse_common_migrate_disable(struct tep_handle *pevent, void *data)
3492 {
3493 return __parse_common(pevent, data,
3494 &pevent->ld_size, &pevent->ld_offset,
3495 "common_migrate_disable");
3496 }
3497
3498 static int events_id_cmp(const void *a, const void *b);
3499
3500 /**
3501 * tep_find_event - find an event by given id
3502 * @pevent: a handle to the pevent
3503 * @id: the id of the event
3504 *
3505 * Returns an event that has a given @id.
3506 */
3507 struct tep_event *tep_find_event(struct tep_handle *pevent, int id)
3508 {
3509 struct tep_event **eventptr;
3510 struct tep_event key;
3511 struct tep_event *pkey = &key;
3512
3513 /* Check cache first */
3514 if (pevent->last_event && pevent->last_event->id == id)
3515 return pevent->last_event;
3516
3517 key.id = id;
3518
3519 eventptr = bsearch(&pkey, pevent->events, pevent->nr_events,
3520 sizeof(*pevent->events), events_id_cmp);
3521
3522 if (eventptr) {
3523 pevent->last_event = *eventptr;
3524 return *eventptr;
3525 }
3526
3527 return NULL;
3528 }
3529
3530 /**
3531 * tep_find_event_by_name - find an event by given name
3532 * @pevent: a handle to the pevent
3533 * @sys: the system name to search for
3534 * @name: the name of the event to search for
3535 *
3536 * This returns an event with a given @name and under the system
3537 * @sys. If @sys is NULL the first event with @name is returned.
3538 */
3539 struct tep_event *
3540 tep_find_event_by_name(struct tep_handle *pevent,
3541 const char *sys, const char *name)
3542 {
3543 struct tep_event *event = NULL;
3544 int i;
3545
3546 if (pevent->last_event &&
3547 strcmp(pevent->last_event->name, name) == 0 &&
3548 (!sys || strcmp(pevent->last_event->system, sys) == 0))
3549 return pevent->last_event;
3550
3551 for (i = 0; i < pevent->nr_events; i++) {
3552 event = pevent->events[i];
3553 if (strcmp(event->name, name) == 0) {
3554 if (!sys)
3555 break;
3556 if (strcmp(event->system, sys) == 0)
3557 break;
3558 }
3559 }
3560 if (i == pevent->nr_events)
3561 event = NULL;
3562
3563 pevent->last_event = event;
3564 return event;
3565 }
3566
3567 static unsigned long long
3568 eval_num_arg(void *data, int size, struct tep_event *event, struct tep_print_arg *arg)
3569 {
3570 struct tep_handle *pevent = event->pevent;
3571 unsigned long long val = 0;
3572 unsigned long long left, right;
3573 struct tep_print_arg *typearg = NULL;
3574 struct tep_print_arg *larg;
3575 unsigned long offset;
3576 unsigned int field_size;
3577
3578 switch (arg->type) {
3579 case TEP_PRINT_NULL:
3580 /* ?? */
3581 return 0;
3582 case TEP_PRINT_ATOM:
3583 return strtoull(arg->atom.atom, NULL, 0);
3584 case TEP_PRINT_FIELD:
3585 if (!arg->field.field) {
3586 arg->field.field = tep_find_any_field(event, arg->field.name);
3587 if (!arg->field.field)
3588 goto out_warning_field;
3589
3590 }
3591 /* must be a number */
3592 val = tep_read_number(pevent, data + arg->field.field->offset,
3593 arg->field.field->size);
3594 break;
3595 case TEP_PRINT_FLAGS:
3596 case TEP_PRINT_SYMBOL:
3597 case TEP_PRINT_INT_ARRAY:
3598 case TEP_PRINT_HEX:
3599 case TEP_PRINT_HEX_STR:
3600 break;
3601 case TEP_PRINT_TYPE:
3602 val = eval_num_arg(data, size, event, arg->typecast.item);
3603 return eval_type(val, arg, 0);
3604 case TEP_PRINT_STRING:
3605 case TEP_PRINT_BSTRING:
3606 case TEP_PRINT_BITMASK:
3607 return 0;
3608 case TEP_PRINT_FUNC: {
3609 struct trace_seq s;
3610 trace_seq_init(&s);
3611 val = process_defined_func(&s, data, size, event, arg);
3612 trace_seq_destroy(&s);
3613 return val;
3614 }
3615 case TEP_PRINT_OP:
3616 if (strcmp(arg->op.op, "[") == 0) {
3617 /*
3618 * Arrays are special, since we don't want
3619 * to read the arg as is.
3620 */
3621 right = eval_num_arg(data, size, event, arg->op.right);
3622
3623 /* handle typecasts */
3624 larg = arg->op.left;
3625 while (larg->type == TEP_PRINT_TYPE) {
3626 if (!typearg)
3627 typearg = larg;
3628 larg = larg->typecast.item;
3629 }
3630
3631 /* Default to long size */
3632 field_size = pevent->long_size;
3633
3634 switch (larg->type) {
3635 case TEP_PRINT_DYNAMIC_ARRAY:
3636 offset = tep_read_number(pevent,
3637 data + larg->dynarray.field->offset,
3638 larg->dynarray.field->size);
3639 if (larg->dynarray.field->elementsize)
3640 field_size = larg->dynarray.field->elementsize;
3641 /*
3642 * The actual length of the dynamic array is stored
3643 * in the top half of the field, and the offset
3644 * is in the bottom half of the 32 bit field.
3645 */
3646 offset &= 0xffff;
3647 offset += right;
3648 break;
3649 case TEP_PRINT_FIELD:
3650 if (!larg->field.field) {
3651 larg->field.field =
3652 tep_find_any_field(event, larg->field.name);
3653 if (!larg->field.field) {
3654 arg = larg;
3655 goto out_warning_field;
3656 }
3657 }
3658 field_size = larg->field.field->elementsize;
3659 offset = larg->field.field->offset +
3660 right * larg->field.field->elementsize;
3661 break;
3662 default:
3663 goto default_op; /* oops, all bets off */
3664 }
3665 val = tep_read_number(pevent,
3666 data + offset, field_size);
3667 if (typearg)
3668 val = eval_type(val, typearg, 1);
3669 break;
3670 } else if (strcmp(arg->op.op, "?") == 0) {
3671 left = eval_num_arg(data, size, event, arg->op.left);
3672 arg = arg->op.right;
3673 if (left)
3674 val = eval_num_arg(data, size, event, arg->op.left);
3675 else
3676 val = eval_num_arg(data, size, event, arg->op.right);
3677 break;
3678 }
3679 default_op:
3680 left = eval_num_arg(data, size, event, arg->op.left);
3681 right = eval_num_arg(data, size, event, arg->op.right);
3682 switch (arg->op.op[0]) {
3683 case '!':
3684 switch (arg->op.op[1]) {
3685 case 0:
3686 val = !right;
3687 break;
3688 case '=':
3689 val = left != right;
3690 break;
3691 default:
3692 goto out_warning_op;
3693 }
3694 break;
3695 case '~':
3696 val = ~right;
3697 break;
3698 case '|':
3699 if (arg->op.op[1])
3700 val = left || right;
3701 else
3702 val = left | right;
3703 break;
3704 case '&':
3705 if (arg->op.op[1])
3706 val = left && right;
3707 else
3708 val = left & right;
3709 break;
3710 case '<':
3711 switch (arg->op.op[1]) {
3712 case 0:
3713 val = left < right;
3714 break;
3715 case '<':
3716 val = left << right;
3717 break;
3718 case '=':
3719 val = left <= right;
3720 break;
3721 default:
3722 goto out_warning_op;
3723 }
3724 break;
3725 case '>':
3726 switch (arg->op.op[1]) {
3727 case 0:
3728 val = left > right;
3729 break;
3730 case '>':
3731 val = left >> right;
3732 break;
3733 case '=':
3734 val = left >= right;
3735 break;
3736 default:
3737 goto out_warning_op;
3738 }
3739 break;
3740 case '=':
3741 if (arg->op.op[1] != '=')
3742 goto out_warning_op;
3743
3744 val = left == right;
3745 break;
3746 case '-':
3747 val = left - right;
3748 break;
3749 case '+':
3750 val = left + right;
3751 break;
3752 case '/':
3753 val = left / right;
3754 break;
3755 case '%':
3756 val = left % right;
3757 break;
3758 case '*':
3759 val = left * right;
3760 break;
3761 default:
3762 goto out_warning_op;
3763 }
3764 break;
3765 case TEP_PRINT_DYNAMIC_ARRAY_LEN:
3766 offset = tep_read_number(pevent,
3767 data + arg->dynarray.field->offset,
3768 arg->dynarray.field->size);
3769 /*
3770 * The total allocated length of the dynamic array is
3771 * stored in the top half of the field, and the offset
3772 * is in the bottom half of the 32 bit field.
3773 */
3774 val = (unsigned long long)(offset >> 16);
3775 break;
3776 case TEP_PRINT_DYNAMIC_ARRAY:
3777 /* Without [], we pass the address to the dynamic data */
3778 offset = tep_read_number(pevent,
3779 data + arg->dynarray.field->offset,
3780 arg->dynarray.field->size);
3781 /*
3782 * The total allocated length of the dynamic array is
3783 * stored in the top half of the field, and the offset
3784 * is in the bottom half of the 32 bit field.
3785 */
3786 offset &= 0xffff;
3787 val = (unsigned long long)((unsigned long)data + offset);
3788 break;
3789 default: /* not sure what to do there */
3790 return 0;
3791 }
3792 return val;
3793
3794 out_warning_op:
3795 do_warning_event(event, "%s: unknown op '%s'", __func__, arg->op.op);
3796 return 0;
3797
3798 out_warning_field:
3799 do_warning_event(event, "%s: field %s not found",
3800 __func__, arg->field.name);
3801 return 0;
3802 }
3803
3804 struct flag {
3805 const char *name;
3806 unsigned long long value;
3807 };
3808
3809 static const struct flag flags[] = {
3810 { "HI_SOFTIRQ", 0 },
3811 { "TIMER_SOFTIRQ", 1 },
3812 { "NET_TX_SOFTIRQ", 2 },
3813 { "NET_RX_SOFTIRQ", 3 },
3814 { "BLOCK_SOFTIRQ", 4 },
3815 { "IRQ_POLL_SOFTIRQ", 5 },
3816 { "TASKLET_SOFTIRQ", 6 },
3817 { "SCHED_SOFTIRQ", 7 },
3818 { "HRTIMER_SOFTIRQ", 8 },
3819 { "RCU_SOFTIRQ", 9 },
3820
3821 { "HRTIMER_NORESTART", 0 },
3822 { "HRTIMER_RESTART", 1 },
3823 };
3824
3825 static long long eval_flag(const char *flag)
3826 {
3827 int i;
3828
3829 /*
3830 * Some flags in the format files do not get converted.
3831 * If the flag is not numeric, see if it is something that
3832 * we already know about.
3833 */
3834 if (isdigit(flag[0]))
3835 return strtoull(flag, NULL, 0);
3836
3837 for (i = 0; i < (int)(sizeof(flags)/sizeof(flags[0])); i++)
3838 if (strcmp(flags[i].name, flag) == 0)
3839 return flags[i].value;
3840
3841 return -1LL;
3842 }
3843
3844 static void print_str_to_seq(struct trace_seq *s, const char *format,
3845 int len_arg, const char *str)
3846 {
3847 if (len_arg >= 0)
3848 trace_seq_printf(s, format, len_arg, str);
3849 else
3850 trace_seq_printf(s, format, str);
3851 }
3852
3853 static void print_bitmask_to_seq(struct tep_handle *pevent,
3854 struct trace_seq *s, const char *format,
3855 int len_arg, const void *data, int size)
3856 {
3857 int nr_bits = size * 8;
3858 int str_size = (nr_bits + 3) / 4;
3859 int len = 0;
3860 char buf[3];
3861 char *str;
3862 int index;
3863 int i;
3864
3865 /*
3866 * The kernel likes to put in commas every 32 bits, we
3867 * can do the same.
3868 */
3869 str_size += (nr_bits - 1) / 32;
3870
3871 str = malloc(str_size + 1);
3872 if (!str) {
3873 do_warning("%s: not enough memory!", __func__);
3874 return;
3875 }
3876 str[str_size] = 0;
3877
3878 /* Start out with -2 for the two chars per byte */
3879 for (i = str_size - 2; i >= 0; i -= 2) {
3880 /*
3881 * data points to a bit mask of size bytes.
3882 * In the kernel, this is an array of long words, thus
3883 * endianness is very important.
3884 */
3885 if (pevent->file_bigendian)
3886 index = size - (len + 1);
3887 else
3888 index = len;
3889
3890 snprintf(buf, 3, "%02x", *((unsigned char *)data + index));
3891 memcpy(str + i, buf, 2);
3892 len++;
3893 if (!(len & 3) && i > 0) {
3894 i--;
3895 str[i] = ',';
3896 }
3897 }
3898
3899 if (len_arg >= 0)
3900 trace_seq_printf(s, format, len_arg, str);
3901 else
3902 trace_seq_printf(s, format, str);
3903
3904 free(str);
3905 }
3906
3907 static void print_str_arg(struct trace_seq *s, void *data, int size,
3908 struct tep_event *event, const char *format,
3909 int len_arg, struct tep_print_arg *arg)
3910 {
3911 struct tep_handle *pevent = event->pevent;
3912 struct tep_print_flag_sym *flag;
3913 struct tep_format_field *field;
3914 struct printk_map *printk;
3915 long long val, fval;
3916 unsigned long long addr;
3917 char *str;
3918 unsigned char *hex;
3919 int print;
3920 int i, len;
3921
3922 switch (arg->type) {
3923 case TEP_PRINT_NULL:
3924 /* ?? */
3925 return;
3926 case TEP_PRINT_ATOM:
3927 print_str_to_seq(s, format, len_arg, arg->atom.atom);
3928 return;
3929 case TEP_PRINT_FIELD:
3930 field = arg->field.field;
3931 if (!field) {
3932 field = tep_find_any_field(event, arg->field.name);
3933 if (!field) {
3934 str = arg->field.name;
3935 goto out_warning_field;
3936 }
3937 arg->field.field = field;
3938 }
3939 /* Zero sized fields, mean the rest of the data */
3940 len = field->size ? : size - field->offset;
3941
3942 /*
3943 * Some events pass in pointers. If this is not an array
3944 * and the size is the same as long_size, assume that it
3945 * is a pointer.
3946 */
3947 if (!(field->flags & TEP_FIELD_IS_ARRAY) &&
3948 field->size == pevent->long_size) {
3949
3950 /* Handle heterogeneous recording and processing
3951 * architectures
3952 *
3953 * CASE I:
3954 * Traces recorded on 32-bit devices (32-bit
3955 * addressing) and processed on 64-bit devices:
3956 * In this case, only 32 bits should be read.
3957 *
3958 * CASE II:
3959 * Traces recorded on 64 bit devices and processed
3960 * on 32-bit devices:
3961 * In this case, 64 bits must be read.
3962 */
3963 addr = (pevent->long_size == 8) ?
3964 *(unsigned long long *)(data + field->offset) :
3965 (unsigned long long)*(unsigned int *)(data + field->offset);
3966
3967 /* Check if it matches a print format */
3968 printk = find_printk(pevent, addr);
3969 if (printk)
3970 trace_seq_puts(s, printk->printk);
3971 else
3972 trace_seq_printf(s, "%llx", addr);
3973 break;
3974 }
3975 str = malloc(len + 1);
3976 if (!str) {
3977 do_warning_event(event, "%s: not enough memory!",
3978 __func__);
3979 return;
3980 }
3981 memcpy(str, data + field->offset, len);
3982 str[len] = 0;
3983 print_str_to_seq(s, format, len_arg, str);
3984 free(str);
3985 break;
3986 case TEP_PRINT_FLAGS:
3987 val = eval_num_arg(data, size, event, arg->flags.field);
3988 print = 0;
3989 for (flag = arg->flags.flags; flag; flag = flag->next) {
3990 fval = eval_flag(flag->value);
3991 if (!val && fval < 0) {
3992 print_str_to_seq(s, format, len_arg, flag->str);
3993 break;
3994 }
3995 if (fval > 0 && (val & fval) == fval) {
3996 if (print && arg->flags.delim)
3997 trace_seq_puts(s, arg->flags.delim);
3998 print_str_to_seq(s, format, len_arg, flag->str);
3999 print = 1;
4000 val &= ~fval;
4001 }
4002 }
4003 if (val) {
4004 if (print && arg->flags.delim)
4005 trace_seq_puts(s, arg->flags.delim);
4006 trace_seq_printf(s, "0x%llx", val);
4007 }
4008 break;
4009 case TEP_PRINT_SYMBOL:
4010 val = eval_num_arg(data, size, event, arg->symbol.field);
4011 for (flag = arg->symbol.symbols; flag; flag = flag->next) {
4012 fval = eval_flag(flag->value);
4013 if (val == fval) {
4014 print_str_to_seq(s, format, len_arg, flag->str);
4015 break;
4016 }
4017 }
4018 if (!flag)
4019 trace_seq_printf(s, "0x%llx", val);
4020 break;
4021 case TEP_PRINT_HEX:
4022 case TEP_PRINT_HEX_STR:
4023 if (arg->hex.field->type == TEP_PRINT_DYNAMIC_ARRAY) {
4024 unsigned long offset;
4025 offset = tep_read_number(pevent,
4026 data + arg->hex.field->dynarray.field->offset,
4027 arg->hex.field->dynarray.field->size);
4028 hex = data + (offset & 0xffff);
4029 } else {
4030 field = arg->hex.field->field.field;
4031 if (!field) {
4032 str = arg->hex.field->field.name;
4033 field = tep_find_any_field(event, str);
4034 if (!field)
4035 goto out_warning_field;
4036 arg->hex.field->field.field = field;
4037 }
4038 hex = data + field->offset;
4039 }
4040 len = eval_num_arg(data, size, event, arg->hex.size);
4041 for (i = 0; i < len; i++) {
4042 if (i && arg->type == TEP_PRINT_HEX)
4043 trace_seq_putc(s, ' ');
4044 trace_seq_printf(s, "%02x", hex[i]);
4045 }
4046 break;
4047
4048 case TEP_PRINT_INT_ARRAY: {
4049 void *num;
4050 int el_size;
4051
4052 if (arg->int_array.field->type == TEP_PRINT_DYNAMIC_ARRAY) {
4053 unsigned long offset;
4054 struct tep_format_field *field =
4055 arg->int_array.field->dynarray.field;
4056 offset = tep_read_number(pevent,
4057 data + field->offset,
4058 field->size);
4059 num = data + (offset & 0xffff);
4060 } else {
4061 field = arg->int_array.field->field.field;
4062 if (!field) {
4063 str = arg->int_array.field->field.name;
4064 field = tep_find_any_field(event, str);
4065 if (!field)
4066 goto out_warning_field;
4067 arg->int_array.field->field.field = field;
4068 }
4069 num = data + field->offset;
4070 }
4071 len = eval_num_arg(data, size, event, arg->int_array.count);
4072 el_size = eval_num_arg(data, size, event,
4073 arg->int_array.el_size);
4074 for (i = 0; i < len; i++) {
4075 if (i)
4076 trace_seq_putc(s, ' ');
4077
4078 if (el_size == 1) {
4079 trace_seq_printf(s, "%u", *(uint8_t *)num);
4080 } else if (el_size == 2) {
4081 trace_seq_printf(s, "%u", *(uint16_t *)num);
4082 } else if (el_size == 4) {
4083 trace_seq_printf(s, "%u", *(uint32_t *)num);
4084 } else if (el_size == 8) {
4085 trace_seq_printf(s, "%"PRIu64, *(uint64_t *)num);
4086 } else {
4087 trace_seq_printf(s, "BAD SIZE:%d 0x%x",
4088 el_size, *(uint8_t *)num);
4089 el_size = 1;
4090 }
4091
4092 num += el_size;
4093 }
4094 break;
4095 }
4096 case TEP_PRINT_TYPE:
4097 break;
4098 case TEP_PRINT_STRING: {
4099 int str_offset;
4100
4101 if (arg->string.offset == -1) {
4102 struct tep_format_field *f;
4103
4104 f = tep_find_any_field(event, arg->string.string);
4105 arg->string.offset = f->offset;
4106 }
4107 str_offset = tep_data2host4(pevent, *(unsigned int *)(data + arg->string.offset));
4108 str_offset &= 0xffff;
4109 print_str_to_seq(s, format, len_arg, ((char *)data) + str_offset);
4110 break;
4111 }
4112 case TEP_PRINT_BSTRING:
4113 print_str_to_seq(s, format, len_arg, arg->string.string);
4114 break;
4115 case TEP_PRINT_BITMASK: {
4116 int bitmask_offset;
4117 int bitmask_size;
4118
4119 if (arg->bitmask.offset == -1) {
4120 struct tep_format_field *f;
4121
4122 f = tep_find_any_field(event, arg->bitmask.bitmask);
4123 arg->bitmask.offset = f->offset;
4124 }
4125 bitmask_offset = tep_data2host4(pevent, *(unsigned int *)(data + arg->bitmask.offset));
4126 bitmask_size = bitmask_offset >> 16;
4127 bitmask_offset &= 0xffff;
4128 print_bitmask_to_seq(pevent, s, format, len_arg,
4129 data + bitmask_offset, bitmask_size);
4130 break;
4131 }
4132 case TEP_PRINT_OP:
4133 /*
4134 * The only op for string should be ? :
4135 */
4136 if (arg->op.op[0] != '?')
4137 return;
4138 val = eval_num_arg(data, size, event, arg->op.left);
4139 if (val)
4140 print_str_arg(s, data, size, event,
4141 format, len_arg, arg->op.right->op.left);
4142 else
4143 print_str_arg(s, data, size, event,
4144 format, len_arg, arg->op.right->op.right);
4145 break;
4146 case TEP_PRINT_FUNC:
4147 process_defined_func(s, data, size, event, arg);
4148 break;
4149 default:
4150 /* well... */
4151 break;
4152 }
4153
4154 return;
4155
4156 out_warning_field:
4157 do_warning_event(event, "%s: field %s not found",
4158 __func__, arg->field.name);
4159 }
4160
4161 static unsigned long long
4162 process_defined_func(struct trace_seq *s, void *data, int size,
4163 struct tep_event *event, struct tep_print_arg *arg)
4164 {
4165 struct tep_function_handler *func_handle = arg->func.func;
4166 struct func_params *param;
4167 unsigned long long *args;
4168 unsigned long long ret;
4169 struct tep_print_arg *farg;
4170 struct trace_seq str;
4171 struct save_str {
4172 struct save_str *next;
4173 char *str;
4174 } *strings = NULL, *string;
4175 int i;
4176
4177 if (!func_handle->nr_args) {
4178 ret = (*func_handle->func)(s, NULL);
4179 goto out;
4180 }
4181
4182 farg = arg->func.args;
4183 param = func_handle->params;
4184
4185 ret = ULLONG_MAX;
4186 args = malloc(sizeof(*args) * func_handle->nr_args);
4187 if (!args)
4188 goto out;
4189
4190 for (i = 0; i < func_handle->nr_args; i++) {
4191 switch (param->type) {
4192 case TEP_FUNC_ARG_INT:
4193 case TEP_FUNC_ARG_LONG:
4194 case TEP_FUNC_ARG_PTR:
4195 args[i] = eval_num_arg(data, size, event, farg);
4196 break;
4197 case TEP_FUNC_ARG_STRING:
4198 trace_seq_init(&str);
4199 print_str_arg(&str, data, size, event, "%s", -1, farg);
4200 trace_seq_terminate(&str);
4201 string = malloc(sizeof(*string));
4202 if (!string) {
4203 do_warning_event(event, "%s(%d): malloc str",
4204 __func__, __LINE__);
4205 goto out_free;
4206 }
4207 string->next = strings;
4208 string->str = strdup(str.buffer);
4209 if (!string->str) {
4210 free(string);
4211 do_warning_event(event, "%s(%d): malloc str",
4212 __func__, __LINE__);
4213 goto out_free;
4214 }
4215 args[i] = (uintptr_t)string->str;
4216 strings = string;
4217 trace_seq_destroy(&str);
4218 break;
4219 default:
4220 /*
4221 * Something went totally wrong, this is not
4222 * an input error, something in this code broke.
4223 */
4224 do_warning_event(event, "Unexpected end of arguments\n");
4225 goto out_free;
4226 }
4227 farg = farg->next;
4228 param = param->next;
4229 }
4230
4231 ret = (*func_handle->func)(s, args);
4232 out_free:
4233 free(args);
4234 while (strings) {
4235 string = strings;
4236 strings = string->next;
4237 free(string->str);
4238 free(string);
4239 }
4240
4241 out:
4242 /* TBD : handle return type here */
4243 return ret;
4244 }
4245
4246 static void free_args(struct tep_print_arg *args)
4247 {
4248 struct tep_print_arg *next;
4249
4250 while (args) {
4251 next = args->next;
4252
4253 free_arg(args);
4254 args = next;
4255 }
4256 }
4257
4258 static struct tep_print_arg *make_bprint_args(char *fmt, void *data, int size, struct tep_event *event)
4259 {
4260 struct tep_handle *pevent = event->pevent;
4261 struct tep_format_field *field, *ip_field;
4262 struct tep_print_arg *args, *arg, **next;
4263 unsigned long long ip, val;
4264 char *ptr;
4265 void *bptr;
4266 int vsize = 0;
4267
4268 field = pevent->bprint_buf_field;
4269 ip_field = pevent->bprint_ip_field;
4270
4271 if (!field) {
4272 field = tep_find_field(event, "buf");
4273 if (!field) {
4274 do_warning_event(event, "can't find buffer field for binary printk");
4275 return NULL;
4276 }
4277 ip_field = tep_find_field(event, "ip");
4278 if (!ip_field) {
4279 do_warning_event(event, "can't find ip field for binary printk");
4280 return NULL;
4281 }
4282 pevent->bprint_buf_field = field;
4283 pevent->bprint_ip_field = ip_field;
4284 }
4285
4286 ip = tep_read_number(pevent, data + ip_field->offset, ip_field->size);
4287
4288 /*
4289 * The first arg is the IP pointer.
4290 */
4291 args = alloc_arg();
4292 if (!args) {
4293 do_warning_event(event, "%s(%d): not enough memory!",
4294 __func__, __LINE__);
4295 return NULL;
4296 }
4297 arg = args;
4298 arg->next = NULL;
4299 next = &arg->next;
4300
4301 arg->type = TEP_PRINT_ATOM;
4302
4303 if (asprintf(&arg->atom.atom, "%lld", ip) < 0)
4304 goto out_free;
4305
4306 /* skip the first "%ps: " */
4307 for (ptr = fmt + 5, bptr = data + field->offset;
4308 bptr < data + size && *ptr; ptr++) {
4309 int ls = 0;
4310
4311 if (*ptr == '%') {
4312 process_again:
4313 ptr++;
4314 switch (*ptr) {
4315 case '%':
4316 break;
4317 case 'l':
4318 ls++;
4319 goto process_again;
4320 case 'L':
4321 ls = 2;
4322 goto process_again;
4323 case '0' ... '9':
4324 goto process_again;
4325 case '.':
4326 goto process_again;
4327 case 'z':
4328 case 'Z':
4329 ls = 1;
4330 goto process_again;
4331 case 'p':
4332 ls = 1;
4333 if (isalnum(ptr[1])) {
4334 ptr++;
4335 /* Check for special pointers */
4336 switch (*ptr) {
4337 case 's':
4338 case 'S':
4339 case 'f':
4340 case 'F':
4341 break;
4342 default:
4343 /*
4344 * Older kernels do not process
4345 * dereferenced pointers.
4346 * Only process if the pointer
4347 * value is a printable.
4348 */
4349 if (isprint(*(char *)bptr))
4350 goto process_string;
4351 }
4352 }
4353 /* fall through */
4354 case 'd':
4355 case 'u':
4356 case 'x':
4357 case 'i':
4358 switch (ls) {
4359 case 0:
4360 vsize = 4;
4361 break;
4362 case 1:
4363 vsize = pevent->long_size;
4364 break;
4365 case 2:
4366 vsize = 8;
4367 break;
4368 default:
4369 vsize = ls; /* ? */
4370 break;
4371 }
4372 /* fall through */
4373 case '*':
4374 if (*ptr == '*')
4375 vsize = 4;
4376
4377 /* the pointers are always 4 bytes aligned */
4378 bptr = (void *)(((unsigned long)bptr + 3) &
4379 ~3);
4380 val = tep_read_number(pevent, bptr, vsize);
4381 bptr += vsize;
4382 arg = alloc_arg();
4383 if (!arg) {
4384 do_warning_event(event, "%s(%d): not enough memory!",
4385 __func__, __LINE__);
4386 goto out_free;
4387 }
4388 arg->next = NULL;
4389 arg->type = TEP_PRINT_ATOM;
4390 if (asprintf(&arg->atom.atom, "%lld", val) < 0) {
4391 free(arg);
4392 goto out_free;
4393 }
4394 *next = arg;
4395 next = &arg->next;
4396 /*
4397 * The '*' case means that an arg is used as the length.
4398 * We need to continue to figure out for what.
4399 */
4400 if (*ptr == '*')
4401 goto process_again;
4402
4403 break;
4404 case 's':
4405 process_string:
4406 arg = alloc_arg();
4407 if (!arg) {
4408 do_warning_event(event, "%s(%d): not enough memory!",
4409 __func__, __LINE__);
4410 goto out_free;
4411 }
4412 arg->next = NULL;
4413 arg->type = TEP_PRINT_BSTRING;
4414 arg->string.string = strdup(bptr);
4415 if (!arg->string.string)
4416 goto out_free;
4417 bptr += strlen(bptr) + 1;
4418 *next = arg;
4419 next = &arg->next;
4420 default:
4421 break;
4422 }
4423 }
4424 }
4425
4426 return args;
4427
4428 out_free:
4429 free_args(args);
4430 return NULL;
4431 }
4432
4433 static char *
4434 get_bprint_format(void *data, int size __maybe_unused,
4435 struct tep_event *event)
4436 {
4437 struct tep_handle *pevent = event->pevent;
4438 unsigned long long addr;
4439 struct tep_format_field *field;
4440 struct printk_map *printk;
4441 char *format;
4442
4443 field = pevent->bprint_fmt_field;
4444
4445 if (!field) {
4446 field = tep_find_field(event, "fmt");
4447 if (!field) {
4448 do_warning_event(event, "can't find format field for binary printk");
4449 return NULL;
4450 }
4451 pevent->bprint_fmt_field = field;
4452 }
4453
4454 addr = tep_read_number(pevent, data + field->offset, field->size);
4455
4456 printk = find_printk(pevent, addr);
4457 if (!printk) {
4458 if (asprintf(&format, "%%pf: (NO FORMAT FOUND at %llx)\n", addr) < 0)
4459 return NULL;
4460 return format;
4461 }
4462
4463 if (asprintf(&format, "%s: %s", "%pf", printk->printk) < 0)
4464 return NULL;
4465
4466 return format;
4467 }
4468
4469 static void print_mac_arg(struct trace_seq *s, int mac, void *data, int size,
4470 struct tep_event *event, struct tep_print_arg *arg)
4471 {
4472 unsigned char *buf;
4473 const char *fmt = "%.2x:%.2x:%.2x:%.2x:%.2x:%.2x";
4474
4475 if (arg->type == TEP_PRINT_FUNC) {
4476 process_defined_func(s, data, size, event, arg);
4477 return;
4478 }
4479
4480 if (arg->type != TEP_PRINT_FIELD) {
4481 trace_seq_printf(s, "ARG TYPE NOT FIELD BUT %d",
4482 arg->type);
4483 return;
4484 }
4485
4486 if (mac == 'm')
4487 fmt = "%.2x%.2x%.2x%.2x%.2x%.2x";
4488 if (!arg->field.field) {
4489 arg->field.field =
4490 tep_find_any_field(event, arg->field.name);
4491 if (!arg->field.field) {
4492 do_warning_event(event, "%s: field %s not found",
4493 __func__, arg->field.name);
4494 return;
4495 }
4496 }
4497 if (arg->field.field->size != 6) {
4498 trace_seq_printf(s, "INVALIDMAC");
4499 return;
4500 }
4501 buf = data + arg->field.field->offset;
4502 trace_seq_printf(s, fmt, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5]);
4503 }
4504
4505 static void print_ip4_addr(struct trace_seq *s, char i, unsigned char *buf)
4506 {
4507 const char *fmt;
4508
4509 if (i == 'i')
4510 fmt = "%03d.%03d.%03d.%03d";
4511 else
4512 fmt = "%d.%d.%d.%d";
4513
4514 trace_seq_printf(s, fmt, buf[0], buf[1], buf[2], buf[3]);
4515 }
4516
4517 static inline bool ipv6_addr_v4mapped(const struct in6_addr *a)
4518 {
4519 return ((unsigned long)(a->s6_addr32[0] | a->s6_addr32[1]) |
4520 (unsigned long)(a->s6_addr32[2] ^ htonl(0x0000ffff))) == 0UL;
4521 }
4522
4523 static inline bool ipv6_addr_is_isatap(const struct in6_addr *addr)
4524 {
4525 return (addr->s6_addr32[2] | htonl(0x02000000)) == htonl(0x02005EFE);
4526 }
4527
4528 static void print_ip6c_addr(struct trace_seq *s, unsigned char *addr)
4529 {
4530 int i, j, range;
4531 unsigned char zerolength[8];
4532 int longest = 1;
4533 int colonpos = -1;
4534 uint16_t word;
4535 uint8_t hi, lo;
4536 bool needcolon = false;
4537 bool useIPv4;
4538 struct in6_addr in6;
4539
4540 memcpy(&in6, addr, sizeof(struct in6_addr));
4541
4542 useIPv4 = ipv6_addr_v4mapped(&in6) || ipv6_addr_is_isatap(&in6);
4543
4544 memset(zerolength, 0, sizeof(zerolength));
4545
4546 if (useIPv4)
4547 range = 6;
4548 else
4549 range = 8;
4550
4551 /* find position of longest 0 run */
4552 for (i = 0; i < range; i++) {
4553 for (j = i; j < range; j++) {
4554 if (in6.s6_addr16[j] != 0)
4555 break;
4556 zerolength[i]++;
4557 }
4558 }
4559 for (i = 0; i < range; i++) {
4560 if (zerolength[i] > longest) {
4561 longest = zerolength[i];
4562 colonpos = i;
4563 }
4564 }
4565 if (longest == 1) /* don't compress a single 0 */
4566 colonpos = -1;
4567
4568 /* emit address */
4569 for (i = 0; i < range; i++) {
4570 if (i == colonpos) {
4571 if (needcolon || i == 0)
4572 trace_seq_printf(s, ":");
4573 trace_seq_printf(s, ":");
4574 needcolon = false;
4575 i += longest - 1;
4576 continue;
4577 }
4578 if (needcolon) {
4579 trace_seq_printf(s, ":");
4580 needcolon = false;
4581 }
4582 /* hex u16 without leading 0s */
4583 word = ntohs(in6.s6_addr16[i]);
4584 hi = word >> 8;
4585 lo = word & 0xff;
4586 if (hi)
4587 trace_seq_printf(s, "%x%02x", hi, lo);
4588 else
4589 trace_seq_printf(s, "%x", lo);
4590
4591 needcolon = true;
4592 }
4593
4594 if (useIPv4) {
4595 if (needcolon)
4596 trace_seq_printf(s, ":");
4597 print_ip4_addr(s, 'I', &in6.s6_addr[12]);
4598 }
4599
4600 return;
4601 }
4602
4603 static void print_ip6_addr(struct trace_seq *s, char i, unsigned char *buf)
4604 {
4605 int j;
4606
4607 for (j = 0; j < 16; j += 2) {
4608 trace_seq_printf(s, "%02x%02x", buf[j], buf[j+1]);
4609 if (i == 'I' && j < 14)
4610 trace_seq_printf(s, ":");
4611 }
4612 }
4613
4614 /*
4615 * %pi4 print an IPv4 address with leading zeros
4616 * %pI4 print an IPv4 address without leading zeros
4617 * %pi6 print an IPv6 address without colons
4618 * %pI6 print an IPv6 address with colons
4619 * %pI6c print an IPv6 address in compressed form with colons
4620 * %pISpc print an IP address based on sockaddr; p adds port.
4621 */
4622 static int print_ipv4_arg(struct trace_seq *s, const char *ptr, char i,
4623 void *data, int size, struct tep_event *event,
4624 struct tep_print_arg *arg)
4625 {
4626 unsigned char *buf;
4627
4628 if (arg->type == TEP_PRINT_FUNC) {
4629 process_defined_func(s, data, size, event, arg);
4630 return 0;
4631 }
4632
4633 if (arg->type != TEP_PRINT_FIELD) {
4634 trace_seq_printf(s, "ARG TYPE NOT FIELD BUT %d", arg->type);
4635 return 0;
4636 }
4637
4638 if (!arg->field.field) {
4639 arg->field.field =
4640 tep_find_any_field(event, arg->field.name);
4641 if (!arg->field.field) {
4642 do_warning("%s: field %s not found",
4643 __func__, arg->field.name);
4644 return 0;
4645 }
4646 }
4647
4648 buf = data + arg->field.field->offset;
4649
4650 if (arg->field.field->size != 4) {
4651 trace_seq_printf(s, "INVALIDIPv4");
4652 return 0;
4653 }
4654 print_ip4_addr(s, i, buf);
4655
4656 return 0;
4657 }
4658
4659 static int print_ipv6_arg(struct trace_seq *s, const char *ptr, char i,
4660 void *data, int size, struct tep_event *event,
4661 struct tep_print_arg *arg)
4662 {
4663 char have_c = 0;
4664 unsigned char *buf;
4665 int rc = 0;
4666
4667 /* pI6c */
4668 if (i == 'I' && *ptr == 'c') {
4669 have_c = 1;
4670 ptr++;
4671 rc++;
4672 }
4673
4674 if (arg->type == TEP_PRINT_FUNC) {
4675 process_defined_func(s, data, size, event, arg);
4676 return rc;
4677 }
4678
4679 if (arg->type != TEP_PRINT_FIELD) {
4680 trace_seq_printf(s, "ARG TYPE NOT FIELD BUT %d", arg->type);
4681 return rc;
4682 }
4683
4684 if (!arg->field.field) {
4685 arg->field.field =
4686 tep_find_any_field(event, arg->field.name);
4687 if (!arg->field.field) {
4688 do_warning("%s: field %s not found",
4689 __func__, arg->field.name);
4690 return rc;
4691 }
4692 }
4693
4694 buf = data + arg->field.field->offset;
4695
4696 if (arg->field.field->size != 16) {
4697 trace_seq_printf(s, "INVALIDIPv6");
4698 return rc;
4699 }
4700
4701 if (have_c)
4702 print_ip6c_addr(s, buf);
4703 else
4704 print_ip6_addr(s, i, buf);
4705
4706 return rc;
4707 }
4708
4709 static int print_ipsa_arg(struct trace_seq *s, const char *ptr, char i,
4710 void *data, int size, struct tep_event *event,
4711 struct tep_print_arg *arg)
4712 {
4713 char have_c = 0, have_p = 0;
4714 unsigned char *buf;
4715 struct sockaddr_storage *sa;
4716 int rc = 0;
4717
4718 /* pISpc */
4719 if (i == 'I') {
4720 if (*ptr == 'p') {
4721 have_p = 1;
4722 ptr++;
4723 rc++;
4724 }
4725 if (*ptr == 'c') {
4726 have_c = 1;
4727 ptr++;
4728 rc++;
4729 }
4730 }
4731
4732 if (arg->type == TEP_PRINT_FUNC) {
4733 process_defined_func(s, data, size, event, arg);
4734 return rc;
4735 }
4736
4737 if (arg->type != TEP_PRINT_FIELD) {
4738 trace_seq_printf(s, "ARG TYPE NOT FIELD BUT %d", arg->type);
4739 return rc;
4740 }
4741
4742 if (!arg->field.field) {
4743 arg->field.field =
4744 tep_find_any_field(event, arg->field.name);
4745 if (!arg->field.field) {
4746 do_warning("%s: field %s not found",
4747 __func__, arg->field.name);
4748 return rc;
4749 }
4750 }
4751
4752 sa = (struct sockaddr_storage *) (data + arg->field.field->offset);
4753
4754 if (sa->ss_family == AF_INET) {
4755 struct sockaddr_in *sa4 = (struct sockaddr_in *) sa;
4756
4757 if (arg->field.field->size < sizeof(struct sockaddr_in)) {
4758 trace_seq_printf(s, "INVALIDIPv4");
4759 return rc;
4760 }
4761
4762 print_ip4_addr(s, i, (unsigned char *) &sa4->sin_addr);
4763 if (have_p)
4764 trace_seq_printf(s, ":%d", ntohs(sa4->sin_port));
4765
4766
4767 } else if (sa->ss_family == AF_INET6) {
4768 struct sockaddr_in6 *sa6 = (struct sockaddr_in6 *) sa;
4769
4770 if (arg->field.field->size < sizeof(struct sockaddr_in6)) {
4771 trace_seq_printf(s, "INVALIDIPv6");
4772 return rc;
4773 }
4774
4775 if (have_p)
4776 trace_seq_printf(s, "[");
4777
4778 buf = (unsigned char *) &sa6->sin6_addr;
4779 if (have_c)
4780 print_ip6c_addr(s, buf);
4781 else
4782 print_ip6_addr(s, i, buf);
4783
4784 if (have_p)
4785 trace_seq_printf(s, "]:%d", ntohs(sa6->sin6_port));
4786 }
4787
4788 return rc;
4789 }
4790
4791 static int print_ip_arg(struct trace_seq *s, const char *ptr,
4792 void *data, int size, struct tep_event *event,
4793 struct tep_print_arg *arg)
4794 {
4795 char i = *ptr; /* 'i' or 'I' */
4796 char ver;
4797 int rc = 0;
4798
4799 ptr++;
4800 rc++;
4801
4802 ver = *ptr;
4803 ptr++;
4804 rc++;
4805
4806 switch (ver) {
4807 case '4':
4808 rc += print_ipv4_arg(s, ptr, i, data, size, event, arg);
4809 break;
4810 case '6':
4811 rc += print_ipv6_arg(s, ptr, i, data, size, event, arg);
4812 break;
4813 case 'S':
4814 rc += print_ipsa_arg(s, ptr, i, data, size, event, arg);
4815 break;
4816 default:
4817 return 0;
4818 }
4819
4820 return rc;
4821 }
4822
4823 static int is_printable_array(char *p, unsigned int len)
4824 {
4825 unsigned int i;
4826
4827 for (i = 0; i < len && p[i]; i++)
4828 if (!isprint(p[i]) && !isspace(p[i]))
4829 return 0;
4830 return 1;
4831 }
4832
4833 void tep_print_field(struct trace_seq *s, void *data,
4834 struct tep_format_field *field)
4835 {
4836 unsigned long long val;
4837 unsigned int offset, len, i;
4838 struct tep_handle *pevent = field->event->pevent;
4839
4840 if (field->flags & TEP_FIELD_IS_ARRAY) {
4841 offset = field->offset;
4842 len = field->size;
4843 if (field->flags & TEP_FIELD_IS_DYNAMIC) {
4844 val = tep_read_number(pevent, data + offset, len);
4845 offset = val;
4846 len = offset >> 16;
4847 offset &= 0xffff;
4848 }
4849 if (field->flags & TEP_FIELD_IS_STRING &&
4850 is_printable_array(data + offset, len)) {
4851 trace_seq_printf(s, "%s", (char *)data + offset);
4852 } else {
4853 trace_seq_puts(s, "ARRAY[");
4854 for (i = 0; i < len; i++) {
4855 if (i)
4856 trace_seq_puts(s, ", ");
4857 trace_seq_printf(s, "%02x",
4858 *((unsigned char *)data + offset + i));
4859 }
4860 trace_seq_putc(s, ']');
4861 field->flags &= ~TEP_FIELD_IS_STRING;
4862 }
4863 } else {
4864 val = tep_read_number(pevent, data + field->offset,
4865 field->size);
4866 if (field->flags & TEP_FIELD_IS_POINTER) {
4867 trace_seq_printf(s, "0x%llx", val);
4868 } else if (field->flags & TEP_FIELD_IS_SIGNED) {
4869 switch (field->size) {
4870 case 4:
4871 /*
4872 * If field is long then print it in hex.
4873 * A long usually stores pointers.
4874 */
4875 if (field->flags & TEP_FIELD_IS_LONG)
4876 trace_seq_printf(s, "0x%x", (int)val);
4877 else
4878 trace_seq_printf(s, "%d", (int)val);
4879 break;
4880 case 2:
4881 trace_seq_printf(s, "%2d", (short)val);
4882 break;
4883 case 1:
4884 trace_seq_printf(s, "%1d", (char)val);
4885 break;
4886 default:
4887 trace_seq_printf(s, "%lld", val);
4888 }
4889 } else {
4890 if (field->flags & TEP_FIELD_IS_LONG)
4891 trace_seq_printf(s, "0x%llx", val);
4892 else
4893 trace_seq_printf(s, "%llu", val);
4894 }
4895 }
4896 }
4897
4898 void tep_print_fields(struct trace_seq *s, void *data,
4899 int size __maybe_unused, struct tep_event *event)
4900 {
4901 struct tep_format_field *field;
4902
4903 field = event->format.fields;
4904 while (field) {
4905 trace_seq_printf(s, " %s=", field->name);
4906 tep_print_field(s, data, field);
4907 field = field->next;
4908 }
4909 }
4910
4911 static void pretty_print(struct trace_seq *s, void *data, int size, struct tep_event *event)
4912 {
4913 struct tep_handle *pevent = event->pevent;
4914 struct tep_print_fmt *print_fmt = &event->print_fmt;
4915 struct tep_print_arg *arg = print_fmt->args;
4916 struct tep_print_arg *args = NULL;
4917 const char *ptr = print_fmt->format;
4918 unsigned long long val;
4919 struct func_map *func;
4920 const char *saveptr;
4921 struct trace_seq p;
4922 char *bprint_fmt = NULL;
4923 char format[32];
4924 int show_func;
4925 int len_as_arg;
4926 int len_arg = 0;
4927 int len;
4928 int ls;
4929
4930 if (event->flags & TEP_EVENT_FL_FAILED) {
4931 trace_seq_printf(s, "[FAILED TO PARSE]");
4932 tep_print_fields(s, data, size, event);
4933 return;
4934 }
4935
4936 if (event->flags & TEP_EVENT_FL_ISBPRINT) {
4937 bprint_fmt = get_bprint_format(data, size, event);
4938 args = make_bprint_args(bprint_fmt, data, size, event);
4939 arg = args;
4940 ptr = bprint_fmt;
4941 }
4942
4943 for (; *ptr; ptr++) {
4944 ls = 0;
4945 if (*ptr == '\\') {
4946 ptr++;
4947 switch (*ptr) {
4948 case 'n':
4949 trace_seq_putc(s, '\n');
4950 break;
4951 case 't':
4952 trace_seq_putc(s, '\t');
4953 break;
4954 case 'r':
4955 trace_seq_putc(s, '\r');
4956 break;
4957 case '\\':
4958 trace_seq_putc(s, '\\');
4959 break;
4960 default:
4961 trace_seq_putc(s, *ptr);
4962 break;
4963 }
4964
4965 } else if (*ptr == '%') {
4966 saveptr = ptr;
4967 show_func = 0;
4968 len_as_arg = 0;
4969 cont_process:
4970 ptr++;
4971 switch (*ptr) {
4972 case '%':
4973 trace_seq_putc(s, '%');
4974 break;
4975 case '#':
4976 /* FIXME: need to handle properly */
4977 goto cont_process;
4978 case 'h':
4979 ls--;
4980 goto cont_process;
4981 case 'l':
4982 ls++;
4983 goto cont_process;
4984 case 'L':
4985 ls = 2;
4986 goto cont_process;
4987 case '*':
4988 /* The argument is the length. */
4989 if (!arg) {
4990 do_warning_event(event, "no argument match");
4991 event->flags |= TEP_EVENT_FL_FAILED;
4992 goto out_failed;
4993 }
4994 len_arg = eval_num_arg(data, size, event, arg);
4995 len_as_arg = 1;
4996 arg = arg->next;
4997 goto cont_process;
4998 case '.':
4999 case 'z':
5000 case 'Z':
5001 case '0' ... '9':
5002 case '-':
5003 goto cont_process;
5004 case 'p':
5005 if (pevent->long_size == 4)
5006 ls = 1;
5007 else
5008 ls = 2;
5009
5010 if (isalnum(ptr[1]))
5011 ptr++;
5012
5013 if (arg->type == TEP_PRINT_BSTRING) {
5014 trace_seq_puts(s, arg->string.string);
5015 arg = arg->next;
5016 break;
5017 }
5018
5019 if (*ptr == 'F' || *ptr == 'f' ||
5020 *ptr == 'S' || *ptr == 's') {
5021 show_func = *ptr;
5022 } else if (*ptr == 'M' || *ptr == 'm') {
5023 print_mac_arg(s, *ptr, data, size, event, arg);
5024 arg = arg->next;
5025 break;
5026 } else if (*ptr == 'I' || *ptr == 'i') {
5027 int n;
5028
5029 n = print_ip_arg(s, ptr, data, size, event, arg);
5030 if (n > 0) {
5031 ptr += n - 1;
5032 arg = arg->next;
5033 break;
5034 }
5035 }
5036
5037 /* fall through */
5038 case 'd':
5039 case 'i':
5040 case 'x':
5041 case 'X':
5042 case 'u':
5043 if (!arg) {
5044 do_warning_event(event, "no argument match");
5045 event->flags |= TEP_EVENT_FL_FAILED;
5046 goto out_failed;
5047 }
5048
5049 len = ((unsigned long)ptr + 1) -
5050 (unsigned long)saveptr;
5051
5052 /* should never happen */
5053 if (len > 31) {
5054 do_warning_event(event, "bad format!");
5055 event->flags |= TEP_EVENT_FL_FAILED;
5056 len = 31;
5057 }
5058
5059 memcpy(format, saveptr, len);
5060 format[len] = 0;
5061
5062 val = eval_num_arg(data, size, event, arg);
5063 arg = arg->next;
5064
5065 if (show_func) {
5066 func = find_func(pevent, val);
5067 if (func) {
5068 trace_seq_puts(s, func->func);
5069 if (show_func == 'F')
5070 trace_seq_printf(s,
5071 "+0x%llx",
5072 val - func->addr);
5073 break;
5074 }
5075 }
5076 if (pevent->long_size == 8 && ls == 1 &&
5077 sizeof(long) != 8) {
5078 char *p;
5079
5080 /* make %l into %ll */
5081 if (ls == 1 && (p = strchr(format, 'l')))
5082 memmove(p+1, p, strlen(p)+1);
5083 else if (strcmp(format, "%p") == 0)
5084 strcpy(format, "0x%llx");
5085 ls = 2;
5086 }
5087 switch (ls) {
5088 case -2:
5089 if (len_as_arg)
5090 trace_seq_printf(s, format, len_arg, (char)val);
5091 else
5092 trace_seq_printf(s, format, (char)val);
5093 break;
5094 case -1:
5095 if (len_as_arg)
5096 trace_seq_printf(s, format, len_arg, (short)val);
5097 else
5098 trace_seq_printf(s, format, (short)val);
5099 break;
5100 case 0:
5101 if (len_as_arg)
5102 trace_seq_printf(s, format, len_arg, (int)val);
5103 else
5104 trace_seq_printf(s, format, (int)val);
5105 break;
5106 case 1:
5107 if (len_as_arg)
5108 trace_seq_printf(s, format, len_arg, (long)val);
5109 else
5110 trace_seq_printf(s, format, (long)val);
5111 break;
5112 case 2:
5113 if (len_as_arg)
5114 trace_seq_printf(s, format, len_arg,
5115 (long long)val);
5116 else
5117 trace_seq_printf(s, format, (long long)val);
5118 break;
5119 default:
5120 do_warning_event(event, "bad count (%d)", ls);
5121 event->flags |= TEP_EVENT_FL_FAILED;
5122 }
5123 break;
5124 case 's':
5125 if (!arg) {
5126 do_warning_event(event, "no matching argument");
5127 event->flags |= TEP_EVENT_FL_FAILED;
5128 goto out_failed;
5129 }
5130
5131 len = ((unsigned long)ptr + 1) -
5132 (unsigned long)saveptr;
5133
5134 /* should never happen */
5135 if (len > 31) {
5136 do_warning_event(event, "bad format!");
5137 event->flags |= TEP_EVENT_FL_FAILED;
5138 len = 31;
5139 }
5140
5141 memcpy(format, saveptr, len);
5142 format[len] = 0;
5143 if (!len_as_arg)
5144 len_arg = -1;
5145 /* Use helper trace_seq */
5146 trace_seq_init(&p);
5147 print_str_arg(&p, data, size, event,
5148 format, len_arg, arg);
5149 trace_seq_terminate(&p);
5150 trace_seq_puts(s, p.buffer);
5151 trace_seq_destroy(&p);
5152 arg = arg->next;
5153 break;
5154 default:
5155 trace_seq_printf(s, ">%c<", *ptr);
5156
5157 }
5158 } else
5159 trace_seq_putc(s, *ptr);
5160 }
5161
5162 if (event->flags & TEP_EVENT_FL_FAILED) {
5163 out_failed:
5164 trace_seq_printf(s, "[FAILED TO PARSE]");
5165 }
5166
5167 if (args) {
5168 free_args(args);
5169 free(bprint_fmt);
5170 }
5171 }
5172
5173 /**
5174 * tep_data_lat_fmt - parse the data for the latency format
5175 * @pevent: a handle to the pevent
5176 * @s: the trace_seq to write to
5177 * @record: the record to read from
5178 *
5179 * This parses out the Latency format (interrupts disabled,
5180 * need rescheduling, in hard/soft interrupt, preempt count
5181 * and lock depth) and places it into the trace_seq.
5182 */
5183 void tep_data_lat_fmt(struct tep_handle *pevent,
5184 struct trace_seq *s, struct tep_record *record)
5185 {
5186 static int check_lock_depth = 1;
5187 static int check_migrate_disable = 1;
5188 static int lock_depth_exists;
5189 static int migrate_disable_exists;
5190 unsigned int lat_flags;
5191 unsigned int pc;
5192 int lock_depth = 0;
5193 int migrate_disable = 0;
5194 int hardirq;
5195 int softirq;
5196 void *data = record->data;
5197
5198 lat_flags = parse_common_flags(pevent, data);
5199 pc = parse_common_pc(pevent, data);
5200 /* lock_depth may not always exist */
5201 if (lock_depth_exists)
5202 lock_depth = parse_common_lock_depth(pevent, data);
5203 else if (check_lock_depth) {
5204 lock_depth = parse_common_lock_depth(pevent, data);
5205 if (lock_depth < 0)
5206 check_lock_depth = 0;
5207 else
5208 lock_depth_exists = 1;
5209 }
5210
5211 /* migrate_disable may not always exist */
5212 if (migrate_disable_exists)
5213 migrate_disable = parse_common_migrate_disable(pevent, data);
5214 else if (check_migrate_disable) {
5215 migrate_disable = parse_common_migrate_disable(pevent, data);
5216 if (migrate_disable < 0)
5217 check_migrate_disable = 0;
5218 else
5219 migrate_disable_exists = 1;
5220 }
5221
5222 hardirq = lat_flags & TRACE_FLAG_HARDIRQ;
5223 softirq = lat_flags & TRACE_FLAG_SOFTIRQ;
5224
5225 trace_seq_printf(s, "%c%c%c",
5226 (lat_flags & TRACE_FLAG_IRQS_OFF) ? 'd' :
5227 (lat_flags & TRACE_FLAG_IRQS_NOSUPPORT) ?
5228 'X' : '.',
5229 (lat_flags & TRACE_FLAG_NEED_RESCHED) ?
5230 'N' : '.',
5231 (hardirq && softirq) ? 'H' :
5232 hardirq ? 'h' : softirq ? 's' : '.');
5233
5234 if (pc)
5235 trace_seq_printf(s, "%x", pc);
5236 else
5237 trace_seq_putc(s, '.');
5238
5239 if (migrate_disable_exists) {
5240 if (migrate_disable < 0)
5241 trace_seq_putc(s, '.');
5242 else
5243 trace_seq_printf(s, "%d", migrate_disable);
5244 }
5245
5246 if (lock_depth_exists) {
5247 if (lock_depth < 0)
5248 trace_seq_putc(s, '.');
5249 else
5250 trace_seq_printf(s, "%d", lock_depth);
5251 }
5252
5253 trace_seq_terminate(s);
5254 }
5255
5256 /**
5257 * tep_data_type - parse out the given event type
5258 * @pevent: a handle to the pevent
5259 * @rec: the record to read from
5260 *
5261 * This returns the event id from the @rec.
5262 */
5263 int tep_data_type(struct tep_handle *pevent, struct tep_record *rec)
5264 {
5265 return trace_parse_common_type(pevent, rec->data);
5266 }
5267
5268 /**
5269 * tep_data_pid - parse the PID from record
5270 * @pevent: a handle to the pevent
5271 * @rec: the record to parse
5272 *
5273 * This returns the PID from a record.
5274 */
5275 int tep_data_pid(struct tep_handle *pevent, struct tep_record *rec)
5276 {
5277 return parse_common_pid(pevent, rec->data);
5278 }
5279
5280 /**
5281 * tep_data_preempt_count - parse the preempt count from the record
5282 * @pevent: a handle to the pevent
5283 * @rec: the record to parse
5284 *
5285 * This returns the preempt count from a record.
5286 */
5287 int tep_data_preempt_count(struct tep_handle *pevent, struct tep_record *rec)
5288 {
5289 return parse_common_pc(pevent, rec->data);
5290 }
5291
5292 /**
5293 * tep_data_flags - parse the latency flags from the record
5294 * @pevent: a handle to the pevent
5295 * @rec: the record to parse
5296 *
5297 * This returns the latency flags from a record.
5298 *
5299 * Use trace_flag_type enum for the flags (see event-parse.h).
5300 */
5301 int tep_data_flags(struct tep_handle *pevent, struct tep_record *rec)
5302 {
5303 return parse_common_flags(pevent, rec->data);
5304 }
5305
5306 /**
5307 * tep_data_comm_from_pid - return the command line from PID
5308 * @pevent: a handle to the pevent
5309 * @pid: the PID of the task to search for
5310 *
5311 * This returns a pointer to the command line that has the given
5312 * @pid.
5313 */
5314 const char *tep_data_comm_from_pid(struct tep_handle *pevent, int pid)
5315 {
5316 const char *comm;
5317
5318 comm = find_cmdline(pevent, pid);
5319 return comm;
5320 }
5321
5322 static struct tep_cmdline *
5323 pid_from_cmdlist(struct tep_handle *pevent, const char *comm, struct tep_cmdline *next)
5324 {
5325 struct cmdline_list *cmdlist = (struct cmdline_list *)next;
5326
5327 if (cmdlist)
5328 cmdlist = cmdlist->next;
5329 else
5330 cmdlist = pevent->cmdlist;
5331
5332 while (cmdlist && strcmp(cmdlist->comm, comm) != 0)
5333 cmdlist = cmdlist->next;
5334
5335 return (struct tep_cmdline *)cmdlist;
5336 }
5337
5338 /**
5339 * tep_data_pid_from_comm - return the pid from a given comm
5340 * @pevent: a handle to the pevent
5341 * @comm: the cmdline to find the pid from
5342 * @next: the cmdline structure to find the next comm
5343 *
5344 * This returns the cmdline structure that holds a pid for a given
5345 * comm, or NULL if none found. As there may be more than one pid for
5346 * a given comm, the result of this call can be passed back into
5347 * a recurring call in the @next parameter, and then it will find the
5348 * next pid.
5349 * Also, it does a linear search, so it may be slow.
5350 */
5351 struct tep_cmdline *tep_data_pid_from_comm(struct tep_handle *pevent, const char *comm,
5352 struct tep_cmdline *next)
5353 {
5354 struct tep_cmdline *cmdline;
5355
5356 /*
5357 * If the cmdlines have not been converted yet, then use
5358 * the list.
5359 */
5360 if (!pevent->cmdlines)
5361 return pid_from_cmdlist(pevent, comm, next);
5362
5363 if (next) {
5364 /*
5365 * The next pointer could have been still from
5366 * a previous call before cmdlines were created
5367 */
5368 if (next < pevent->cmdlines ||
5369 next >= pevent->cmdlines + pevent->cmdline_count)
5370 next = NULL;
5371 else
5372 cmdline = next++;
5373 }
5374
5375 if (!next)
5376 cmdline = pevent->cmdlines;
5377
5378 while (cmdline < pevent->cmdlines + pevent->cmdline_count) {
5379 if (strcmp(cmdline->comm, comm) == 0)
5380 return cmdline;
5381 cmdline++;
5382 }
5383 return NULL;
5384 }
5385
5386 /**
5387 * tep_cmdline_pid - return the pid associated to a given cmdline
5388 * @cmdline: The cmdline structure to get the pid from
5389 *
5390 * Returns the pid for a give cmdline. If @cmdline is NULL, then
5391 * -1 is returned.
5392 */
5393 int tep_cmdline_pid(struct tep_handle *pevent, struct tep_cmdline *cmdline)
5394 {
5395 struct cmdline_list *cmdlist = (struct cmdline_list *)cmdline;
5396
5397 if (!cmdline)
5398 return -1;
5399
5400 /*
5401 * If cmdlines have not been created yet, or cmdline is
5402 * not part of the array, then treat it as a cmdlist instead.
5403 */
5404 if (!pevent->cmdlines ||
5405 cmdline < pevent->cmdlines ||
5406 cmdline >= pevent->cmdlines + pevent->cmdline_count)
5407 return cmdlist->pid;
5408
5409 return cmdline->pid;
5410 }
5411
5412 /**
5413 * tep_event_info - parse the data into the print format
5414 * @s: the trace_seq to write to
5415 * @event: the handle to the event
5416 * @record: the record to read from
5417 *
5418 * This parses the raw @data using the given @event information and
5419 * writes the print format into the trace_seq.
5420 */
5421 void tep_event_info(struct trace_seq *s, struct tep_event *event,
5422 struct tep_record *record)
5423 {
5424 int print_pretty = 1;
5425
5426 if (event->pevent->print_raw || (event->flags & TEP_EVENT_FL_PRINTRAW))
5427 tep_print_fields(s, record->data, record->size, event);
5428 else {
5429
5430 if (event->handler && !(event->flags & TEP_EVENT_FL_NOHANDLE))
5431 print_pretty = event->handler(s, record, event,
5432 event->context);
5433
5434 if (print_pretty)
5435 pretty_print(s, record->data, record->size, event);
5436 }
5437
5438 trace_seq_terminate(s);
5439 }
5440
5441 static bool is_timestamp_in_us(char *trace_clock, bool use_trace_clock)
5442 {
5443 if (!trace_clock || !use_trace_clock)
5444 return true;
5445
5446 if (!strcmp(trace_clock, "local") || !strcmp(trace_clock, "global")
5447 || !strcmp(trace_clock, "uptime") || !strcmp(trace_clock, "perf"))
5448 return true;
5449
5450 /* trace_clock is setting in tsc or counter mode */
5451 return false;
5452 }
5453
5454 /**
5455 * tep_find_event_by_record - return the event from a given record
5456 * @pevent: a handle to the pevent
5457 * @record: The record to get the event from
5458 *
5459 * Returns the associated event for a given record, or NULL if non is
5460 * is found.
5461 */
5462 struct tep_event *
5463 tep_find_event_by_record(struct tep_handle *pevent, struct tep_record *record)
5464 {
5465 int type;
5466
5467 if (record->size < 0) {
5468 do_warning("ug! negative record size %d", record->size);
5469 return NULL;
5470 }
5471
5472 type = trace_parse_common_type(pevent, record->data);
5473
5474 return tep_find_event(pevent, type);
5475 }
5476
5477 /**
5478 * tep_print_event_task - Write the event task comm, pid and CPU
5479 * @pevent: a handle to the pevent
5480 * @s: the trace_seq to write to
5481 * @event: the handle to the record's event
5482 * @record: The record to get the event from
5483 *
5484 * Writes the tasks comm, pid and CPU to @s.
5485 */
5486 void tep_print_event_task(struct tep_handle *pevent, struct trace_seq *s,
5487 struct tep_event *event,
5488 struct tep_record *record)
5489 {
5490 void *data = record->data;
5491 const char *comm;
5492 int pid;
5493
5494 pid = parse_common_pid(pevent, data);
5495 comm = find_cmdline(pevent, pid);
5496
5497 if (pevent->latency_format) {
5498 trace_seq_printf(s, "%8.8s-%-5d %3d",
5499 comm, pid, record->cpu);
5500 } else
5501 trace_seq_printf(s, "%16s-%-5d [%03d]", comm, pid, record->cpu);
5502 }
5503
5504 /**
5505 * tep_print_event_time - Write the event timestamp
5506 * @pevent: a handle to the pevent
5507 * @s: the trace_seq to write to
5508 * @event: the handle to the record's event
5509 * @record: The record to get the event from
5510 * @use_trace_clock: Set to parse according to the @pevent->trace_clock
5511 *
5512 * Writes the timestamp of the record into @s.
5513 */
5514 void tep_print_event_time(struct tep_handle *pevent, struct trace_seq *s,
5515 struct tep_event *event,
5516 struct tep_record *record,
5517 bool use_trace_clock)
5518 {
5519 unsigned long secs;
5520 unsigned long usecs;
5521 unsigned long nsecs;
5522 int p;
5523 bool use_usec_format;
5524
5525 use_usec_format = is_timestamp_in_us(pevent->trace_clock,
5526 use_trace_clock);
5527 if (use_usec_format) {
5528 secs = record->ts / NSEC_PER_SEC;
5529 nsecs = record->ts - secs * NSEC_PER_SEC;
5530 }
5531
5532 if (pevent->latency_format) {
5533 tep_data_lat_fmt(pevent, s, record);
5534 }
5535
5536 if (use_usec_format) {
5537 if (pevent->flags & TEP_NSEC_OUTPUT) {
5538 usecs = nsecs;
5539 p = 9;
5540 } else {
5541 usecs = (nsecs + 500) / NSEC_PER_USEC;
5542 /* To avoid usecs larger than 1 sec */
5543 if (usecs >= USEC_PER_SEC) {
5544 usecs -= USEC_PER_SEC;
5545 secs++;
5546 }
5547 p = 6;
5548 }
5549
5550 trace_seq_printf(s, " %5lu.%0*lu:", secs, p, usecs);
5551 } else
5552 trace_seq_printf(s, " %12llu:", record->ts);
5553 }
5554
5555 /**
5556 * tep_print_event_data - Write the event data section
5557 * @pevent: a handle to the pevent
5558 * @s: the trace_seq to write to
5559 * @event: the handle to the record's event
5560 * @record: The record to get the event from
5561 *
5562 * Writes the parsing of the record's data to @s.
5563 */
5564 void tep_print_event_data(struct tep_handle *pevent, struct trace_seq *s,
5565 struct tep_event *event,
5566 struct tep_record *record)
5567 {
5568 static const char *spaces = " "; /* 20 spaces */
5569 int len;
5570
5571 trace_seq_printf(s, " %s: ", event->name);
5572
5573 /* Space out the event names evenly. */
5574 len = strlen(event->name);
5575 if (len < 20)
5576 trace_seq_printf(s, "%.*s", 20 - len, spaces);
5577
5578 tep_event_info(s, event, record);
5579 }
5580
5581 void tep_print_event(struct tep_handle *pevent, struct trace_seq *s,
5582 struct tep_record *record, bool use_trace_clock)
5583 {
5584 struct tep_event *event;
5585
5586 event = tep_find_event_by_record(pevent, record);
5587 if (!event) {
5588 int i;
5589 int type = trace_parse_common_type(pevent, record->data);
5590
5591 do_warning("ug! no event found for type %d", type);
5592 trace_seq_printf(s, "[UNKNOWN TYPE %d]", type);
5593 for (i = 0; i < record->size; i++)
5594 trace_seq_printf(s, " %02x",
5595 ((unsigned char *)record->data)[i]);
5596 return;
5597 }
5598
5599 tep_print_event_task(pevent, s, event, record);
5600 tep_print_event_time(pevent, s, event, record, use_trace_clock);
5601 tep_print_event_data(pevent, s, event, record);
5602 }
5603
5604 static int events_id_cmp(const void *a, const void *b)
5605 {
5606 struct tep_event * const * ea = a;
5607 struct tep_event * const * eb = b;
5608
5609 if ((*ea)->id < (*eb)->id)
5610 return -1;
5611
5612 if ((*ea)->id > (*eb)->id)
5613 return 1;
5614
5615 return 0;
5616 }
5617
5618 static int events_name_cmp(const void *a, const void *b)
5619 {
5620 struct tep_event * const * ea = a;
5621 struct tep_event * const * eb = b;
5622 int res;
5623
5624 res = strcmp((*ea)->name, (*eb)->name);
5625 if (res)
5626 return res;
5627
5628 res = strcmp((*ea)->system, (*eb)->system);
5629 if (res)
5630 return res;
5631
5632 return events_id_cmp(a, b);
5633 }
5634
5635 static int events_system_cmp(const void *a, const void *b)
5636 {
5637 struct tep_event * const * ea = a;
5638 struct tep_event * const * eb = b;
5639 int res;
5640
5641 res = strcmp((*ea)->system, (*eb)->system);
5642 if (res)
5643 return res;
5644
5645 res = strcmp((*ea)->name, (*eb)->name);
5646 if (res)
5647 return res;
5648
5649 return events_id_cmp(a, b);
5650 }
5651
5652 struct tep_event **tep_list_events(struct tep_handle *pevent, enum tep_event_sort_type sort_type)
5653 {
5654 struct tep_event **events;
5655 int (*sort)(const void *a, const void *b);
5656
5657 events = pevent->sort_events;
5658
5659 if (events && pevent->last_type == sort_type)
5660 return events;
5661
5662 if (!events) {
5663 events = malloc(sizeof(*events) * (pevent->nr_events + 1));
5664 if (!events)
5665 return NULL;
5666
5667 memcpy(events, pevent->events, sizeof(*events) * pevent->nr_events);
5668 events[pevent->nr_events] = NULL;
5669
5670 pevent->sort_events = events;
5671
5672 /* the internal events are sorted by id */
5673 if (sort_type == TEP_EVENT_SORT_ID) {
5674 pevent->last_type = sort_type;
5675 return events;
5676 }
5677 }
5678
5679 switch (sort_type) {
5680 case TEP_EVENT_SORT_ID:
5681 sort = events_id_cmp;
5682 break;
5683 case TEP_EVENT_SORT_NAME:
5684 sort = events_name_cmp;
5685 break;
5686 case TEP_EVENT_SORT_SYSTEM:
5687 sort = events_system_cmp;
5688 break;
5689 default:
5690 return events;
5691 }
5692
5693 qsort(events, pevent->nr_events, sizeof(*events), sort);
5694 pevent->last_type = sort_type;
5695
5696 return events;
5697 }
5698
5699 static struct tep_format_field **
5700 get_event_fields(const char *type, const char *name,
5701 int count, struct tep_format_field *list)
5702 {
5703 struct tep_format_field **fields;
5704 struct tep_format_field *field;
5705 int i = 0;
5706
5707 fields = malloc(sizeof(*fields) * (count + 1));
5708 if (!fields)
5709 return NULL;
5710
5711 for (field = list; field; field = field->next) {
5712 fields[i++] = field;
5713 if (i == count + 1) {
5714 do_warning("event %s has more %s fields than specified",
5715 name, type);
5716 i--;
5717 break;
5718 }
5719 }
5720
5721 if (i != count)
5722 do_warning("event %s has less %s fields than specified",
5723 name, type);
5724
5725 fields[i] = NULL;
5726
5727 return fields;
5728 }
5729
5730 /**
5731 * tep_event_common_fields - return a list of common fields for an event
5732 * @event: the event to return the common fields of.
5733 *
5734 * Returns an allocated array of fields. The last item in the array is NULL.
5735 * The array must be freed with free().
5736 */
5737 struct tep_format_field **tep_event_common_fields(struct tep_event *event)
5738 {
5739 return get_event_fields("common", event->name,
5740 event->format.nr_common,
5741 event->format.common_fields);
5742 }
5743
5744 /**
5745 * tep_event_fields - return a list of event specific fields for an event
5746 * @event: the event to return the fields of.
5747 *
5748 * Returns an allocated array of fields. The last item in the array is NULL.
5749 * The array must be freed with free().
5750 */
5751 struct tep_format_field **tep_event_fields(struct tep_event *event)
5752 {
5753 return get_event_fields("event", event->name,
5754 event->format.nr_fields,
5755 event->format.fields);
5756 }
5757
5758 static void print_fields(struct trace_seq *s, struct tep_print_flag_sym *field)
5759 {
5760 trace_seq_printf(s, "{ %s, %s }", field->value, field->str);
5761 if (field->next) {
5762 trace_seq_puts(s, ", ");
5763 print_fields(s, field->next);
5764 }
5765 }
5766
5767 /* for debugging */
5768 static void print_args(struct tep_print_arg *args)
5769 {
5770 int print_paren = 1;
5771 struct trace_seq s;
5772
5773 switch (args->type) {
5774 case TEP_PRINT_NULL:
5775 printf("null");
5776 break;
5777 case TEP_PRINT_ATOM:
5778 printf("%s", args->atom.atom);
5779 break;
5780 case TEP_PRINT_FIELD:
5781 printf("REC->%s", args->field.name);
5782 break;
5783 case TEP_PRINT_FLAGS:
5784 printf("__print_flags(");
5785 print_args(args->flags.field);
5786 printf(", %s, ", args->flags.delim);
5787 trace_seq_init(&s);
5788 print_fields(&s, args->flags.flags);
5789 trace_seq_do_printf(&s);
5790 trace_seq_destroy(&s);
5791 printf(")");
5792 break;
5793 case TEP_PRINT_SYMBOL:
5794 printf("__print_symbolic(");
5795 print_args(args->symbol.field);
5796 printf(", ");
5797 trace_seq_init(&s);
5798 print_fields(&s, args->symbol.symbols);
5799 trace_seq_do_printf(&s);
5800 trace_seq_destroy(&s);
5801 printf(")");
5802 break;
5803 case TEP_PRINT_HEX:
5804 printf("__print_hex(");
5805 print_args(args->hex.field);
5806 printf(", ");
5807 print_args(args->hex.size);
5808 printf(")");
5809 break;
5810 case TEP_PRINT_HEX_STR:
5811 printf("__print_hex_str(");
5812 print_args(args->hex.field);
5813 printf(", ");
5814 print_args(args->hex.size);
5815 printf(")");
5816 break;
5817 case TEP_PRINT_INT_ARRAY:
5818 printf("__print_array(");
5819 print_args(args->int_array.field);
5820 printf(", ");
5821 print_args(args->int_array.count);
5822 printf(", ");
5823 print_args(args->int_array.el_size);
5824 printf(")");
5825 break;
5826 case TEP_PRINT_STRING:
5827 case TEP_PRINT_BSTRING:
5828 printf("__get_str(%s)", args->string.string);
5829 break;
5830 case TEP_PRINT_BITMASK:
5831 printf("__get_bitmask(%s)", args->bitmask.bitmask);
5832 break;
5833 case TEP_PRINT_TYPE:
5834 printf("(%s)", args->typecast.type);
5835 print_args(args->typecast.item);
5836 break;
5837 case TEP_PRINT_OP:
5838 if (strcmp(args->op.op, ":") == 0)
5839 print_paren = 0;
5840 if (print_paren)
5841 printf("(");
5842 print_args(args->op.left);
5843 printf(" %s ", args->op.op);
5844 print_args(args->op.right);
5845 if (print_paren)
5846 printf(")");
5847 break;
5848 default:
5849 /* we should warn... */
5850 return;
5851 }
5852 if (args->next) {
5853 printf("\n");
5854 print_args(args->next);
5855 }
5856 }
5857
5858 static void parse_header_field(const char *field,
5859 int *offset, int *size, int mandatory)
5860 {
5861 unsigned long long save_input_buf_ptr;
5862 unsigned long long save_input_buf_siz;
5863 char *token;
5864 int type;
5865
5866 save_input_buf_ptr = input_buf_ptr;
5867 save_input_buf_siz = input_buf_siz;
5868
5869 if (read_expected(TEP_EVENT_ITEM, "field") < 0)
5870 return;
5871 if (read_expected(TEP_EVENT_OP, ":") < 0)
5872 return;
5873
5874 /* type */
5875 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
5876 goto fail;
5877 free_token(token);
5878
5879 /*
5880 * If this is not a mandatory field, then test it first.
5881 */
5882 if (mandatory) {
5883 if (read_expected(TEP_EVENT_ITEM, field) < 0)
5884 return;
5885 } else {
5886 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
5887 goto fail;
5888 if (strcmp(token, field) != 0)
5889 goto discard;
5890 free_token(token);
5891 }
5892
5893 if (read_expected(TEP_EVENT_OP, ";") < 0)
5894 return;
5895 if (read_expected(TEP_EVENT_ITEM, "offset") < 0)
5896 return;
5897 if (read_expected(TEP_EVENT_OP, ":") < 0)
5898 return;
5899 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
5900 goto fail;
5901 *offset = atoi(token);
5902 free_token(token);
5903 if (read_expected(TEP_EVENT_OP, ";") < 0)
5904 return;
5905 if (read_expected(TEP_EVENT_ITEM, "size") < 0)
5906 return;
5907 if (read_expected(TEP_EVENT_OP, ":") < 0)
5908 return;
5909 if (read_expect_type(TEP_EVENT_ITEM, &token) < 0)
5910 goto fail;
5911 *size = atoi(token);
5912 free_token(token);
5913 if (read_expected(TEP_EVENT_OP, ";") < 0)
5914 return;
5915 type = read_token(&token);
5916 if (type != TEP_EVENT_NEWLINE) {
5917 /* newer versions of the kernel have a "signed" type */
5918 if (type != TEP_EVENT_ITEM)
5919 goto fail;
5920
5921 if (strcmp(token, "signed") != 0)
5922 goto fail;
5923
5924 free_token(token);
5925
5926 if (read_expected(TEP_EVENT_OP, ":") < 0)
5927 return;
5928
5929 if (read_expect_type(TEP_EVENT_ITEM, &token))
5930 goto fail;
5931
5932 free_token(token);
5933 if (read_expected(TEP_EVENT_OP, ";") < 0)
5934 return;
5935
5936 if (read_expect_type(TEP_EVENT_NEWLINE, &token))
5937 goto fail;
5938 }
5939 fail:
5940 free_token(token);
5941 return;
5942
5943 discard:
5944 input_buf_ptr = save_input_buf_ptr;
5945 input_buf_siz = save_input_buf_siz;
5946 *offset = 0;
5947 *size = 0;
5948 free_token(token);
5949 }
5950
5951 /**
5952 * tep_parse_header_page - parse the data stored in the header page
5953 * @pevent: the handle to the pevent
5954 * @buf: the buffer storing the header page format string
5955 * @size: the size of @buf
5956 * @long_size: the long size to use if there is no header
5957 *
5958 * This parses the header page format for information on the
5959 * ring buffer used. The @buf should be copied from
5960 *
5961 * /sys/kernel/debug/tracing/events/header_page
5962 */
5963 int tep_parse_header_page(struct tep_handle *pevent, char *buf, unsigned long size,
5964 int long_size)
5965 {
5966 int ignore;
5967
5968 if (!size) {
5969 /*
5970 * Old kernels did not have header page info.
5971 * Sorry but we just use what we find here in user space.
5972 */
5973 pevent->header_page_ts_size = sizeof(long long);
5974 pevent->header_page_size_size = long_size;
5975 pevent->header_page_data_offset = sizeof(long long) + long_size;
5976 pevent->old_format = 1;
5977 return -1;
5978 }
5979 init_input_buf(buf, size);
5980
5981 parse_header_field("timestamp", &pevent->header_page_ts_offset,
5982 &pevent->header_page_ts_size, 1);
5983 parse_header_field("commit", &pevent->header_page_size_offset,
5984 &pevent->header_page_size_size, 1);
5985 parse_header_field("overwrite", &pevent->header_page_overwrite,
5986 &ignore, 0);
5987 parse_header_field("data", &pevent->header_page_data_offset,
5988 &pevent->header_page_data_size, 1);
5989
5990 return 0;
5991 }
5992
5993 static int event_matches(struct tep_event *event,
5994 int id, const char *sys_name,
5995 const char *event_name)
5996 {
5997 if (id >= 0 && id != event->id)
5998 return 0;
5999
6000 if (event_name && (strcmp(event_name, event->name) != 0))
6001 return 0;
6002
6003 if (sys_name && (strcmp(sys_name, event->system) != 0))
6004 return 0;
6005
6006 return 1;
6007 }
6008
6009 static void free_handler(struct event_handler *handle)
6010 {
6011 free((void *)handle->sys_name);
6012 free((void *)handle->event_name);
6013 free(handle);
6014 }
6015
6016 static int find_event_handle(struct tep_handle *pevent, struct tep_event *event)
6017 {
6018 struct event_handler *handle, **next;
6019
6020 for (next = &pevent->handlers; *next;
6021 next = &(*next)->next) {
6022 handle = *next;
6023 if (event_matches(event, handle->id,
6024 handle->sys_name,
6025 handle->event_name))
6026 break;
6027 }
6028
6029 if (!(*next))
6030 return 0;
6031
6032 pr_stat("overriding event (%d) %s:%s with new print handler",
6033 event->id, event->system, event->name);
6034
6035 event->handler = handle->func;
6036 event->context = handle->context;
6037
6038 *next = handle->next;
6039 free_handler(handle);
6040
6041 return 1;
6042 }
6043
6044 /**
6045 * __tep_parse_format - parse the event format
6046 * @buf: the buffer storing the event format string
6047 * @size: the size of @buf
6048 * @sys: the system the event belongs to
6049 *
6050 * This parses the event format and creates an event structure
6051 * to quickly parse raw data for a given event.
6052 *
6053 * These files currently come from:
6054 *
6055 * /sys/kernel/debug/tracing/events/.../.../format
6056 */
6057 enum tep_errno __tep_parse_format(struct tep_event **eventp,
6058 struct tep_handle *pevent, const char *buf,
6059 unsigned long size, const char *sys)
6060 {
6061 struct tep_event *event;
6062 int ret;
6063
6064 init_input_buf(buf, size);
6065
6066 *eventp = event = alloc_event();
6067 if (!event)
6068 return TEP_ERRNO__MEM_ALLOC_FAILED;
6069
6070 event->name = event_read_name();
6071 if (!event->name) {
6072 /* Bad event? */
6073 ret = TEP_ERRNO__MEM_ALLOC_FAILED;
6074 goto event_alloc_failed;
6075 }
6076
6077 if (strcmp(sys, "ftrace") == 0) {
6078 event->flags |= TEP_EVENT_FL_ISFTRACE;
6079
6080 if (strcmp(event->name, "bprint") == 0)
6081 event->flags |= TEP_EVENT_FL_ISBPRINT;
6082 }
6083
6084 event->id = event_read_id();
6085 if (event->id < 0) {
6086 ret = TEP_ERRNO__READ_ID_FAILED;
6087 /*
6088 * This isn't an allocation error actually.
6089 * But as the ID is critical, just bail out.
6090 */
6091 goto event_alloc_failed;
6092 }
6093
6094 event->system = strdup(sys);
6095 if (!event->system) {
6096 ret = TEP_ERRNO__MEM_ALLOC_FAILED;
6097 goto event_alloc_failed;
6098 }
6099
6100 /* Add pevent to event so that it can be referenced */
6101 event->pevent = pevent;
6102
6103 ret = event_read_format(event);
6104 if (ret < 0) {
6105 ret = TEP_ERRNO__READ_FORMAT_FAILED;
6106 goto event_parse_failed;
6107 }
6108
6109 /*
6110 * If the event has an override, don't print warnings if the event
6111 * print format fails to parse.
6112 */
6113 if (pevent && find_event_handle(pevent, event))
6114 show_warning = 0;
6115
6116 ret = event_read_print(event);
6117 show_warning = 1;
6118
6119 if (ret < 0) {
6120 ret = TEP_ERRNO__READ_PRINT_FAILED;
6121 goto event_parse_failed;
6122 }
6123
6124 if (!ret && (event->flags & TEP_EVENT_FL_ISFTRACE)) {
6125 struct tep_format_field *field;
6126 struct tep_print_arg *arg, **list;
6127
6128 /* old ftrace had no args */
6129 list = &event->print_fmt.args;
6130 for (field = event->format.fields; field; field = field->next) {
6131 arg = alloc_arg();
6132 if (!arg) {
6133 event->flags |= TEP_EVENT_FL_FAILED;
6134 return TEP_ERRNO__OLD_FTRACE_ARG_FAILED;
6135 }
6136 arg->type = TEP_PRINT_FIELD;
6137 arg->field.name = strdup(field->name);
6138 if (!arg->field.name) {
6139 event->flags |= TEP_EVENT_FL_FAILED;
6140 free_arg(arg);
6141 return TEP_ERRNO__OLD_FTRACE_ARG_FAILED;
6142 }
6143 arg->field.field = field;
6144 *list = arg;
6145 list = &arg->next;
6146 }
6147 return 0;
6148 }
6149
6150 return 0;
6151
6152 event_parse_failed:
6153 event->flags |= TEP_EVENT_FL_FAILED;
6154 return ret;
6155
6156 event_alloc_failed:
6157 free(event->system);
6158 free(event->name);
6159 free(event);
6160 *eventp = NULL;
6161 return ret;
6162 }
6163
6164 static enum tep_errno
6165 __parse_event(struct tep_handle *pevent,
6166 struct tep_event **eventp,
6167 const char *buf, unsigned long size,
6168 const char *sys)
6169 {
6170 int ret = __tep_parse_format(eventp, pevent, buf, size, sys);
6171 struct tep_event *event = *eventp;
6172
6173 if (event == NULL)
6174 return ret;
6175
6176 if (pevent && add_event(pevent, event)) {
6177 ret = TEP_ERRNO__MEM_ALLOC_FAILED;
6178 goto event_add_failed;
6179 }
6180
6181 #define PRINT_ARGS 0
6182 if (PRINT_ARGS && event->print_fmt.args)
6183 print_args(event->print_fmt.args);
6184
6185 return 0;
6186
6187 event_add_failed:
6188 tep_free_event(event);
6189 return ret;
6190 }
6191
6192 /**
6193 * tep_parse_format - parse the event format
6194 * @pevent: the handle to the pevent
6195 * @eventp: returned format
6196 * @buf: the buffer storing the event format string
6197 * @size: the size of @buf
6198 * @sys: the system the event belongs to
6199 *
6200 * This parses the event format and creates an event structure
6201 * to quickly parse raw data for a given event.
6202 *
6203 * These files currently come from:
6204 *
6205 * /sys/kernel/debug/tracing/events/.../.../format
6206 */
6207 enum tep_errno tep_parse_format(struct tep_handle *pevent,
6208 struct tep_event **eventp,
6209 const char *buf,
6210 unsigned long size, const char *sys)
6211 {
6212 return __parse_event(pevent, eventp, buf, size, sys);
6213 }
6214
6215 /**
6216 * tep_parse_event - parse the event format
6217 * @pevent: the handle to the pevent
6218 * @buf: the buffer storing the event format string
6219 * @size: the size of @buf
6220 * @sys: the system the event belongs to
6221 *
6222 * This parses the event format and creates an event structure
6223 * to quickly parse raw data for a given event.
6224 *
6225 * These files currently come from:
6226 *
6227 * /sys/kernel/debug/tracing/events/.../.../format
6228 */
6229 enum tep_errno tep_parse_event(struct tep_handle *pevent, const char *buf,
6230 unsigned long size, const char *sys)
6231 {
6232 struct tep_event *event = NULL;
6233 return __parse_event(pevent, &event, buf, size, sys);
6234 }
6235
6236 int get_field_val(struct trace_seq *s, struct tep_format_field *field,
6237 const char *name, struct tep_record *record,
6238 unsigned long long *val, int err)
6239 {
6240 if (!field) {
6241 if (err)
6242 trace_seq_printf(s, "<CANT FIND FIELD %s>", name);
6243 return -1;
6244 }
6245
6246 if (tep_read_number_field(field, record->data, val)) {
6247 if (err)
6248 trace_seq_printf(s, " %s=INVALID", name);
6249 return -1;
6250 }
6251
6252 return 0;
6253 }
6254
6255 /**
6256 * tep_get_field_raw - return the raw pointer into the data field
6257 * @s: The seq to print to on error
6258 * @event: the event that the field is for
6259 * @name: The name of the field
6260 * @record: The record with the field name.
6261 * @len: place to store the field length.
6262 * @err: print default error if failed.
6263 *
6264 * Returns a pointer into record->data of the field and places
6265 * the length of the field in @len.
6266 *
6267 * On failure, it returns NULL.
6268 */
6269 void *tep_get_field_raw(struct trace_seq *s, struct tep_event *event,
6270 const char *name, struct tep_record *record,
6271 int *len, int err)
6272 {
6273 struct tep_format_field *field;
6274 void *data = record->data;
6275 unsigned offset;
6276 int dummy;
6277
6278 if (!event)
6279 return NULL;
6280
6281 field = tep_find_field(event, name);
6282
6283 if (!field) {
6284 if (err)
6285 trace_seq_printf(s, "<CANT FIND FIELD %s>", name);
6286 return NULL;
6287 }
6288
6289 /* Allow @len to be NULL */
6290 if (!len)
6291 len = &dummy;
6292
6293 offset = field->offset;
6294 if (field->flags & TEP_FIELD_IS_DYNAMIC) {
6295 offset = tep_read_number(event->pevent,
6296 data + offset, field->size);
6297 *len = offset >> 16;
6298 offset &= 0xffff;
6299 } else
6300 *len = field->size;
6301
6302 return data + offset;
6303 }
6304
6305 /**
6306 * tep_get_field_val - find a field and return its value
6307 * @s: The seq to print to on error
6308 * @event: the event that the field is for
6309 * @name: The name of the field
6310 * @record: The record with the field name.
6311 * @val: place to store the value of the field.
6312 * @err: print default error if failed.
6313 *
6314 * Returns 0 on success -1 on field not found.
6315 */
6316 int tep_get_field_val(struct trace_seq *s, struct tep_event *event,
6317 const char *name, struct tep_record *record,
6318 unsigned long long *val, int err)
6319 {
6320 struct tep_format_field *field;
6321
6322 if (!event)
6323 return -1;
6324
6325 field = tep_find_field(event, name);
6326
6327 return get_field_val(s, field, name, record, val, err);
6328 }
6329
6330 /**
6331 * tep_get_common_field_val - find a common field and return its value
6332 * @s: The seq to print to on error
6333 * @event: the event that the field is for
6334 * @name: The name of the field
6335 * @record: The record with the field name.
6336 * @val: place to store the value of the field.
6337 * @err: print default error if failed.
6338 *
6339 * Returns 0 on success -1 on field not found.
6340 */
6341 int tep_get_common_field_val(struct trace_seq *s, struct tep_event *event,
6342 const char *name, struct tep_record *record,
6343 unsigned long long *val, int err)
6344 {
6345 struct tep_format_field *field;
6346
6347 if (!event)
6348 return -1;
6349
6350 field = tep_find_common_field(event, name);
6351
6352 return get_field_val(s, field, name, record, val, err);
6353 }
6354
6355 /**
6356 * tep_get_any_field_val - find a any field and return its value
6357 * @s: The seq to print to on error
6358 * @event: the event that the field is for
6359 * @name: The name of the field
6360 * @record: The record with the field name.
6361 * @val: place to store the value of the field.
6362 * @err: print default error if failed.
6363 *
6364 * Returns 0 on success -1 on field not found.
6365 */
6366 int tep_get_any_field_val(struct trace_seq *s, struct tep_event *event,
6367 const char *name, struct tep_record *record,
6368 unsigned long long *val, int err)
6369 {
6370 struct tep_format_field *field;
6371
6372 if (!event)
6373 return -1;
6374
6375 field = tep_find_any_field(event, name);
6376
6377 return get_field_val(s, field, name, record, val, err);
6378 }
6379
6380 /**
6381 * tep_print_num_field - print a field and a format
6382 * @s: The seq to print to
6383 * @fmt: The printf format to print the field with.
6384 * @event: the event that the field is for
6385 * @name: The name of the field
6386 * @record: The record with the field name.
6387 * @err: print default error if failed.
6388 *
6389 * Returns: 0 on success, -1 field not found, or 1 if buffer is full.
6390 */
6391 int tep_print_num_field(struct trace_seq *s, const char *fmt,
6392 struct tep_event *event, const char *name,
6393 struct tep_record *record, int err)
6394 {
6395 struct tep_format_field *field = tep_find_field(event, name);
6396 unsigned long long val;
6397
6398 if (!field)
6399 goto failed;
6400
6401 if (tep_read_number_field(field, record->data, &val))
6402 goto failed;
6403
6404 return trace_seq_printf(s, fmt, val);
6405
6406 failed:
6407 if (err)
6408 trace_seq_printf(s, "CAN'T FIND FIELD \"%s\"", name);
6409 return -1;
6410 }
6411
6412 /**
6413 * tep_print_func_field - print a field and a format for function pointers
6414 * @s: The seq to print to
6415 * @fmt: The printf format to print the field with.
6416 * @event: the event that the field is for
6417 * @name: The name of the field
6418 * @record: The record with the field name.
6419 * @err: print default error if failed.
6420 *
6421 * Returns: 0 on success, -1 field not found, or 1 if buffer is full.
6422 */
6423 int tep_print_func_field(struct trace_seq *s, const char *fmt,
6424 struct tep_event *event, const char *name,
6425 struct tep_record *record, int err)
6426 {
6427 struct tep_format_field *field = tep_find_field(event, name);
6428 struct tep_handle *pevent = event->pevent;
6429 unsigned long long val;
6430 struct func_map *func;
6431 char tmp[128];
6432
6433 if (!field)
6434 goto failed;
6435
6436 if (tep_read_number_field(field, record->data, &val))
6437 goto failed;
6438
6439 func = find_func(pevent, val);
6440
6441 if (func)
6442 snprintf(tmp, 128, "%s/0x%llx", func->func, func->addr - val);
6443 else
6444 sprintf(tmp, "0x%08llx", val);
6445
6446 return trace_seq_printf(s, fmt, tmp);
6447
6448 failed:
6449 if (err)
6450 trace_seq_printf(s, "CAN'T FIND FIELD \"%s\"", name);
6451 return -1;
6452 }
6453
6454 static void free_func_handle(struct tep_function_handler *func)
6455 {
6456 struct func_params *params;
6457
6458 free(func->name);
6459
6460 while (func->params) {
6461 params = func->params;
6462 func->params = params->next;
6463 free(params);
6464 }
6465
6466 free(func);
6467 }
6468
6469 /**
6470 * tep_register_print_function - register a helper function
6471 * @pevent: the handle to the pevent
6472 * @func: the function to process the helper function
6473 * @ret_type: the return type of the helper function
6474 * @name: the name of the helper function
6475 * @parameters: A list of enum tep_func_arg_type
6476 *
6477 * Some events may have helper functions in the print format arguments.
6478 * This allows a plugin to dynamically create a way to process one
6479 * of these functions.
6480 *
6481 * The @parameters is a variable list of tep_func_arg_type enums that
6482 * must end with TEP_FUNC_ARG_VOID.
6483 */
6484 int tep_register_print_function(struct tep_handle *pevent,
6485 tep_func_handler func,
6486 enum tep_func_arg_type ret_type,
6487 char *name, ...)
6488 {
6489 struct tep_function_handler *func_handle;
6490 struct func_params **next_param;
6491 struct func_params *param;
6492 enum tep_func_arg_type type;
6493 va_list ap;
6494 int ret;
6495
6496 func_handle = find_func_handler(pevent, name);
6497 if (func_handle) {
6498 /*
6499 * This is most like caused by the users own
6500 * plugins updating the function. This overrides the
6501 * system defaults.
6502 */
6503 pr_stat("override of function helper '%s'", name);
6504 remove_func_handler(pevent, name);
6505 }
6506
6507 func_handle = calloc(1, sizeof(*func_handle));
6508 if (!func_handle) {
6509 do_warning("Failed to allocate function handler");
6510 return TEP_ERRNO__MEM_ALLOC_FAILED;
6511 }
6512
6513 func_handle->ret_type = ret_type;
6514 func_handle->name = strdup(name);
6515 func_handle->func = func;
6516 if (!func_handle->name) {
6517 do_warning("Failed to allocate function name");
6518 free(func_handle);
6519 return TEP_ERRNO__MEM_ALLOC_FAILED;
6520 }
6521
6522 next_param = &(func_handle->params);
6523 va_start(ap, name);
6524 for (;;) {
6525 type = va_arg(ap, enum tep_func_arg_type);
6526 if (type == TEP_FUNC_ARG_VOID)
6527 break;
6528
6529 if (type >= TEP_FUNC_ARG_MAX_TYPES) {
6530 do_warning("Invalid argument type %d", type);
6531 ret = TEP_ERRNO__INVALID_ARG_TYPE;
6532 goto out_free;
6533 }
6534
6535 param = malloc(sizeof(*param));
6536 if (!param) {
6537 do_warning("Failed to allocate function param");
6538 ret = TEP_ERRNO__MEM_ALLOC_FAILED;
6539 goto out_free;
6540 }
6541 param->type = type;
6542 param->next = NULL;
6543
6544 *next_param = param;
6545 next_param = &(param->next);
6546
6547 func_handle->nr_args++;
6548 }
6549 va_end(ap);
6550
6551 func_handle->next = pevent->func_handlers;
6552 pevent->func_handlers = func_handle;
6553
6554 return 0;
6555 out_free:
6556 va_end(ap);
6557 free_func_handle(func_handle);
6558 return ret;
6559 }
6560
6561 /**
6562 * tep_unregister_print_function - unregister a helper function
6563 * @pevent: the handle to the pevent
6564 * @func: the function to process the helper function
6565 * @name: the name of the helper function
6566 *
6567 * This function removes existing print handler for function @name.
6568 *
6569 * Returns 0 if the handler was removed successully, -1 otherwise.
6570 */
6571 int tep_unregister_print_function(struct tep_handle *pevent,
6572 tep_func_handler func, char *name)
6573 {
6574 struct tep_function_handler *func_handle;
6575
6576 func_handle = find_func_handler(pevent, name);
6577 if (func_handle && func_handle->func == func) {
6578 remove_func_handler(pevent, name);
6579 return 0;
6580 }
6581 return -1;
6582 }
6583
6584 static struct tep_event *search_event(struct tep_handle *pevent, int id,
6585 const char *sys_name,
6586 const char *event_name)
6587 {
6588 struct tep_event *event;
6589
6590 if (id >= 0) {
6591 /* search by id */
6592 event = tep_find_event(pevent, id);
6593 if (!event)
6594 return NULL;
6595 if (event_name && (strcmp(event_name, event->name) != 0))
6596 return NULL;
6597 if (sys_name && (strcmp(sys_name, event->system) != 0))
6598 return NULL;
6599 } else {
6600 event = tep_find_event_by_name(pevent, sys_name, event_name);
6601 if (!event)
6602 return NULL;
6603 }
6604 return event;
6605 }
6606
6607 /**
6608 * tep_register_event_handler - register a way to parse an event
6609 * @pevent: the handle to the pevent
6610 * @id: the id of the event to register
6611 * @sys_name: the system name the event belongs to
6612 * @event_name: the name of the event
6613 * @func: the function to call to parse the event information
6614 * @context: the data to be passed to @func
6615 *
6616 * This function allows a developer to override the parsing of
6617 * a given event. If for some reason the default print format
6618 * is not sufficient, this function will register a function
6619 * for an event to be used to parse the data instead.
6620 *
6621 * If @id is >= 0, then it is used to find the event.
6622 * else @sys_name and @event_name are used.
6623 *
6624 * Returns:
6625 * TEP_REGISTER_SUCCESS_OVERWRITE if an existing handler is overwritten
6626 * TEP_REGISTER_SUCCESS if a new handler is registered successfully
6627 * negative TEP_ERRNO_... in case of an error
6628 *
6629 */
6630 int tep_register_event_handler(struct tep_handle *pevent, int id,
6631 const char *sys_name, const char *event_name,
6632 tep_event_handler_func func, void *context)
6633 {
6634 struct tep_event *event;
6635 struct event_handler *handle;
6636
6637 event = search_event(pevent, id, sys_name, event_name);
6638 if (event == NULL)
6639 goto not_found;
6640
6641 pr_stat("overriding event (%d) %s:%s with new print handler",
6642 event->id, event->system, event->name);
6643
6644 event->handler = func;
6645 event->context = context;
6646 return TEP_REGISTER_SUCCESS_OVERWRITE;
6647
6648 not_found:
6649 /* Save for later use. */
6650 handle = calloc(1, sizeof(*handle));
6651 if (!handle) {
6652 do_warning("Failed to allocate event handler");
6653 return TEP_ERRNO__MEM_ALLOC_FAILED;
6654 }
6655
6656 handle->id = id;
6657 if (event_name)
6658 handle->event_name = strdup(event_name);
6659 if (sys_name)
6660 handle->sys_name = strdup(sys_name);
6661
6662 if ((event_name && !handle->event_name) ||
6663 (sys_name && !handle->sys_name)) {
6664 do_warning("Failed to allocate event/sys name");
6665 free((void *)handle->event_name);
6666 free((void *)handle->sys_name);
6667 free(handle);
6668 return TEP_ERRNO__MEM_ALLOC_FAILED;
6669 }
6670
6671 handle->func = func;
6672 handle->next = pevent->handlers;
6673 pevent->handlers = handle;
6674 handle->context = context;
6675
6676 return TEP_REGISTER_SUCCESS;
6677 }
6678
6679 static int handle_matches(struct event_handler *handler, int id,
6680 const char *sys_name, const char *event_name,
6681 tep_event_handler_func func, void *context)
6682 {
6683 if (id >= 0 && id != handler->id)
6684 return 0;
6685
6686 if (event_name && (strcmp(event_name, handler->event_name) != 0))
6687 return 0;
6688
6689 if (sys_name && (strcmp(sys_name, handler->sys_name) != 0))
6690 return 0;
6691
6692 if (func != handler->func || context != handler->context)
6693 return 0;
6694
6695 return 1;
6696 }
6697
6698 /**
6699 * tep_unregister_event_handler - unregister an existing event handler
6700 * @pevent: the handle to the pevent
6701 * @id: the id of the event to unregister
6702 * @sys_name: the system name the handler belongs to
6703 * @event_name: the name of the event handler
6704 * @func: the function to call to parse the event information
6705 * @context: the data to be passed to @func
6706 *
6707 * This function removes existing event handler (parser).
6708 *
6709 * If @id is >= 0, then it is used to find the event.
6710 * else @sys_name and @event_name are used.
6711 *
6712 * Returns 0 if handler was removed successfully, -1 if event was not found.
6713 */
6714 int tep_unregister_event_handler(struct tep_handle *pevent, int id,
6715 const char *sys_name, const char *event_name,
6716 tep_event_handler_func func, void *context)
6717 {
6718 struct tep_event *event;
6719 struct event_handler *handle;
6720 struct event_handler **next;
6721
6722 event = search_event(pevent, id, sys_name, event_name);
6723 if (event == NULL)
6724 goto not_found;
6725
6726 if (event->handler == func && event->context == context) {
6727 pr_stat("removing override handler for event (%d) %s:%s. Going back to default handler.",
6728 event->id, event->system, event->name);
6729
6730 event->handler = NULL;
6731 event->context = NULL;
6732 return 0;
6733 }
6734
6735 not_found:
6736 for (next = &pevent->handlers; *next; next = &(*next)->next) {
6737 handle = *next;
6738 if (handle_matches(handle, id, sys_name, event_name,
6739 func, context))
6740 break;
6741 }
6742
6743 if (!(*next))
6744 return -1;
6745
6746 *next = handle->next;
6747 free_handler(handle);
6748
6749 return 0;
6750 }
6751
6752 /**
6753 * tep_alloc - create a pevent handle
6754 */
6755 struct tep_handle *tep_alloc(void)
6756 {
6757 struct tep_handle *pevent = calloc(1, sizeof(*pevent));
6758
6759 if (pevent) {
6760 pevent->ref_count = 1;
6761 pevent->host_bigendian = tep_host_bigendian();
6762 }
6763
6764 return pevent;
6765 }
6766
6767 void tep_ref(struct tep_handle *pevent)
6768 {
6769 pevent->ref_count++;
6770 }
6771
6772 int tep_get_ref(struct tep_handle *tep)
6773 {
6774 if (tep)
6775 return tep->ref_count;
6776 return 0;
6777 }
6778
6779 void tep_free_format_field(struct tep_format_field *field)
6780 {
6781 free(field->type);
6782 if (field->alias != field->name)
6783 free(field->alias);
6784 free(field->name);
6785 free(field);
6786 }
6787
6788 static void free_format_fields(struct tep_format_field *field)
6789 {
6790 struct tep_format_field *next;
6791
6792 while (field) {
6793 next = field->next;
6794 tep_free_format_field(field);
6795 field = next;
6796 }
6797 }
6798
6799 static void free_formats(struct tep_format *format)
6800 {
6801 free_format_fields(format->common_fields);
6802 free_format_fields(format->fields);
6803 }
6804
6805 void tep_free_event(struct tep_event *event)
6806 {
6807 free(event->name);
6808 free(event->system);
6809
6810 free_formats(&event->format);
6811
6812 free(event->print_fmt.format);
6813 free_args(event->print_fmt.args);
6814
6815 free(event);
6816 }
6817
6818 /**
6819 * tep_free - free a pevent handle
6820 * @pevent: the pevent handle to free
6821 */
6822 void tep_free(struct tep_handle *pevent)
6823 {
6824 struct cmdline_list *cmdlist, *cmdnext;
6825 struct func_list *funclist, *funcnext;
6826 struct printk_list *printklist, *printknext;
6827 struct tep_function_handler *func_handler;
6828 struct event_handler *handle;
6829 int i;
6830
6831 if (!pevent)
6832 return;
6833
6834 cmdlist = pevent->cmdlist;
6835 funclist = pevent->funclist;
6836 printklist = pevent->printklist;
6837
6838 pevent->ref_count--;
6839 if (pevent->ref_count)
6840 return;
6841
6842 if (pevent->cmdlines) {
6843 for (i = 0; i < pevent->cmdline_count; i++)
6844 free(pevent->cmdlines[i].comm);
6845 free(pevent->cmdlines);
6846 }
6847
6848 while (cmdlist) {
6849 cmdnext = cmdlist->next;
6850 free(cmdlist->comm);
6851 free(cmdlist);
6852 cmdlist = cmdnext;
6853 }
6854
6855 if (pevent->func_map) {
6856 for (i = 0; i < (int)pevent->func_count; i++) {
6857 free(pevent->func_map[i].func);
6858 free(pevent->func_map[i].mod);
6859 }
6860 free(pevent->func_map);
6861 }
6862
6863 while (funclist) {
6864 funcnext = funclist->next;
6865 free(funclist->func);
6866 free(funclist->mod);
6867 free(funclist);
6868 funclist = funcnext;
6869 }
6870
6871 while (pevent->func_handlers) {
6872 func_handler = pevent->func_handlers;
6873 pevent->func_handlers = func_handler->next;
6874 free_func_handle(func_handler);
6875 }
6876
6877 if (pevent->printk_map) {
6878 for (i = 0; i < (int)pevent->printk_count; i++)
6879 free(pevent->printk_map[i].printk);
6880 free(pevent->printk_map);
6881 }
6882
6883 while (printklist) {
6884 printknext = printklist->next;
6885 free(printklist->printk);
6886 free(printklist);
6887 printklist = printknext;
6888 }
6889
6890 for (i = 0; i < pevent->nr_events; i++)
6891 tep_free_event(pevent->events[i]);
6892
6893 while (pevent->handlers) {
6894 handle = pevent->handlers;
6895 pevent->handlers = handle->next;
6896 free_handler(handle);
6897 }
6898
6899 free(pevent->trace_clock);
6900 free(pevent->events);
6901 free(pevent->sort_events);
6902 free(pevent->func_resolver);
6903
6904 free(pevent);
6905 }
6906
6907 void tep_unref(struct tep_handle *pevent)
6908 {
6909 tep_free(pevent);
6910 }
Ubuntu combined Linux kernel mirror