| 1 | /* |
| 2 | * buffers.h |
| 3 | * LTTng userspace tracer buffering system |
| 4 | * |
| 5 | * Copyright (C) 2009 - Pierre-Marc Fournier (pierre-marc dot fournier at polymtl dot ca) |
| 6 | * Copyright (C) 2008 - Mathieu Desnoyers (mathieu.desnoyers@polymtl.ca) |
| 7 | * |
| 8 | * This library is free software; you can redistribute it and/or |
| 9 | * modify it under the terms of the GNU Lesser General Public |
| 10 | * License as published by the Free Software Foundation; either |
| 11 | * version 2.1 of the License, or (at your option) any later version. |
| 12 | * |
| 13 | * This library is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 16 | * Lesser General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU Lesser General Public |
| 19 | * License along with this library; if not, write to the Free Software |
| 20 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
| 21 | */ |
| 22 | |
| 23 | #ifndef _UST_BUFFERS_H |
| 24 | #define _UST_BUFFERS_H |
| 25 | |
| 26 | #include <assert.h> |
| 27 | |
| 28 | #include <ust/core.h> |
| 29 | |
| 30 | #include "usterr.h" |
| 31 | #include "channels.h" |
| 32 | #include "tracerconst.h" |
| 33 | #include "tracercore.h" |
| 34 | #include "header-inline.h" |
| 35 | |
| 36 | /***** FIXME: SHOULD BE REMOVED ***** */ |
| 37 | |
| 38 | /* |
| 39 | * BUFFER_TRUNC zeroes the subbuffer offset and the subbuffer number parts of |
| 40 | * the offset, which leaves only the buffer number. |
| 41 | */ |
| 42 | #define BUFFER_TRUNC(offset, chan) \ |
| 43 | ((offset) & (~((chan)->alloc_size-1))) |
| 44 | #define BUFFER_OFFSET(offset, chan) ((offset) & ((chan)->alloc_size - 1)) |
| 45 | #define SUBBUF_OFFSET(offset, chan) ((offset) & ((chan)->subbuf_size - 1)) |
| 46 | #define SUBBUF_ALIGN(offset, chan) \ |
| 47 | (((offset) + (chan)->subbuf_size) & (~((chan)->subbuf_size - 1))) |
| 48 | #define SUBBUF_TRUNC(offset, chan) \ |
| 49 | ((offset) & (~((chan)->subbuf_size - 1))) |
| 50 | #define SUBBUF_INDEX(offset, chan) \ |
| 51 | (BUFFER_OFFSET((offset), chan) >> (chan)->subbuf_size_order) |
| 52 | |
| 53 | /* |
| 54 | * Tracks changes to rchan/rchan_buf structs |
| 55 | */ |
| 56 | #define UST_CHANNEL_VERSION 8 |
| 57 | |
| 58 | /**************************************/ |
| 59 | |
| 60 | struct commit_counters { |
| 61 | long cc; /* ATOMIC */ |
| 62 | long cc_sb; /* ATOMIC - Incremented _once_ at sb switch */ |
| 63 | }; |
| 64 | |
| 65 | struct ust_buffer { |
| 66 | /* First 32 bytes cache-hot cacheline */ |
| 67 | long offset; /* Current offset in the buffer *atomic* */ |
| 68 | struct commit_counters *commit_count; /* Commit count per sub-buffer */ |
| 69 | long consumed; /* Current offset in the buffer *atomic* access (shared) */ |
| 70 | unsigned long last_tsc; /* |
| 71 | * Last timestamp written in the buffer. |
| 72 | */ |
| 73 | /* End of first 32 bytes cacheline */ |
| 74 | long active_readers; /* ATOMIC - Active readers count standard atomic access (shared) */ |
| 75 | long events_lost; /* ATOMIC */ |
| 76 | long corrupted_subbuffers; /* *ATOMIC* */ |
| 77 | /* one byte is written to this pipe when data is available, in order |
| 78 | to wake the consumer */ |
| 79 | /* portability: Single byte writes must be as quick as possible. The kernel-side |
| 80 | buffer must be large enough so the writer doesn't block. From the pipe(7) |
| 81 | man page: Since linux 2.6.11, the pipe capacity is 65536 bytes. */ |
| 82 | int data_ready_fd_write; |
| 83 | /* the reading end of the pipe */ |
| 84 | int data_ready_fd_read; |
| 85 | |
| 86 | unsigned int finalized; |
| 87 | //ust// struct timer_list switch_timer; /* timer for periodical switch */ |
| 88 | unsigned long switch_timer_interval; /* 0 = unset */ |
| 89 | |
| 90 | struct ust_channel *chan; |
| 91 | |
| 92 | struct kref kref; |
| 93 | void *buf_data; |
| 94 | size_t buf_size; |
| 95 | int shmid; |
| 96 | unsigned int cpu; |
| 97 | |
| 98 | /* commit count per subbuffer; must be at end of struct */ |
| 99 | long commit_seq[0] ____cacheline_aligned; /* ATOMIC */ |
| 100 | } ____cacheline_aligned; |
| 101 | |
| 102 | /* |
| 103 | * A switch is done during tracing or as a final flush after tracing (so it |
| 104 | * won't write in the new sub-buffer). |
| 105 | * FIXME: make this message clearer |
| 106 | */ |
| 107 | enum force_switch_mode { FORCE_ACTIVE, FORCE_FLUSH }; |
| 108 | |
| 109 | extern int ltt_reserve_slot_lockless_slow(struct ust_channel *chan, |
| 110 | struct ust_trace *trace, size_t data_size, |
| 111 | int largest_align, int cpu, |
| 112 | struct ust_buffer **ret_buf, |
| 113 | size_t *slot_size, long *buf_offset, |
| 114 | u64 *tsc, unsigned int *rflags); |
| 115 | |
| 116 | extern void ltt_force_switch_lockless_slow(struct ust_buffer *buf, |
| 117 | enum force_switch_mode mode); |
| 118 | |
| 119 | |
| 120 | static __inline__ void ust_buffers_do_copy(void *dest, const void *src, size_t len) |
| 121 | { |
| 122 | union { |
| 123 | const void *src; |
| 124 | const u8 *src8; |
| 125 | const u16 *src16; |
| 126 | const u32 *src32; |
| 127 | const u64 *src64; |
| 128 | } u = { .src = src }; |
| 129 | |
| 130 | switch (len) { |
| 131 | case 0: break; |
| 132 | case 1: *(u8 *)dest = *u.src8; |
| 133 | break; |
| 134 | case 2: *(u16 *)dest = *u.src16; |
| 135 | break; |
| 136 | case 4: *(u32 *)dest = *u.src32; |
| 137 | break; |
| 138 | case 8: *(u64 *)dest = *u.src64; |
| 139 | break; |
| 140 | default: |
| 141 | memcpy(dest, src, len); |
| 142 | } |
| 143 | } |
| 144 | |
| 145 | static __inline__ void *ust_buffers_offset_address(struct ust_buffer *buf, size_t offset) |
| 146 | { |
| 147 | return ((char *)buf->buf_data)+offset; |
| 148 | } |
| 149 | |
| 150 | /* |
| 151 | * Last TSC comparison functions. Check if the current TSC overflows |
| 152 | * LTT_TSC_BITS bits from the last TSC read. Reads and writes last_tsc |
| 153 | * atomically. |
| 154 | */ |
| 155 | |
| 156 | /* FIXME: does this test work properly? */ |
| 157 | #if (BITS_PER_LONG == 32) |
| 158 | static __inline__ void save_last_tsc(struct ust_buffer *ltt_buf, |
| 159 | u64 tsc) |
| 160 | { |
| 161 | ltt_buf->last_tsc = (unsigned long)(tsc >> LTT_TSC_BITS); |
| 162 | } |
| 163 | |
| 164 | static __inline__ int last_tsc_overflow(struct ust_buffer *ltt_buf, |
| 165 | u64 tsc) |
| 166 | { |
| 167 | unsigned long tsc_shifted = (unsigned long)(tsc >> LTT_TSC_BITS); |
| 168 | |
| 169 | if (unlikely((tsc_shifted - ltt_buf->last_tsc))) |
| 170 | return 1; |
| 171 | else |
| 172 | return 0; |
| 173 | } |
| 174 | #else |
| 175 | static __inline__ void save_last_tsc(struct ust_buffer *ltt_buf, |
| 176 | u64 tsc) |
| 177 | { |
| 178 | ltt_buf->last_tsc = (unsigned long)tsc; |
| 179 | } |
| 180 | |
| 181 | static __inline__ int last_tsc_overflow(struct ust_buffer *ltt_buf, |
| 182 | u64 tsc) |
| 183 | { |
| 184 | if (unlikely((tsc - ltt_buf->last_tsc) >> LTT_TSC_BITS)) |
| 185 | return 1; |
| 186 | else |
| 187 | return 0; |
| 188 | } |
| 189 | #endif |
| 190 | |
| 191 | static __inline__ void ltt_reserve_push_reader( |
| 192 | struct ust_channel *rchan, |
| 193 | struct ust_buffer *buf, |
| 194 | long offset) |
| 195 | { |
| 196 | long consumed_old, consumed_new; |
| 197 | |
| 198 | do { |
| 199 | consumed_old = uatomic_read(&buf->consumed); |
| 200 | /* |
| 201 | * If buffer is in overwrite mode, push the reader consumed |
| 202 | * count if the write position has reached it and we are not |
| 203 | * at the first iteration (don't push the reader farther than |
| 204 | * the writer). This operation can be done concurrently by many |
| 205 | * writers in the same buffer, the writer being at the farthest |
| 206 | * write position sub-buffer index in the buffer being the one |
| 207 | * which will win this loop. |
| 208 | * If the buffer is not in overwrite mode, pushing the reader |
| 209 | * only happens if a sub-buffer is corrupted. |
| 210 | */ |
| 211 | if (unlikely((SUBBUF_TRUNC(offset, buf->chan) |
| 212 | - SUBBUF_TRUNC(consumed_old, buf->chan)) |
| 213 | >= rchan->alloc_size)) |
| 214 | consumed_new = SUBBUF_ALIGN(consumed_old, buf->chan); |
| 215 | else |
| 216 | return; |
| 217 | } while (unlikely(uatomic_cmpxchg(&buf->consumed, consumed_old, |
| 218 | consumed_new) != consumed_old)); |
| 219 | } |
| 220 | |
| 221 | static __inline__ void ltt_vmcore_check_deliver( |
| 222 | struct ust_buffer *buf, |
| 223 | long commit_count, long idx) |
| 224 | { |
| 225 | uatomic_set(&buf->commit_seq[idx], commit_count); |
| 226 | } |
| 227 | |
| 228 | static __inline__ void ltt_check_deliver(struct ust_channel *chan, |
| 229 | struct ust_buffer *buf, |
| 230 | long offset, long commit_count, long idx) |
| 231 | { |
| 232 | long old_commit_count = commit_count - chan->subbuf_size; |
| 233 | |
| 234 | /* Check if all commits have been done */ |
| 235 | if (unlikely((BUFFER_TRUNC(offset, chan) |
| 236 | >> chan->n_subbufs_order) |
| 237 | - (old_commit_count |
| 238 | & chan->commit_count_mask) == 0)) { |
| 239 | /* |
| 240 | * If we succeeded in updating the cc_sb, we are delivering |
| 241 | * the subbuffer. Deals with concurrent updates of the "cc" |
| 242 | * value without adding a add_return atomic operation to the |
| 243 | * fast path. |
| 244 | */ |
| 245 | if (likely(uatomic_cmpxchg(&buf->commit_count[idx].cc_sb, |
| 246 | old_commit_count, commit_count) |
| 247 | == old_commit_count)) { |
| 248 | int result; |
| 249 | |
| 250 | /* |
| 251 | * Set noref flag for this subbuffer. |
| 252 | */ |
| 253 | //ust// ltt_set_noref_flag(rchan, buf, idx); |
| 254 | ltt_vmcore_check_deliver(buf, commit_count, idx); |
| 255 | |
| 256 | /* wakeup consumer */ |
| 257 | result = write(buf->data_ready_fd_write, "1", 1); |
| 258 | if(result == -1) { |
| 259 | PERROR("write (in ltt_relay_buffer_flush)"); |
| 260 | ERR("this should never happen!"); |
| 261 | } |
| 262 | } |
| 263 | } |
| 264 | } |
| 265 | |
| 266 | static __inline__ int ltt_poll_deliver(struct ust_channel *chan, struct ust_buffer *buf) |
| 267 | { |
| 268 | long consumed_old, consumed_idx, commit_count, write_offset; |
| 269 | |
| 270 | consumed_old = uatomic_read(&buf->consumed); |
| 271 | consumed_idx = SUBBUF_INDEX(consumed_old, buf->chan); |
| 272 | commit_count = uatomic_read(&buf->commit_count[consumed_idx].cc_sb); |
| 273 | /* |
| 274 | * No memory barrier here, since we are only interested |
| 275 | * in a statistically correct polling result. The next poll will |
| 276 | * get the data is we are racing. The mb() that ensures correct |
| 277 | * memory order is in get_subbuf. |
| 278 | */ |
| 279 | write_offset = uatomic_read(&buf->offset); |
| 280 | |
| 281 | /* |
| 282 | * Check that the subbuffer we are trying to consume has been |
| 283 | * already fully committed. |
| 284 | */ |
| 285 | |
| 286 | if (((commit_count - chan->subbuf_size) |
| 287 | & chan->commit_count_mask) |
| 288 | - (BUFFER_TRUNC(consumed_old, buf->chan) |
| 289 | >> chan->n_subbufs_order) |
| 290 | != 0) |
| 291 | return 0; |
| 292 | |
| 293 | /* |
| 294 | * Check that we are not about to read the same subbuffer in |
| 295 | * which the writer head is. |
| 296 | */ |
| 297 | if ((SUBBUF_TRUNC(write_offset, buf->chan) |
| 298 | - SUBBUF_TRUNC(consumed_old, buf->chan)) |
| 299 | == 0) |
| 300 | return 0; |
| 301 | |
| 302 | return 1; |
| 303 | |
| 304 | } |
| 305 | |
| 306 | /* |
| 307 | * returns 0 if reserve ok, or 1 if the slow path must be taken. |
| 308 | */ |
| 309 | static __inline__ int ltt_relay_try_reserve( |
| 310 | struct ust_channel *chan, |
| 311 | struct ust_buffer *buf, |
| 312 | size_t data_size, |
| 313 | u64 *tsc, unsigned int *rflags, int largest_align, |
| 314 | long *o_begin, long *o_end, long *o_old, |
| 315 | size_t *before_hdr_pad, size_t *size) |
| 316 | { |
| 317 | *o_begin = uatomic_read(&buf->offset); |
| 318 | *o_old = *o_begin; |
| 319 | |
| 320 | *tsc = trace_clock_read64(); |
| 321 | |
| 322 | //ust// #ifdef CONFIG_LTT_VMCORE |
| 323 | //ust// prefetch(&buf->commit_count[SUBBUF_INDEX(*o_begin, rchan)]); |
| 324 | //ust// prefetch(&buf->commit_seq[SUBBUF_INDEX(*o_begin, rchan)]); |
| 325 | //ust// #else |
| 326 | //ust// prefetchw(&buf->commit_count[SUBBUF_INDEX(*o_begin, rchan)]); |
| 327 | //ust// #endif |
| 328 | if (last_tsc_overflow(buf, *tsc)) |
| 329 | *rflags = LTT_RFLAG_ID_SIZE_TSC; |
| 330 | |
| 331 | if (unlikely(SUBBUF_OFFSET(*o_begin, buf->chan) == 0)) |
| 332 | return 1; |
| 333 | |
| 334 | *size = ust_get_header_size(chan, |
| 335 | *o_begin, data_size, |
| 336 | before_hdr_pad, *rflags); |
| 337 | *size += ltt_align(*o_begin + *size, largest_align) + data_size; |
| 338 | if (unlikely((SUBBUF_OFFSET(*o_begin, buf->chan) + *size) |
| 339 | > buf->chan->subbuf_size)) |
| 340 | return 1; |
| 341 | |
| 342 | /* |
| 343 | * Event fits in the current buffer and we are not on a switch |
| 344 | * boundary. It's safe to write. |
| 345 | */ |
| 346 | *o_end = *o_begin + *size; |
| 347 | |
| 348 | if (unlikely((SUBBUF_OFFSET(*o_end, buf->chan)) == 0)) |
| 349 | /* |
| 350 | * The offset_end will fall at the very beginning of the next |
| 351 | * subbuffer. |
| 352 | */ |
| 353 | return 1; |
| 354 | |
| 355 | return 0; |
| 356 | } |
| 357 | |
| 358 | static __inline__ int ltt_reserve_slot(struct ust_channel *chan, |
| 359 | struct ust_trace *trace, size_t data_size, |
| 360 | int largest_align, int cpu, |
| 361 | struct ust_buffer **ret_buf, |
| 362 | size_t *slot_size, long *buf_offset, u64 *tsc, |
| 363 | unsigned int *rflags) |
| 364 | { |
| 365 | struct ust_buffer *buf = *ret_buf = chan->buf[cpu]; |
| 366 | long o_begin, o_end, o_old; |
| 367 | size_t before_hdr_pad; |
| 368 | |
| 369 | /* |
| 370 | * Perform retryable operations. |
| 371 | */ |
| 372 | /* FIXME: make this really per cpu? */ |
| 373 | if (unlikely(LOAD_SHARED(ltt_nesting) > 4)) { |
| 374 | DBG("Dropping event because nesting is too deep."); |
| 375 | uatomic_inc(&buf->events_lost); |
| 376 | return -EPERM; |
| 377 | } |
| 378 | |
| 379 | if (unlikely(ltt_relay_try_reserve(chan, buf, |
| 380 | data_size, tsc, rflags, |
| 381 | largest_align, &o_begin, &o_end, &o_old, |
| 382 | &before_hdr_pad, slot_size))) |
| 383 | goto slow_path; |
| 384 | |
| 385 | if (unlikely(uatomic_cmpxchg(&buf->offset, o_old, o_end) != o_old)) |
| 386 | goto slow_path; |
| 387 | |
| 388 | /* |
| 389 | * Atomically update last_tsc. This update races against concurrent |
| 390 | * atomic updates, but the race will always cause supplementary full TSC |
| 391 | * events, never the opposite (missing a full TSC event when it would be |
| 392 | * needed). |
| 393 | */ |
| 394 | save_last_tsc(buf, *tsc); |
| 395 | |
| 396 | /* |
| 397 | * Push the reader if necessary |
| 398 | */ |
| 399 | ltt_reserve_push_reader(chan, buf, o_end - 1); |
| 400 | |
| 401 | /* |
| 402 | * Clear noref flag for this subbuffer. |
| 403 | */ |
| 404 | //ust// ltt_clear_noref_flag(chan, buf, SUBBUF_INDEX(o_end - 1, chan)); |
| 405 | |
| 406 | *buf_offset = o_begin + before_hdr_pad; |
| 407 | return 0; |
| 408 | slow_path: |
| 409 | return ltt_reserve_slot_lockless_slow(chan, trace, data_size, |
| 410 | largest_align, cpu, ret_buf, |
| 411 | slot_size, buf_offset, tsc, |
| 412 | rflags); |
| 413 | } |
| 414 | |
| 415 | /* |
| 416 | * Force a sub-buffer switch for a per-cpu buffer. This operation is |
| 417 | * completely reentrant : can be called while tracing is active with |
| 418 | * absolutely no lock held. |
| 419 | */ |
| 420 | static __inline__ void ltt_force_switch(struct ust_buffer *buf, |
| 421 | enum force_switch_mode mode) |
| 422 | { |
| 423 | return ltt_force_switch_lockless_slow(buf, mode); |
| 424 | } |
| 425 | |
| 426 | /* |
| 427 | * for flight recording. must be called after relay_commit. |
| 428 | * This function increments the subbuffers's commit_seq counter each time the |
| 429 | * commit count reaches back the reserve offset (module subbuffer size). It is |
| 430 | * useful for crash dump. |
| 431 | */ |
| 432 | //ust// #ifdef CONFIG_LTT_VMCORE |
| 433 | static __inline__ void ltt_write_commit_counter(struct ust_channel *chan, |
| 434 | struct ust_buffer *buf, long idx, long buf_offset, |
| 435 | long commit_count, size_t data_size) |
| 436 | { |
| 437 | long offset; |
| 438 | long commit_seq_old; |
| 439 | |
| 440 | offset = buf_offset + data_size; |
| 441 | |
| 442 | /* |
| 443 | * SUBBUF_OFFSET includes commit_count_mask. We can simply |
| 444 | * compare the offsets within the subbuffer without caring about |
| 445 | * buffer full/empty mismatch because offset is never zero here |
| 446 | * (subbuffer header and event headers have non-zero length). |
| 447 | */ |
| 448 | if (unlikely(SUBBUF_OFFSET(offset - commit_count, buf->chan))) |
| 449 | return; |
| 450 | |
| 451 | commit_seq_old = uatomic_read(&buf->commit_seq[idx]); |
| 452 | while (commit_seq_old < commit_count) |
| 453 | commit_seq_old = uatomic_cmpxchg(&buf->commit_seq[idx], |
| 454 | commit_seq_old, commit_count); |
| 455 | |
| 456 | DBG("commit_seq for channel %s_%d, subbuf %ld is now %ld", buf->chan->channel_name, buf->cpu, idx, commit_count); |
| 457 | } |
| 458 | //ust// #else |
| 459 | //ust// static __inline__ void ltt_write_commit_counter(struct ust_buffer *buf, |
| 460 | //ust// long idx, long buf_offset, long commit_count, size_t data_size) |
| 461 | //ust// { |
| 462 | //ust// } |
| 463 | //ust// #endif |
| 464 | |
| 465 | /* |
| 466 | * Atomic unordered slot commit. Increments the commit count in the |
| 467 | * specified sub-buffer, and delivers it if necessary. |
| 468 | * |
| 469 | * Parameters: |
| 470 | * |
| 471 | * @ltt_channel : channel structure |
| 472 | * @transport_data: transport-specific data |
| 473 | * @buf_offset : offset following the event header. |
| 474 | * @data_size : size of the event data. |
| 475 | * @slot_size : size of the reserved slot. |
| 476 | */ |
| 477 | static __inline__ void ltt_commit_slot( |
| 478 | struct ust_channel *chan, |
| 479 | struct ust_buffer *buf, long buf_offset, |
| 480 | size_t data_size, size_t slot_size) |
| 481 | { |
| 482 | long offset_end = buf_offset; |
| 483 | long endidx = SUBBUF_INDEX(offset_end - 1, chan); |
| 484 | long commit_count; |
| 485 | |
| 486 | smp_wmb(); |
| 487 | |
| 488 | uatomic_add(&buf->commit_count[endidx].cc, slot_size); |
| 489 | /* |
| 490 | * commit count read can race with concurrent OOO commit count updates. |
| 491 | * This is only needed for ltt_check_deliver (for non-polling delivery |
| 492 | * only) and for ltt_write_commit_counter. The race can only cause the |
| 493 | * counter to be read with the same value more than once, which could |
| 494 | * cause : |
| 495 | * - Multiple delivery for the same sub-buffer (which is handled |
| 496 | * gracefully by the reader code) if the value is for a full |
| 497 | * sub-buffer. It's important that we can never miss a sub-buffer |
| 498 | * delivery. Re-reading the value after the uatomic_add ensures this. |
| 499 | * - Reading a commit_count with a higher value that what was actually |
| 500 | * added to it for the ltt_write_commit_counter call (again caused by |
| 501 | * a concurrent committer). It does not matter, because this function |
| 502 | * is interested in the fact that the commit count reaches back the |
| 503 | * reserve offset for a specific sub-buffer, which is completely |
| 504 | * independent of the order. |
| 505 | */ |
| 506 | commit_count = uatomic_read(&buf->commit_count[endidx].cc); |
| 507 | |
| 508 | ltt_check_deliver(chan, buf, offset_end - 1, commit_count, endidx); |
| 509 | /* |
| 510 | * Update data_size for each commit. It's needed only for extracting |
| 511 | * ltt buffers from vmcore, after crash. |
| 512 | */ |
| 513 | ltt_write_commit_counter(chan, buf, endidx, buf_offset, commit_count, data_size); |
| 514 | } |
| 515 | |
| 516 | void _ust_buffers_strncpy_fixup(struct ust_buffer *buf, size_t offset, |
| 517 | size_t len, size_t copied, int terminated); |
| 518 | |
| 519 | static __inline__ int ust_buffers_write(struct ust_buffer *buf, size_t offset, |
| 520 | const void *src, size_t len) |
| 521 | { |
| 522 | size_t buf_offset = BUFFER_OFFSET(offset, buf->chan); |
| 523 | |
| 524 | assert(buf_offset < buf->chan->subbuf_size*buf->chan->subbuf_cnt); |
| 525 | assert(buf_offset + len < buf->chan->subbuf_size*buf->chan->subbuf_cnt); |
| 526 | |
| 527 | ust_buffers_do_copy(buf->buf_data + buf_offset, src, len); |
| 528 | |
| 529 | return len; |
| 530 | } |
| 531 | |
| 532 | /* |
| 533 | * ust_buffers_do_memset - write character into dest. |
| 534 | * @dest: destination |
| 535 | * @src: source character |
| 536 | * @len: length to write |
| 537 | */ |
| 538 | static __inline__ |
| 539 | void ust_buffers_do_memset(void *dest, char src, size_t len) |
| 540 | { |
| 541 | /* |
| 542 | * What we really want here is an __inline__ memset, but we |
| 543 | * don't have constants, so gcc generally uses a function call. |
| 544 | */ |
| 545 | for (; len > 0; len--) |
| 546 | *(u8 *)dest++ = src; |
| 547 | } |
| 548 | |
| 549 | /* |
| 550 | * ust_buffers_do_strncpy - copy a string up to a certain number of bytes |
| 551 | * @dest: destination |
| 552 | * @src: source |
| 553 | * @len: max. length to copy |
| 554 | * @terminated: output string ends with \0 (output) |
| 555 | * |
| 556 | * returns the number of bytes copied. Does not finalize with \0 if len is |
| 557 | * reached. |
| 558 | */ |
| 559 | static __inline__ |
| 560 | size_t ust_buffers_do_strncpy(void *dest, const void *src, size_t len, |
| 561 | int *terminated) |
| 562 | { |
| 563 | size_t orig_len = len; |
| 564 | |
| 565 | *terminated = 0; |
| 566 | /* |
| 567 | * What we really want here is an __inline__ strncpy, but we |
| 568 | * don't have constants, so gcc generally uses a function call. |
| 569 | */ |
| 570 | for (; len > 0; len--) { |
| 571 | *(u8 *)dest = LOAD_SHARED(*(const u8 *)src); |
| 572 | /* Check with dest, because src may be modified concurrently */ |
| 573 | if (*(const u8 *)dest == '\0') { |
| 574 | len--; |
| 575 | *terminated = 1; |
| 576 | break; |
| 577 | } |
| 578 | dest++; |
| 579 | src++; |
| 580 | } |
| 581 | return orig_len - len; |
| 582 | } |
| 583 | |
| 584 | static __inline__ |
| 585 | int ust_buffers_strncpy(struct ust_buffer *buf, size_t offset, const void *src, |
| 586 | size_t len) |
| 587 | { |
| 588 | size_t buf_offset = BUFFER_OFFSET(offset, buf->chan); |
| 589 | ssize_t copied; |
| 590 | int terminated; |
| 591 | |
| 592 | assert(buf_offset < buf->chan->subbuf_size*buf->chan->subbuf_cnt); |
| 593 | assert(buf_offset + len < buf->chan->subbuf_size*buf->chan->subbuf_cnt); |
| 594 | |
| 595 | copied = ust_buffers_do_strncpy(buf->buf_data + buf_offset, |
| 596 | src, len, &terminated); |
| 597 | if (unlikely(copied < len || !terminated)) |
| 598 | _ust_buffers_strncpy_fixup(buf, offset, len, copied, |
| 599 | terminated); |
| 600 | return len; |
| 601 | } |
| 602 | |
| 603 | extern int ust_buffers_get_subbuf(struct ust_buffer *buf, long *consumed); |
| 604 | extern int ust_buffers_put_subbuf(struct ust_buffer *buf, unsigned long uconsumed_old); |
| 605 | |
| 606 | extern void init_ustrelay_transport(void); |
| 607 | |
| 608 | #endif /* _UST_BUFFERS_H */ |