]> pd.if.org Git - nbds/blob - runtime/lwt.c
be83e5fb1c31453463897f231d5318eb24f01cd9
[nbds] / runtime / lwt.c
1 /* 
2  * Written by Josh Dybnis and released to the public domain, as explained at
3  * http://creativecommons.org/licenses/publicdomain
4  *
5  * lightweight tracing 
6  */
7 #include <stdio.h>
8 #include "common.h"
9 #include "runtime_local.h"
10 #include "lwt.h"
11 #include "mem.h"
12
13 #define LWT_BUFFER_SCALE 16
14 #define LWT_BUFFER_SIZE (1 << LWT_BUFFER_SCALE)
15 #define LWT_BUFFER_MASK (LWT_BUFFER_SIZE - 1)
16
17 volatile int halt_ = 0;
18
19 typedef struct lwt_record {
20     uint64_t timestamp;
21     const char *format;
22     size_t value1;
23     size_t value2;
24 } lwt_record_t;
25
26 typedef struct lwt_buffer {
27     uint32_t head;
28     lwt_record_t x[0];
29 } lwt_buffer_t;
30
31 lwt_buffer_t *lwt_buf_[MAX_NUM_THREADS] = {};
32 uint64_t flag_mask_ = 0;
33 static const char *flags_ = "";
34
35 void lwt_thread_init (int thread_id)
36 {
37     assert(thread_id < MAX_NUM_THREADS);
38     if (lwt_buf_[thread_id] == NULL) {
39         lwt_buf_[thread_id] = (lwt_buffer_t *)nbd_malloc(sizeof(lwt_buffer_t) + sizeof(lwt_record_t) * LWT_BUFFER_SIZE);
40         memset(lwt_buf_[thread_id], 0, sizeof(lwt_buffer_t));
41     }
42 }
43
44 void lwt_set_trace_level (const char *flags)
45 {
46     assert(strlen(flags) % 2 == 0); // a well formed <flags> should be an even number of characters long
47     flags_ = flags;
48     int i;
49     for (i = 0; flags[i]; i+=2) {
50         flag_mask_ |= 1 << (flags[i] - 'A');
51     }
52 }
53
54 static inline void dump_record (FILE *file, int thread_id, lwt_record_t *r, uint64_t offset)
55 {
56     // print the record if its trace category is enabled at a high enough level
57     int flag  =  (size_t)r->format >> 56;
58     int level = ((size_t)r->format >> 48) & 0xFF;
59     const char *f = strchr(flags_, flag);
60     if (f != NULL && level <= f[1]) {
61         char s[3] = {flag, level, '\0'};
62         fprintf(file, "%09llu %d %s ", ((uint64_t)r->timestamp - offset) >> 6, thread_id, s);
63         const char *format = (const char *)((size_t)r->format & MASK(48)); // strip out the embedded flags
64         fprintf(file, format, r->value1, r->value2);
65         fprintf(file, "\n");
66     }
67 }
68
69 static void dump_buffer (FILE *file, int thread_id, uint64_t offset)
70 {
71     lwt_buffer_t *tb = lwt_buf_[thread_id]; 
72     assert(tb);
73     if (tb->head > LWT_BUFFER_SIZE) {
74         for (int i = tb->head & LWT_BUFFER_MASK; i < LWT_BUFFER_SIZE; ++i) {
75             dump_record(file, thread_id, tb->x + i, offset);
76         }
77     }
78
79     for (int i = 0; i < (tb->head & LWT_BUFFER_MASK); ++i) {
80         dump_record(file, thread_id, tb->x + i, offset);
81     }
82 }
83
84 void lwt_dump (const char *file_name)
85 {
86     halt_ = 1;
87     uint64_t offset = (uint64_t)-1;
88
89     for (int i = 0; i < MAX_NUM_THREADS; ++i) {
90         if (lwt_buf_[i] != NULL && lwt_buf_[i]->head != 0) {
91             uint64_t x = lwt_buf_[i]->x[0].timestamp;
92             if (x < offset) {
93                 offset = x;
94             }
95             if (lwt_buf_[i]->head > LWT_BUFFER_SIZE)
96             {
97                 x = lwt_buf_[i]->x[lwt_buf_[i]->head & LWT_BUFFER_MASK].timestamp;
98                 if (x < offset) {
99                     offset = x;
100                 }
101             }
102         }
103     }
104
105     if (offset != (uint64_t)-1) {
106         FILE *file = fopen(file_name, "w");
107         assert(file);
108         for (int i = 0; i < MAX_NUM_THREADS; ++i) {
109             if (lwt_buf_[i] != NULL) {
110                 dump_buffer(file, i, offset);
111             }
112         }
113         fflush(file);
114         fclose(file);
115     }
116 }
117
118 void lwt_trace_i (const char *format, size_t value1, size_t value2) {
119     if (*(volatile int *)&halt_)
120         return;
121     LOCALIZE_THREAD_LOCAL(tid_, int);
122     lwt_buffer_t *tb = lwt_buf_[tid_];
123     if (tb != NULL) {
124         unsigned int u, l;
125         __asm__ __volatile__("rdtsc" : "=a" (l), "=d" (u)); 
126         uint64_t timestamp = ((uint64_t)u << 32) | l; 
127         lwt_record_t temp = { timestamp, format, value1, value2 };
128
129         tb->x[tb->head++ & LWT_BUFFER_MASK] = temp;
130     }
131 }