Use macros for .bss.page_aligned section.
[safe/jmp/linux-2.6] / arch / x86 / kernel / ds.c
index 96768e9..ef42a03 100644 (file)
@@ -6,44 +6,74 @@
  * precise-event based sampling (PEBS).
  *
  * It manages:
- * - per-thread and per-cpu allocation of BTS and PEBS
- * - buffer memory allocation (optional)
- * - buffer overflow handling
+ * - DS and BTS hardware configuration
+ * - buffer overflow handling (to be done)
  * - buffer access
  *
- * It assumes:
- * - get_task_struct on all parameter tasks
- * - current is allowed to trace parameter tasks
+ * It does not do:
+ * - security checking (is the caller allowed to trace the task)
+ * - buffer allocation (memory accounting)
  *
  *
- * Copyright (C) 2007-2008 Intel Corporation.
- * Markus Metzger <markus.t.metzger@intel.com>, 2007-2008
+ * Copyright (C) 2007-2009 Intel Corporation.
+ * Markus Metzger <markus.t.metzger@intel.com>, 2007-2009
  */
 
-
-#include <asm/ds.h>
-
-#include <linux/errno.h>
+#include <linux/kernel.h>
 #include <linux/string.h>
-#include <linux/slab.h>
+#include <linux/errno.h>
 #include <linux/sched.h>
+#include <linux/slab.h>
 #include <linux/mm.h>
-#include <linux/kernel.h>
+#include <linux/trace_clock.h>
+
+#include <asm/ds.h>
 
+#include "ds_selftest.h"
 
 /*
- * The configuration for a particular DS hardware implementation.
+ * The configuration for a particular DS hardware implementation:
  */
 struct ds_configuration {
-       /* the size of the DS structure in bytes */
-       unsigned char  sizeof_ds;
-       /* the size of one pointer-typed field in the DS structure in bytes;
-          this covers the first 8 fields related to buffer management. */
-       unsigned char  sizeof_field;
-       /* the size of a BTS/PEBS record in bytes */
-       unsigned char  sizeof_rec[2];
+       /* The name of the configuration: */
+       const char              *name;
+
+       /* The size of pointer-typed fields in DS, BTS, and PEBS: */
+       unsigned char           sizeof_ptr_field;
+
+       /* The size of a BTS/PEBS record in bytes: */
+       unsigned char           sizeof_rec[2];
+
+       /* The number of pebs counter reset values in the DS structure. */
+       unsigned char           nr_counter_reset;
+
+       /* Control bit-masks indexed by enum ds_feature: */
+       unsigned long           ctl[dsf_ctl_max];
 };
-static struct ds_configuration ds_cfg;
+static struct ds_configuration ds_cfg __read_mostly;
+
+
+/* Maximal size of a DS configuration: */
+#define MAX_SIZEOF_DS          0x80
+
+/* Maximal size of a BTS record: */
+#define MAX_SIZEOF_BTS         (3 * 8)
+
+/* BTS and PEBS buffer alignment: */
+#define DS_ALIGNMENT           (1 << 3)
+
+/* Number of buffer pointers in DS: */
+#define NUM_DS_PTR_FIELDS      8
+
+/* Size of a pebs reset value in DS: */
+#define PEBS_RESET_FIELD_SIZE  8
+
+/* Mask of control bits in the DS MSR register: */
+#define BTS_CONTROL                              \
+       ( ds_cfg.ctl[dsf_bts]                   | \
+         ds_cfg.ctl[dsf_bts_kernel]            | \
+         ds_cfg.ctl[dsf_bts_user]              | \
+         ds_cfg.ctl[dsf_bts_overflow] )
 
 /*
  * A BTS or PEBS tracer.
@@ -52,27 +82,36 @@ static struct ds_configuration ds_cfg;
  * to identify tracers.
  */
 struct ds_tracer {
-       /* the DS context (partially) owned by this tracer */
-       struct ds_context *context;
-       /* the buffer provided on ds_request() and its size in bytes */
-       void *buffer;
-       size_t size;
-       /* the number of allocated pages for on-request allocated buffers */
-       unsigned int pages;
+       /* The DS context (partially) owned by this tracer. */
+       struct ds_context       *context;
+       /* The buffer provided on ds_request() and its size in bytes. */
+       void                    *buffer;
+       size_t                  size;
 };
 
 struct bts_tracer {
-       /* the common DS part */
-       struct ds_tracer ds;
-       /* buffer overflow notification function */
-       bts_ovfl_callback_t ovfl;
+       /* The common DS part: */
+       struct ds_tracer        ds;
+
+       /* The trace including the DS configuration: */
+       struct bts_trace        trace;
+
+       /* Buffer overflow notification function: */
+       bts_ovfl_callback_t     ovfl;
+
+       /* Active flags affecting trace collection. */
+       unsigned int            flags;
 };
 
 struct pebs_tracer {
-       /* the common DS part */
-       struct ds_tracer ds;
-       /* buffer overflow notification function */
-       pebs_ovfl_callback_t ovfl;
+       /* The common DS part: */
+       struct ds_tracer        ds;
+
+       /* The trace including the DS configuration: */
+       struct pebs_trace       trace;
+
+       /* Buffer overflow notification function: */
+       pebs_ovfl_callback_t    ovfl;
 };
 
 /*
@@ -81,6 +120,7 @@ struct pebs_tracer {
  *
  * The DS configuration consists of the following fields; different
  * architetures vary in the size of those fields.
+ *
  * - double-word aligned base linear address of the BTS buffer
  * - write pointer into the BTS buffer
  * - end linear address of the BTS buffer (one byte beyond the end of
@@ -119,33 +159,30 @@ enum ds_field {
 };
 
 enum ds_qualifier {
-       ds_bts  = 0,
+       ds_bts = 0,
        ds_pebs
 };
 
-static inline unsigned long ds_get(const unsigned char *base,
-                                  enum ds_qualifier qual, enum ds_field field)
+static inline unsigned long
+ds_get(const unsigned char *base, enum ds_qualifier qual, enum ds_field field)
 {
-       base += (ds_cfg.sizeof_field * (field + (4 * qual)));
+       base += (ds_cfg.sizeof_ptr_field * (field + (4 * qual)));
        return *(unsigned long *)base;
 }
 
-static inline void ds_set(unsigned char *base, enum ds_qualifier qual,
-                         enum ds_field field, unsigned long value)
+static inline void
+ds_set(unsigned char *base, enum ds_qualifier qual, enum ds_field field,
+       unsigned long value)
 {
-       base += (ds_cfg.sizeof_field * (field + (4 * qual)));
+       base += (ds_cfg.sizeof_ptr_field * (field + (4 * qual)));
        (*(unsigned long *)base) = value;
 }
 
-#define DS_ALIGNMENT (1 << 3)  /* BTS and PEBS buffer alignment */
-
 
 /*
- * Locking is done only for allocating BTS or PEBS resources and for
- * guarding context and buffer memory allocation.
+ * Locking is done only for allocating BTS or PEBS resources.
  */
-static spinlock_t ds_lock = __SPIN_LOCK_UNLOCKED(ds_lock);
-
+static DEFINE_SPINLOCK(ds_lock);
 
 /*
  * We either support (system-wide) per-cpu or per-thread allocation.
@@ -160,30 +197,43 @@ static spinlock_t ds_lock = __SPIN_LOCK_UNLOCKED(ds_lock);
  *   >0  number of per-thread tracers
  *   <0  number of per-cpu tracers
  *
- * The below functions to get and put tracers and to check the
- * allocation type require the ds_lock to be held by the caller.
- *
  * Tracers essentially gives the number of ds contexts for a certain
  * type of allocation.
  */
-static long tracers;
+static atomic_t tracers = ATOMIC_INIT(0);
 
-static inline void get_tracer(struct task_struct *task)
+static inline int get_tracer(struct task_struct *task)
 {
-       tracers += (task ? 1 : -1);
-}
+       int error;
 
-static inline void put_tracer(struct task_struct *task)
-{
-       tracers -= (task ? 1 : -1);
+       spin_lock_irq(&ds_lock);
+
+       if (task) {
+               error = -EPERM;
+               if (atomic_read(&tracers) < 0)
+                       goto out;
+               atomic_inc(&tracers);
+       } else {
+               error = -EPERM;
+               if (atomic_read(&tracers) > 0)
+                       goto out;
+               atomic_dec(&tracers);
+       }
+
+       error = 0;
+out:
+       spin_unlock_irq(&ds_lock);
+       return error;
 }
 
-static inline int check_tracer(struct task_struct *task)
+static inline void put_tracer(struct task_struct *task)
 {
-       return (task ? (tracers >= 0) : (tracers <= 0));
+       if (task)
+               atomic_dec(&tracers);
+       else
+               atomic_inc(&tracers);
 }
 
-
 /*
  * The DS context is either attached to a thread or to a cpu:
  * - in the former case, the thread_struct contains a pointer to the
@@ -194,51 +244,69 @@ static inline int check_tracer(struct task_struct *task)
  * Contexts are use-counted. They are allocated on first access and
  * deallocated when the last user puts the context.
  */
-static DEFINE_PER_CPU(struct ds_context *, system_context);
+struct ds_context {
+       /* The DS configuration; goes into MSR_IA32_DS_AREA: */
+       unsigned char           ds[MAX_SIZEOF_DS];
 
-#define this_system_context per_cpu(system_context, smp_processor_id())
+       /* The owner of the BTS and PEBS configuration, respectively: */
+       struct bts_tracer       *bts_master;
+       struct pebs_tracer      *pebs_master;
 
-static inline struct ds_context *ds_get_context(struct task_struct *task)
-{
-       struct ds_context **p_context =
-               (task ? &task->thread.ds_ctx : &this_system_context);
-       struct ds_context *context = *p_context;
-       unsigned long irq;
+       /* Use count: */
+       unsigned long           count;
+
+       /* Pointer to the context pointer field: */
+       struct ds_context       **this;
 
-       if (!context) {
-               context = kzalloc(sizeof(*context), GFP_KERNEL);
-               if (!context)
-                       return NULL;
+       /* The traced task; NULL for cpu tracing: */
+       struct task_struct      *task;
+
+       /* The traced cpu; only valid if task is NULL: */
+       int                     cpu;
+};
 
-               spin_lock_irqsave(&ds_lock, irq);
+static DEFINE_PER_CPU(struct ds_context *, cpu_context);
 
-               if (*p_context) {
-                       kfree(context);
 
-                       context = *p_context;
-               } else {
-                       *p_context = context;
+static struct ds_context *ds_get_context(struct task_struct *task, int cpu)
+{
+       struct ds_context **p_context =
+               (task ? &task->thread.ds_ctx : &per_cpu(cpu_context, cpu));
+       struct ds_context *context = NULL;
+       struct ds_context *new_context = NULL;
 
-                       context->this = p_context;
-                       context->task = task;
+       /* Chances are small that we already have a context. */
+       new_context = kzalloc(sizeof(*new_context), GFP_KERNEL);
+       if (!new_context)
+               return NULL;
 
-                       if (task)
-                               set_tsk_thread_flag(task, TIF_DS_AREA_MSR);
+       spin_lock_irq(&ds_lock);
 
-                       if (!task || (task == current))
-                               wrmsrl(MSR_IA32_DS_AREA,
-                                      (unsigned long)context->ds);
-               }
-               spin_unlock_irqrestore(&ds_lock, irq);
+       context = *p_context;
+       if (likely(!context)) {
+               context = new_context;
+
+               context->this = p_context;
+               context->task = task;
+               context->cpu = cpu;
+               context->count = 0;
+
+               *p_context = context;
        }
 
        context->count++;
 
+       spin_unlock_irq(&ds_lock);
+
+       if (context != new_context)
+               kfree(new_context);
+
        return context;
 }
 
-static inline void ds_put_context(struct ds_context *context)
+static void ds_put_context(struct ds_context *context)
 {
+       struct task_struct *task;
        unsigned long irq;
 
        if (!context)
@@ -246,25 +314,65 @@ static inline void ds_put_context(struct ds_context *context)
 
        spin_lock_irqsave(&ds_lock, irq);
 
-       if (--context->count)
-               goto out;
+       if (--context->count) {
+               spin_unlock_irqrestore(&ds_lock, irq);
+               return;
+       }
 
        *(context->this) = NULL;
 
-       if (context->task)
-               clear_tsk_thread_flag(context->task, TIF_DS_AREA_MSR);
+       task = context->task;
 
-       if (!context->task || (context->task == current))
-               wrmsrl(MSR_IA32_DS_AREA, 0);
+       if (task)
+               clear_tsk_thread_flag(task, TIF_DS_AREA_MSR);
+
+       /*
+        * We leave the (now dangling) pointer to the DS configuration in
+        * the DS_AREA msr. This is as good or as bad as replacing it with
+        * NULL - the hardware would crash if we enabled tracing.
+        *
+        * This saves us some problems with having to write an msr on a
+        * different cpu while preventing others from doing the same for the
+        * next context for that same cpu.
+        */
 
-       kfree(context);
- out:
        spin_unlock_irqrestore(&ds_lock, irq);
+
+       /* The context might still be in use for context switching. */
+       if (task && (task != current))
+               wait_task_context_switch(task);
+
+       kfree(context);
 }
 
+static void ds_install_ds_area(struct ds_context *context)
+{
+       unsigned long ds;
+
+       ds = (unsigned long)context->ds;
+
+       /*
+        * There is a race between the bts master and the pebs master.
+        *
+        * The thread/cpu access is synchronized via get/put_cpu() for
+        * task tracing and via wrmsr_on_cpu for cpu tracing.
+        *
+        * If bts and pebs are collected for the same task or same cpu,
+        * the same confiuration is written twice.
+        */
+       if (context->task) {
+               get_cpu();
+               if (context->task == current)
+                       wrmsrl(MSR_IA32_DS_AREA, ds);
+               set_tsk_thread_flag(context->task, TIF_DS_AREA_MSR);
+               put_cpu();
+       } else
+               wrmsr_on_cpu(context->cpu, MSR_IA32_DS_AREA,
+                            (u32)((u64)ds), (u32)((u64)ds >> 32));
+}
 
 /*
- * Handle a buffer overflow
+ * Call the tracer's callback on a buffer overflow.
  *
  * context: the ds context
  * qual: the buffer type
@@ -272,77 +380,253 @@ static inline void ds_put_context(struct ds_context *context)
 static void ds_overflow(struct ds_context *context, enum ds_qualifier qual)
 {
        switch (qual) {
-       case ds_bts: {
-               struct bts_tracer *tracer =
-                       container_of(context->owner[qual],
-                                    struct bts_tracer, ds);
-               if (tracer->ovfl)
-                       tracer->ovfl(tracer);
-       }
+       case ds_bts:
+               if (context->bts_master &&
+                   context->bts_master->ovfl)
+                       context->bts_master->ovfl(context->bts_master);
                break;
-       case ds_pebs: {
-               struct pebs_tracer *tracer =
-                       container_of(context->owner[qual],
-                                    struct pebs_tracer, ds);
-               if (tracer->ovfl)
-                       tracer->ovfl(tracer);
-       }
+       case ds_pebs:
+               if (context->pebs_master &&
+                   context->pebs_master->ovfl)
+                       context->pebs_master->ovfl(context->pebs_master);
                break;
        }
 }
 
 
 /*
- * Allocate a non-pageable buffer of the parameter size.
- * Checks the memory and the locked memory rlimit.
+ * Write raw data into the BTS or PEBS buffer.
  *
- * Returns the buffer, if successful;
- *         NULL, if out of memory or rlimit exceeded.
+ * The remainder of any partially written record is zeroed out.
  *
- * size: the requested buffer size in bytes
- * pages (out): if not NULL, contains the number of pages reserved
+ * context: the DS context
+ * qual:    the buffer type
+ * record:  the data to write
+ * size:    the size of the data
  */
-static inline void *ds_allocate_buffer(size_t size, unsigned int *pages)
+static int ds_write(struct ds_context *context, enum ds_qualifier qual,
+                   const void *record, size_t size)
 {
-       unsigned long rlim, vm, pgsz;
-       void *buffer = NULL;
+       int bytes_written = 0;
 
-       pgsz = PAGE_ALIGN(size) >> PAGE_SHIFT;
+       if (!record)
+               return -EINVAL;
 
-       down_write(&current->mm->mmap_sem);
+       while (size) {
+               unsigned long base, index, end, write_end, int_th;
+               unsigned long write_size, adj_write_size;
 
-       rlim = current->signal->rlim[RLIMIT_AS].rlim_cur >> PAGE_SHIFT;
-       vm   = current->mm->total_vm  + pgsz;
-       if (rlim < vm)
-               goto out;
+               /*
+                * Write as much as possible without producing an
+                * overflow interrupt.
+                *
+                * Interrupt_threshold must either be
+                * - bigger than absolute_maximum or
+                * - point to a record between buffer_base and absolute_maximum
+                *
+                * Index points to a valid record.
+                */
+               base   = ds_get(context->ds, qual, ds_buffer_base);
+               index  = ds_get(context->ds, qual, ds_index);
+               end    = ds_get(context->ds, qual, ds_absolute_maximum);
+               int_th = ds_get(context->ds, qual, ds_interrupt_threshold);
 
-       rlim = current->signal->rlim[RLIMIT_MEMLOCK].rlim_cur >> PAGE_SHIFT;
-       vm   = current->mm->locked_vm  + pgsz;
-       if (rlim < vm)
-               goto out;
+               write_end = min(end, int_th);
 
-       buffer = kzalloc(size, GFP_KERNEL);
-       if (!buffer)
-               goto out;
+               /*
+                * If we are already beyond the interrupt threshold,
+                * we fill the entire buffer.
+                */
+               if (write_end <= index)
+                       write_end = end;
 
-       current->mm->total_vm  += pgsz;
-       current->mm->locked_vm += pgsz;
+               if (write_end <= index)
+                       break;
 
-       if (pages)
-               *pages = pgsz;
+               write_size = min((unsigned long) size, write_end - index);
+               memcpy((void *)index, record, write_size);
 
- out:
-       up_write(&current->mm->mmap_sem);
-       return buffer;
+               record = (const char *)record + write_size;
+               size -= write_size;
+               bytes_written += write_size;
+
+               adj_write_size = write_size / ds_cfg.sizeof_rec[qual];
+               adj_write_size *= ds_cfg.sizeof_rec[qual];
+
+               /* Zero out trailing bytes. */
+               memset((char *)index + write_size, 0,
+                      adj_write_size - write_size);
+               index += adj_write_size;
+
+               if (index >= end)
+                       index = base;
+               ds_set(context->ds, qual, ds_index, index);
+
+               if (index >= int_th)
+                       ds_overflow(context, qual);
+       }
+
+       return bytes_written;
+}
+
+
+/*
+ * Branch Trace Store (BTS) uses the following format. Different
+ * architectures vary in the size of those fields.
+ * - source linear address
+ * - destination linear address
+ * - flags
+ *
+ * Later architectures use 64bit pointers throughout, whereas earlier
+ * architectures use 32bit pointers in 32bit mode.
+ *
+ * We compute the base address for the fields based on:
+ * - the field size stored in the DS configuration
+ * - the relative field position
+ *
+ * In order to store additional information in the BTS buffer, we use
+ * a special source address to indicate that the record requires
+ * special interpretation.
+ *
+ * Netburst indicated via a bit in the flags field whether the branch
+ * was predicted; this is ignored.
+ *
+ * We use two levels of abstraction:
+ * - the raw data level defined here
+ * - an arch-independent level defined in ds.h
+ */
+
+enum bts_field {
+       bts_from,
+       bts_to,
+       bts_flags,
+
+       bts_qual                = bts_from,
+       bts_clock               = bts_to,
+       bts_pid                 = bts_flags,
+
+       bts_qual_mask           = (bts_qual_max - 1),
+       bts_escape              = ((unsigned long)-1 & ~bts_qual_mask)
+};
+
+static inline unsigned long bts_get(const char *base, unsigned long field)
+{
+       base += (ds_cfg.sizeof_ptr_field * field);
+       return *(unsigned long *)base;
+}
+
+static inline void bts_set(char *base, unsigned long field, unsigned long val)
+{
+       base += (ds_cfg.sizeof_ptr_field * field);
+       (*(unsigned long *)base) = val;
 }
 
-static void ds_install_ds_config(struct ds_context *context,
-                                enum ds_qualifier qual,
-                                void *base, size_t size, size_t ith)
+
+/*
+ * The raw BTS data is architecture dependent.
+ *
+ * For higher-level users, we give an arch-independent view.
+ * - ds.h defines struct bts_struct
+ * - bts_read translates one raw bts record into a bts_struct
+ * - bts_write translates one bts_struct into the raw format and
+ *   writes it into the top of the parameter tracer's buffer.
+ *
+ * return: bytes read/written on success; -Eerrno, otherwise
+ */
+static int
+bts_read(struct bts_tracer *tracer, const void *at, struct bts_struct *out)
 {
+       if (!tracer)
+               return -EINVAL;
+
+       if (at < tracer->trace.ds.begin)
+               return -EINVAL;
+
+       if (tracer->trace.ds.end < (at + tracer->trace.ds.size))
+               return -EINVAL;
+
+       memset(out, 0, sizeof(*out));
+       if ((bts_get(at, bts_qual) & ~bts_qual_mask) == bts_escape) {
+               out->qualifier = (bts_get(at, bts_qual) & bts_qual_mask);
+               out->variant.event.clock = bts_get(at, bts_clock);
+               out->variant.event.pid = bts_get(at, bts_pid);
+       } else {
+               out->qualifier = bts_branch;
+               out->variant.lbr.from = bts_get(at, bts_from);
+               out->variant.lbr.to   = bts_get(at, bts_to);
+
+               if (!out->variant.lbr.from && !out->variant.lbr.to)
+                       out->qualifier = bts_invalid;
+       }
+
+       return ds_cfg.sizeof_rec[ds_bts];
+}
+
+static int bts_write(struct bts_tracer *tracer, const struct bts_struct *in)
+{
+       unsigned char raw[MAX_SIZEOF_BTS];
+
+       if (!tracer)
+               return -EINVAL;
+
+       if (MAX_SIZEOF_BTS < ds_cfg.sizeof_rec[ds_bts])
+               return -EOVERFLOW;
+
+       switch (in->qualifier) {
+       case bts_invalid:
+               bts_set(raw, bts_from, 0);
+               bts_set(raw, bts_to, 0);
+               bts_set(raw, bts_flags, 0);
+               break;
+       case bts_branch:
+               bts_set(raw, bts_from, in->variant.lbr.from);
+               bts_set(raw, bts_to,   in->variant.lbr.to);
+               bts_set(raw, bts_flags, 0);
+               break;
+       case bts_task_arrives:
+       case bts_task_departs:
+               bts_set(raw, bts_qual, (bts_escape | in->qualifier));
+               bts_set(raw, bts_clock, in->variant.event.clock);
+               bts_set(raw, bts_pid, in->variant.event.pid);
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       return ds_write(tracer->ds.context, ds_bts, raw,
+                       ds_cfg.sizeof_rec[ds_bts]);
+}
+
+
+static void ds_write_config(struct ds_context *context,
+                           struct ds_trace *cfg, enum ds_qualifier qual)
+{
+       unsigned char *ds = context->ds;
+
+       ds_set(ds, qual, ds_buffer_base, (unsigned long)cfg->begin);
+       ds_set(ds, qual, ds_index, (unsigned long)cfg->top);
+       ds_set(ds, qual, ds_absolute_maximum, (unsigned long)cfg->end);
+       ds_set(ds, qual, ds_interrupt_threshold, (unsigned long)cfg->ith);
+}
+
+static void ds_read_config(struct ds_context *context,
+                          struct ds_trace *cfg, enum ds_qualifier qual)
+{
+       unsigned char *ds = context->ds;
+
+       cfg->begin = (void *)ds_get(ds, qual, ds_buffer_base);
+       cfg->top = (void *)ds_get(ds, qual, ds_index);
+       cfg->end = (void *)ds_get(ds, qual, ds_absolute_maximum);
+       cfg->ith = (void *)ds_get(ds, qual, ds_interrupt_threshold);
+}
+
+static void ds_init_ds_trace(struct ds_trace *trace, enum ds_qualifier qual,
+                            void *base, size_t size, size_t ith,
+                            unsigned int flags) {
        unsigned long buffer, adj;
 
-       /* adjust the buffer address and size to meet alignment
+       /*
+        * Adjust the buffer address and size to meet alignment
         * constraints:
         * - buffer is double-word aligned
         * - size is multiple of record size
@@ -356,35 +640,48 @@ static void ds_install_ds_config(struct ds_context *context,
        buffer += adj;
        size   -= adj;
 
-       size /= ds_cfg.sizeof_rec[qual];
-       size *= ds_cfg.sizeof_rec[qual];
+       trace->n = size / ds_cfg.sizeof_rec[qual];
+       trace->size = ds_cfg.sizeof_rec[qual];
 
-       ds_set(context->ds, qual, ds_buffer_base, buffer);
-       ds_set(context->ds, qual, ds_index, buffer);
-       ds_set(context->ds, qual, ds_absolute_maximum, buffer + size);
+       size = (trace->n * trace->size);
 
-       /* The value for 'no threshold' is -1, which will set the
+       trace->begin = (void *)buffer;
+       trace->top = trace->begin;
+       trace->end = (void *)(buffer + size);
+       /*
+        * The value for 'no threshold' is -1, which will set the
         * threshold outside of the buffer, just like we want it.
         */
-       ds_set(context->ds, qual,
-              ds_interrupt_threshold, buffer + size - ith);
+       ith *= ds_cfg.sizeof_rec[qual];
+       trace->ith = (void *)(buffer + size - ith);
+
+       trace->flags = flags;
 }
 
-static int ds_request(struct ds_tracer *tracer, enum ds_qualifier qual,
-                     struct task_struct *task,
-                     void *base, size_t size, size_t th)
+
+static int ds_request(struct ds_tracer *tracer, struct ds_trace *trace,
+                     enum ds_qualifier qual, struct task_struct *task,
+                     int cpu, void *base, size_t size, size_t th)
 {
        struct ds_context *context;
-       unsigned long irq;
        int error;
+       size_t req_size;
 
        error = -EOPNOTSUPP;
-       if (!ds_cfg.sizeof_ds)
+       if (!ds_cfg.sizeof_rec[qual])
                goto out;
 
-       /* we require some space to do alignment adjustments below */
        error = -EINVAL;
-       if (size < (DS_ALIGNMENT + ds_cfg.sizeof_rec[qual]))
+       if (!base)
+               goto out;
+
+       req_size = ds_cfg.sizeof_rec[qual];
+       /* We might need space for alignment adjustments. */
+       if (!IS_ALIGNED((unsigned long)base, DS_ALIGNMENT))
+               req_size += DS_ALIGNMENT;
+
+       error = -EINVAL;
+       if (size < req_size)
                goto out;
 
        if (th != (size_t)-1) {
@@ -395,495 +692,746 @@ static int ds_request(struct ds_tracer *tracer, enum ds_qualifier qual,
                        goto out;
        }
 
-       error = -ENOMEM;
-       if (!base) {
-               base = ds_allocate_buffer(size, &tracer->pages);
-               if (!base)
-                       goto out;
-       }
-
        tracer->buffer = base;
        tracer->size = size;
 
        error = -ENOMEM;
-       context = ds_get_context(task);
+       context = ds_get_context(task, cpu);
        if (!context)
                goto out;
        tracer->context = context;
 
+       /*
+        * Defer any tracer-specific initialization work for the context until
+        * context ownership has been clarified.
+        */
 
-       spin_lock_irqsave(&ds_lock, irq);
-
-       error = -EPERM;
-       if (!check_tracer(task))
-               goto out_unlock;
-       get_tracer(task);
-
-       error = -EPERM;
-       if (context->owner[qual])
-               goto out_put_tracer;
-       context->owner[qual] = tracer;
-
-       spin_unlock_irqrestore(&ds_lock, irq);
-
-
-       ds_install_ds_config(context, qual, base, size, th);
-
-       return 0;
-
- out_put_tracer:
-       put_tracer(task);
- out_unlock:
-       spin_unlock_irqrestore(&ds_lock, irq);
-       ds_put_context(context);
-       tracer->context = NULL;
+       error = 0;
  out:
        return error;
 }
 
-struct bts_tracer *ds_request_bts(struct task_struct *task,
-                                 void *base, size_t size,
-                                 bts_ovfl_callback_t ovfl, size_t th)
+static struct bts_tracer *ds_request_bts(struct task_struct *task, int cpu,
+                                        void *base, size_t size,
+                                        bts_ovfl_callback_t ovfl, size_t th,
+                                        unsigned int flags)
 {
        struct bts_tracer *tracer;
        int error;
 
-       /* buffer overflow notification is not yet implemented */
+       /* Buffer overflow notification is not yet implemented. */
        error = -EOPNOTSUPP;
        if (ovfl)
                goto out;
 
+       error = get_tracer(task);
+       if (error < 0)
+               goto out;
+
        error = -ENOMEM;
        tracer = kzalloc(sizeof(*tracer), GFP_KERNEL);
        if (!tracer)
-               goto out;
+               goto out_put_tracer;
        tracer->ovfl = ovfl;
 
-       error = ds_request(&tracer->ds, ds_bts, task, base, size, th);
+       /* Do some more error checking and acquire a tracing context. */
+       error = ds_request(&tracer->ds, &tracer->trace.ds,
+                          ds_bts, task, cpu, base, size, th);
        if (error < 0)
                goto out_tracer;
 
+       /* Claim the bts part of the tracing context we acquired above. */
+       spin_lock_irq(&ds_lock);
+
+       error = -EPERM;
+       if (tracer->ds.context->bts_master)
+               goto out_unlock;
+       tracer->ds.context->bts_master = tracer;
+
+       spin_unlock_irq(&ds_lock);
+
+       /*
+        * Now that we own the bts part of the context, let's complete the
+        * initialization for that part.
+        */
+       ds_init_ds_trace(&tracer->trace.ds, ds_bts, base, size, th, flags);
+       ds_write_config(tracer->ds.context, &tracer->trace.ds, ds_bts);
+       ds_install_ds_area(tracer->ds.context);
+
+       tracer->trace.read  = bts_read;
+       tracer->trace.write = bts_write;
+
+       /* Start tracing. */
+       ds_resume_bts(tracer);
+
        return tracer;
 
+ out_unlock:
+       spin_unlock_irq(&ds_lock);
+       ds_put_context(tracer->ds.context);
  out_tracer:
-       (void)ds_release_bts(tracer);
+       kfree(tracer);
+ out_put_tracer:
+       put_tracer(task);
  out:
        return ERR_PTR(error);
 }
 
-struct pebs_tracer *ds_request_pebs(struct task_struct *task,
-                                   void *base, size_t size,
-                                   pebs_ovfl_callback_t ovfl, size_t th)
+struct bts_tracer *ds_request_bts_task(struct task_struct *task,
+                                      void *base, size_t size,
+                                      bts_ovfl_callback_t ovfl,
+                                      size_t th, unsigned int flags)
+{
+       return ds_request_bts(task, 0, base, size, ovfl, th, flags);
+}
+
+struct bts_tracer *ds_request_bts_cpu(int cpu, void *base, size_t size,
+                                     bts_ovfl_callback_t ovfl,
+                                     size_t th, unsigned int flags)
+{
+       return ds_request_bts(NULL, cpu, base, size, ovfl, th, flags);
+}
+
+static struct pebs_tracer *ds_request_pebs(struct task_struct *task, int cpu,
+                                          void *base, size_t size,
+                                          pebs_ovfl_callback_t ovfl, size_t th,
+                                          unsigned int flags)
 {
        struct pebs_tracer *tracer;
        int error;
 
-       /* buffer overflow notification is not yet implemented */
+       /* Buffer overflow notification is not yet implemented. */
        error = -EOPNOTSUPP;
        if (ovfl)
                goto out;
 
+       error = get_tracer(task);
+       if (error < 0)
+               goto out;
+
        error = -ENOMEM;
        tracer = kzalloc(sizeof(*tracer), GFP_KERNEL);
        if (!tracer)
-               goto out;
+               goto out_put_tracer;
        tracer->ovfl = ovfl;
 
-       error = ds_request(&tracer->ds, ds_pebs, task, base, size, th);
+       /* Do some more error checking and acquire a tracing context. */
+       error = ds_request(&tracer->ds, &tracer->trace.ds,
+                          ds_pebs, task, cpu, base, size, th);
        if (error < 0)
                goto out_tracer;
 
+       /* Claim the pebs part of the tracing context we acquired above. */
+       spin_lock_irq(&ds_lock);
+
+       error = -EPERM;
+       if (tracer->ds.context->pebs_master)
+               goto out_unlock;
+       tracer->ds.context->pebs_master = tracer;
+
+       spin_unlock_irq(&ds_lock);
+
+       /*
+        * Now that we own the pebs part of the context, let's complete the
+        * initialization for that part.
+        */
+       ds_init_ds_trace(&tracer->trace.ds, ds_pebs, base, size, th, flags);
+       ds_write_config(tracer->ds.context, &tracer->trace.ds, ds_pebs);
+       ds_install_ds_area(tracer->ds.context);
+
+       /* Start tracing. */
+       ds_resume_pebs(tracer);
+
        return tracer;
 
+ out_unlock:
+       spin_unlock_irq(&ds_lock);
+       ds_put_context(tracer->ds.context);
  out_tracer:
-       (void)ds_release_pebs(tracer);
+       kfree(tracer);
+ out_put_tracer:
+       put_tracer(task);
  out:
        return ERR_PTR(error);
 }
 
-static void ds_release(struct ds_tracer *tracer, enum ds_qualifier qual)
+struct pebs_tracer *ds_request_pebs_task(struct task_struct *task,
+                                        void *base, size_t size,
+                                        pebs_ovfl_callback_t ovfl,
+                                        size_t th, unsigned int flags)
 {
-       if (tracer->context) {
-               BUG_ON(tracer->context->owner[qual] != tracer);
-               tracer->context->owner[qual] = NULL;
-
-               put_tracer(tracer->context->task);
-               ds_put_context(tracer->context);
-       }
-
-       if (tracer->pages) {
-               kfree(tracer->buffer);
-
-               down_write(&current->mm->mmap_sem);
-
-               current->mm->total_vm  -= tracer->pages;
-               current->mm->locked_vm -= tracer->pages;
+       return ds_request_pebs(task, 0, base, size, ovfl, th, flags);
+}
 
-               up_write(&current->mm->mmap_sem);
-       }
+struct pebs_tracer *ds_request_pebs_cpu(int cpu, void *base, size_t size,
+                                       pebs_ovfl_callback_t ovfl,
+                                       size_t th, unsigned int flags)
+{
+       return ds_request_pebs(NULL, cpu, base, size, ovfl, th, flags);
 }
 
-int ds_release_bts(struct bts_tracer *tracer)
+static void ds_free_bts(struct bts_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
+       struct task_struct *task;
 
-       ds_release(&tracer->ds, ds_bts);
-       kfree(tracer);
+       task = tracer->ds.context->task;
 
-       return 0;
-}
+       WARN_ON_ONCE(tracer->ds.context->bts_master != tracer);
+       tracer->ds.context->bts_master = NULL;
 
-int ds_release_pebs(struct pebs_tracer *tracer)
-{
-       if (!tracer)
-               return -EINVAL;
+       /* Make sure tracing stopped and the tracer is not in use. */
+       if (task && (task != current))
+               wait_task_context_switch(task);
 
-       ds_release(&tracer->ds, ds_pebs);
-       kfree(tracer);
+       ds_put_context(tracer->ds.context);
+       put_tracer(task);
 
-       return 0;
+       kfree(tracer);
 }
 
-static size_t ds_get_index(struct ds_context *context, enum ds_qualifier qual)
+void ds_release_bts(struct bts_tracer *tracer)
 {
-       unsigned long base, index;
+       might_sleep();
 
-       base  = ds_get(context->ds, qual, ds_buffer_base);
-       index = ds_get(context->ds, qual, ds_index);
+       if (!tracer)
+               return;
 
-       return (index - base) / ds_cfg.sizeof_rec[qual];
+       ds_suspend_bts(tracer);
+       ds_free_bts(tracer);
 }
 
-int ds_get_bts_index(struct bts_tracer *tracer, size_t *pos)
+int ds_release_bts_noirq(struct bts_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
+       struct task_struct *task;
+       unsigned long irq;
+       int error;
 
-       if (!pos)
-               return -EINVAL;
+       if (!tracer)
+               return 0;
 
-       *pos = ds_get_index(tracer->ds.context, ds_bts);
+       task = tracer->ds.context->task;
 
-       return 0;
-}
+       local_irq_save(irq);
 
-int ds_get_pebs_index(struct pebs_tracer *tracer, size_t *pos)
-{
-       if (!tracer)
-               return -EINVAL;
+       error = -EPERM;
+       if (!task &&
+           (tracer->ds.context->cpu != smp_processor_id()))
+               goto out;
 
-       if (!pos)
-               return -EINVAL;
+       error = -EPERM;
+       if (task && (task != current))
+               goto out;
 
-       *pos = ds_get_index(tracer->ds.context, ds_pebs);
+       ds_suspend_bts_noirq(tracer);
+       ds_free_bts(tracer);
 
-       return 0;
+       error = 0;
+ out:
+       local_irq_restore(irq);
+       return error;
 }
 
-static size_t ds_get_end(struct ds_context *context, enum ds_qualifier qual)
+static void update_task_debugctlmsr(struct task_struct *task,
+                                   unsigned long debugctlmsr)
 {
-       unsigned long base, max;
-
-       base = ds_get(context->ds, qual, ds_buffer_base);
-       max  = ds_get(context->ds, qual, ds_absolute_maximum);
+       task->thread.debugctlmsr = debugctlmsr;
 
-       return (max - base) / ds_cfg.sizeof_rec[qual];
+       get_cpu();
+       if (task == current)
+               update_debugctlmsr(debugctlmsr);
+       put_cpu();
 }
 
-int ds_get_bts_end(struct bts_tracer *tracer, size_t *pos)
+void ds_suspend_bts(struct bts_tracer *tracer)
 {
+       struct task_struct *task;
+       unsigned long debugctlmsr;
+       int cpu;
+
        if (!tracer)
-               return -EINVAL;
+               return;
 
-       if (!pos)
-               return -EINVAL;
+       tracer->flags = 0;
 
-       *pos = ds_get_end(tracer->ds.context, ds_bts);
+       task = tracer->ds.context->task;
+       cpu  = tracer->ds.context->cpu;
 
-       return 0;
+       WARN_ON(!task && irqs_disabled());
+
+       debugctlmsr = (task ?
+                      task->thread.debugctlmsr :
+                      get_debugctlmsr_on_cpu(cpu));
+       debugctlmsr &= ~BTS_CONTROL;
+
+       if (task)
+               update_task_debugctlmsr(task, debugctlmsr);
+       else
+               update_debugctlmsr_on_cpu(cpu, debugctlmsr);
 }
 
-int ds_get_pebs_end(struct pebs_tracer *tracer, size_t *pos)
+int ds_suspend_bts_noirq(struct bts_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
+       struct task_struct *task;
+       unsigned long debugctlmsr, irq;
+       int cpu, error = 0;
 
-       if (!pos)
-               return -EINVAL;
+       if (!tracer)
+               return 0;
 
-       *pos = ds_get_end(tracer->ds.context, ds_pebs);
+       tracer->flags = 0;
 
-       return 0;
-}
+       task = tracer->ds.context->task;
+       cpu  = tracer->ds.context->cpu;
 
-static int ds_access(struct ds_context *context, enum ds_qualifier qual,
-                    size_t index, const void **record)
-{
-       unsigned long base, idx;
+       local_irq_save(irq);
 
-       if (!record)
-               return -EINVAL;
-
-       base = ds_get(context->ds, qual, ds_buffer_base);
-       idx = base + (index * ds_cfg.sizeof_rec[qual]);
+       error = -EPERM;
+       if (!task && (cpu != smp_processor_id()))
+               goto out;
 
-       if (idx > ds_get(context->ds, qual, ds_absolute_maximum))
-               return -EINVAL;
+       debugctlmsr = (task ?
+                      task->thread.debugctlmsr :
+                      get_debugctlmsr());
+       debugctlmsr &= ~BTS_CONTROL;
 
-       *record = (const void *)idx;
+       if (task)
+               update_task_debugctlmsr(task, debugctlmsr);
+       else
+               update_debugctlmsr(debugctlmsr);
 
-       return ds_cfg.sizeof_rec[qual];
+       error = 0;
+ out:
+       local_irq_restore(irq);
+       return error;
 }
 
-int ds_access_bts(struct bts_tracer *tracer, size_t index,
-                 const void **record)
+static unsigned long ds_bts_control(struct bts_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
+       unsigned long control;
 
-       return ds_access(tracer->ds.context, ds_bts, index, record);
+       control = ds_cfg.ctl[dsf_bts];
+       if (!(tracer->trace.ds.flags & BTS_KERNEL))
+               control |= ds_cfg.ctl[dsf_bts_kernel];
+       if (!(tracer->trace.ds.flags & BTS_USER))
+               control |= ds_cfg.ctl[dsf_bts_user];
+
+       return control;
 }
 
-int ds_access_pebs(struct pebs_tracer *tracer, size_t index,
-                  const void **record)
+void ds_resume_bts(struct bts_tracer *tracer)
 {
+       struct task_struct *task;
+       unsigned long debugctlmsr;
+       int cpu;
+
        if (!tracer)
-               return -EINVAL;
+               return;
+
+       tracer->flags = tracer->trace.ds.flags;
+
+       task = tracer->ds.context->task;
+       cpu  = tracer->ds.context->cpu;
+
+       WARN_ON(!task && irqs_disabled());
 
-       return ds_access(tracer->ds.context, ds_pebs, index, record);
+       debugctlmsr = (task ?
+                      task->thread.debugctlmsr :
+                      get_debugctlmsr_on_cpu(cpu));
+       debugctlmsr |= ds_bts_control(tracer);
+
+       if (task)
+               update_task_debugctlmsr(task, debugctlmsr);
+       else
+               update_debugctlmsr_on_cpu(cpu, debugctlmsr);
 }
 
-static int ds_write(struct ds_context *context, enum ds_qualifier qual,
-                   const void *record, size_t size)
+int ds_resume_bts_noirq(struct bts_tracer *tracer)
 {
-       int bytes_written = 0;
+       struct task_struct *task;
+       unsigned long debugctlmsr, irq;
+       int cpu, error = 0;
 
-       if (!record)
-               return -EINVAL;
+       if (!tracer)
+               return 0;
 
-       while (size) {
-               unsigned long base, index, end, write_end, int_th;
-               unsigned long write_size, adj_write_size;
+       tracer->flags = tracer->trace.ds.flags;
 
-               /*
-                * write as much as possible without producing an
-                * overflow interrupt.
-                *
-                * interrupt_threshold must either be
-                * - bigger than absolute_maximum or
-                * - point to a record between buffer_base and absolute_maximum
-                *
-                * index points to a valid record.
-                */
-               base   = ds_get(context->ds, qual, ds_buffer_base);
-               index  = ds_get(context->ds, qual, ds_index);
-               end    = ds_get(context->ds, qual, ds_absolute_maximum);
-               int_th = ds_get(context->ds, qual, ds_interrupt_threshold);
+       task = tracer->ds.context->task;
+       cpu  = tracer->ds.context->cpu;
 
-               write_end = min(end, int_th);
+       local_irq_save(irq);
 
-               /* if we are already beyond the interrupt threshold,
-                * we fill the entire buffer */
-               if (write_end <= index)
-                       write_end = end;
+       error = -EPERM;
+       if (!task && (cpu != smp_processor_id()))
+               goto out;
 
-               if (write_end <= index)
-                       break;
+       debugctlmsr = (task ?
+                      task->thread.debugctlmsr :
+                      get_debugctlmsr());
+       debugctlmsr |= ds_bts_control(tracer);
 
-               write_size = min((unsigned long) size, write_end - index);
-               memcpy((void *)index, record, write_size);
+       if (task)
+               update_task_debugctlmsr(task, debugctlmsr);
+       else
+               update_debugctlmsr(debugctlmsr);
 
-               record = (const char *)record + write_size;
-               size -= write_size;
-               bytes_written += write_size;
+       error = 0;
+ out:
+       local_irq_restore(irq);
+       return error;
+}
 
-               adj_write_size = write_size / ds_cfg.sizeof_rec[qual];
-               adj_write_size *= ds_cfg.sizeof_rec[qual];
+static void ds_free_pebs(struct pebs_tracer *tracer)
+{
+       struct task_struct *task;
 
-               /* zero out trailing bytes */
-               memset((char *)index + write_size, 0,
-                      adj_write_size - write_size);
-               index += adj_write_size;
+       task = tracer->ds.context->task;
 
-               if (index >= end)
-                       index = base;
-               ds_set(context->ds, qual, ds_index, index);
+       WARN_ON_ONCE(tracer->ds.context->pebs_master != tracer);
+       tracer->ds.context->pebs_master = NULL;
 
-               if (index >= int_th)
-                       ds_overflow(context, qual);
-       }
+       ds_put_context(tracer->ds.context);
+       put_tracer(task);
 
-       return bytes_written;
+       kfree(tracer);
 }
 
-int ds_write_bts(struct bts_tracer *tracer, const void *record, size_t size)
+void ds_release_pebs(struct pebs_tracer *tracer)
 {
+       might_sleep();
+
        if (!tracer)
-               return -EINVAL;
+               return;
 
-       return ds_write(tracer->ds.context, ds_bts, record, size);
+       ds_suspend_pebs(tracer);
+       ds_free_pebs(tracer);
 }
 
-int ds_write_pebs(struct pebs_tracer *tracer, const void *record, size_t size)
+int ds_release_pebs_noirq(struct pebs_tracer *tracer)
 {
+       struct task_struct *task;
+       unsigned long irq;
+       int error;
+
        if (!tracer)
-               return -EINVAL;
+               return 0;
 
-       return ds_write(tracer->ds.context, ds_pebs, record, size);
-}
+       task = tracer->ds.context->task;
 
-static void ds_reset_or_clear(struct ds_context *context,
-                             enum ds_qualifier qual, int clear)
-{
-       unsigned long base, end;
+       local_irq_save(irq);
+
+       error = -EPERM;
+       if (!task &&
+           (tracer->ds.context->cpu != smp_processor_id()))
+               goto out;
 
-       base = ds_get(context->ds, qual, ds_buffer_base);
-       end  = ds_get(context->ds, qual, ds_absolute_maximum);
+       error = -EPERM;
+       if (task && (task != current))
+               goto out;
 
-       if (clear)
-               memset((void *)base, 0, end - base);
+       ds_suspend_pebs_noirq(tracer);
+       ds_free_pebs(tracer);
 
-       ds_set(context->ds, qual, ds_index, base);
+       error = 0;
+ out:
+       local_irq_restore(irq);
+       return error;
 }
 
-int ds_reset_bts(struct bts_tracer *tracer)
+void ds_suspend_pebs(struct pebs_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
 
-       ds_reset_or_clear(tracer->ds.context, ds_bts, /* clear = */ 0);
+}
 
+int ds_suspend_pebs_noirq(struct pebs_tracer *tracer)
+{
        return 0;
 }
 
-int ds_reset_pebs(struct pebs_tracer *tracer)
+void ds_resume_pebs(struct pebs_tracer *tracer)
 {
-       if (!tracer)
-               return -EINVAL;
 
-       ds_reset_or_clear(tracer->ds.context, ds_pebs, /* clear = */ 0);
+}
 
+int ds_resume_pebs_noirq(struct pebs_tracer *tracer)
+{
        return 0;
 }
 
-int ds_clear_bts(struct bts_tracer *tracer)
+const struct bts_trace *ds_read_bts(struct bts_tracer *tracer)
 {
        if (!tracer)
-               return -EINVAL;
+               return NULL;
 
-       ds_reset_or_clear(tracer->ds.context, ds_bts, /* clear = */ 1);
+       ds_read_config(tracer->ds.context, &tracer->trace.ds, ds_bts);
+       return &tracer->trace;
+}
 
-       return 0;
+const struct pebs_trace *ds_read_pebs(struct pebs_tracer *tracer)
+{
+       if (!tracer)
+               return NULL;
+
+       ds_read_config(tracer->ds.context, &tracer->trace.ds, ds_pebs);
+
+       tracer->trace.counters = ds_cfg.nr_counter_reset;
+       memcpy(tracer->trace.counter_reset,
+              tracer->ds.context->ds +
+              (NUM_DS_PTR_FIELDS * ds_cfg.sizeof_ptr_field),
+              ds_cfg.nr_counter_reset * PEBS_RESET_FIELD_SIZE);
+
+       return &tracer->trace;
 }
 
-int ds_clear_pebs(struct pebs_tracer *tracer)
+int ds_reset_bts(struct bts_tracer *tracer)
 {
        if (!tracer)
                return -EINVAL;
 
-       ds_reset_or_clear(tracer->ds.context, ds_pebs, /* clear = */ 1);
+       tracer->trace.ds.top = tracer->trace.ds.begin;
+
+       ds_set(tracer->ds.context->ds, ds_bts, ds_index,
+              (unsigned long)tracer->trace.ds.top);
 
        return 0;
 }
 
-int ds_get_pebs_reset(struct pebs_tracer *tracer, u64 *value)
+int ds_reset_pebs(struct pebs_tracer *tracer)
 {
        if (!tracer)
                return -EINVAL;
 
-       if (!value)
-               return -EINVAL;
+       tracer->trace.ds.top = tracer->trace.ds.begin;
 
-       *value = *(u64 *)(tracer->ds.context->ds + (ds_cfg.sizeof_field * 8));
+       ds_set(tracer->ds.context->ds, ds_pebs, ds_index,
+              (unsigned long)tracer->trace.ds.top);
 
        return 0;
 }
 
-int ds_set_pebs_reset(struct pebs_tracer *tracer, u64 value)
+int ds_set_pebs_reset(struct pebs_tracer *tracer,
+                     unsigned int counter, u64 value)
 {
        if (!tracer)
                return -EINVAL;
 
-       *(u64 *)(tracer->ds.context->ds + (ds_cfg.sizeof_field * 8)) = value;
+       if (ds_cfg.nr_counter_reset < counter)
+               return -EINVAL;
+
+       *(u64 *)(tracer->ds.context->ds +
+                (NUM_DS_PTR_FIELDS * ds_cfg.sizeof_ptr_field) +
+                (counter * PEBS_RESET_FIELD_SIZE)) = value;
 
        return 0;
 }
 
-static const struct ds_configuration ds_cfg_var = {
-       .sizeof_ds    = sizeof(long) * 12,
-       .sizeof_field = sizeof(long),
-       .sizeof_rec[ds_bts]   = sizeof(long) * 3,
-#ifdef __i386__
-       .sizeof_rec[ds_pebs]  = sizeof(long) * 10
-#else
-       .sizeof_rec[ds_pebs]  = sizeof(long) * 18
-#endif
+static const struct ds_configuration ds_cfg_netburst = {
+       .name = "Netburst",
+       .ctl[dsf_bts]           = (1 << 2) | (1 << 3),
+       .ctl[dsf_bts_kernel]    = (1 << 5),
+       .ctl[dsf_bts_user]      = (1 << 6),
+       .nr_counter_reset       = 1,
+};
+static const struct ds_configuration ds_cfg_pentium_m = {
+       .name = "Pentium M",
+       .ctl[dsf_bts]           = (1 << 6) | (1 << 7),
+       .nr_counter_reset       = 1,
+};
+static const struct ds_configuration ds_cfg_core2_atom = {
+       .name = "Core 2/Atom",
+       .ctl[dsf_bts]           = (1 << 6) | (1 << 7),
+       .ctl[dsf_bts_kernel]    = (1 << 9),
+       .ctl[dsf_bts_user]      = (1 << 10),
+       .nr_counter_reset       = 1,
 };
-static const struct ds_configuration ds_cfg_64 = {
-       .sizeof_ds    = 8 * 12,
-       .sizeof_field = 8,
-       .sizeof_rec[ds_bts]   = 8 * 3,
+static const struct ds_configuration ds_cfg_core_i7 = {
+       .name = "Core i7",
+       .ctl[dsf_bts]           = (1 << 6) | (1 << 7),
+       .ctl[dsf_bts_kernel]    = (1 << 9),
+       .ctl[dsf_bts_user]      = (1 << 10),
+       .nr_counter_reset       = 4,
+};
+
+static void
+ds_configure(const struct ds_configuration *cfg,
+            struct cpuinfo_x86 *cpu)
+{
+       unsigned long nr_pebs_fields = 0;
+
+       printk(KERN_INFO "[ds] using %s configuration\n", cfg->name);
+
 #ifdef __i386__
-       .sizeof_rec[ds_pebs]  = 8 * 10
+       nr_pebs_fields = 10;
 #else
-       .sizeof_rec[ds_pebs]  = 8 * 18
+       nr_pebs_fields = 18;
 #endif
-};
 
-static inline void
-ds_configure(const struct ds_configuration *cfg)
-{
+       /*
+        * Starting with version 2, architectural performance
+        * monitoring supports a format specifier.
+        */
+       if ((cpuid_eax(0xa) & 0xff) > 1) {
+               unsigned long perf_capabilities, format;
+
+               rdmsrl(MSR_IA32_PERF_CAPABILITIES, perf_capabilities);
+
+               format = (perf_capabilities >> 8) & 0xf;
+
+               switch (format) {
+               case 0:
+                       nr_pebs_fields = 18;
+                       break;
+               case 1:
+                       nr_pebs_fields = 22;
+                       break;
+               default:
+                       printk(KERN_INFO
+                              "[ds] unknown PEBS format: %lu\n", format);
+                       nr_pebs_fields = 0;
+                       break;
+               }
+       }
+
+       memset(&ds_cfg, 0, sizeof(ds_cfg));
        ds_cfg = *cfg;
 
-       printk(KERN_INFO "DS available\n");
+       ds_cfg.sizeof_ptr_field =
+               (cpu_has(cpu, X86_FEATURE_DTES64) ? 8 : 4);
+
+       ds_cfg.sizeof_rec[ds_bts]  = ds_cfg.sizeof_ptr_field * 3;
+       ds_cfg.sizeof_rec[ds_pebs] = ds_cfg.sizeof_ptr_field * nr_pebs_fields;
 
-       BUG_ON(MAX_SIZEOF_DS < ds_cfg.sizeof_ds);
+       if (!cpu_has(cpu, X86_FEATURE_BTS)) {
+               ds_cfg.sizeof_rec[ds_bts] = 0;
+               printk(KERN_INFO "[ds] bts not available\n");
+       }
+       if (!cpu_has(cpu, X86_FEATURE_PEBS)) {
+               ds_cfg.sizeof_rec[ds_pebs] = 0;
+               printk(KERN_INFO "[ds] pebs not available\n");
+       }
+
+       printk(KERN_INFO "[ds] sizes: address: %u bit, ",
+              8 * ds_cfg.sizeof_ptr_field);
+       printk("bts/pebs record: %u/%u bytes\n",
+              ds_cfg.sizeof_rec[ds_bts], ds_cfg.sizeof_rec[ds_pebs]);
+
+       WARN_ON_ONCE(MAX_PEBS_COUNTERS < ds_cfg.nr_counter_reset);
 }
 
 void __cpuinit ds_init_intel(struct cpuinfo_x86 *c)
 {
+       /* Only configure the first cpu. Others are identical. */
+       if (ds_cfg.name)
+               return;
+
        switch (c->x86) {
        case 0x6:
                switch (c->x86_model) {
-               case 0 ... 0xC:
-                       /* sorry, don't know about them */
+               case 0x9:
+               case 0xd: /* Pentium M */
+                       ds_configure(&ds_cfg_pentium_m, c);
                        break;
-               case 0xD:
-               case 0xE: /* Pentium M */
-                       ds_configure(&ds_cfg_var);
+               case 0xf:
+               case 0x17: /* Core2 */
+               case 0x1c: /* Atom */
+                       ds_configure(&ds_cfg_core2_atom, c);
                        break;
-               default: /* Core2, Atom, ... */
-                       ds_configure(&ds_cfg_64);
+               case 0x1a: /* Core i7 */
+                       ds_configure(&ds_cfg_core_i7, c);
+                       break;
+               default:
+                       /* Sorry, don't know about them. */
                        break;
                }
                break;
-       case 0xF:
+       case 0xf:
                switch (c->x86_model) {
                case 0x0:
                case 0x1:
                case 0x2: /* Netburst */
-                       ds_configure(&ds_cfg_var);
+                       ds_configure(&ds_cfg_netburst, c);
                        break;
                default:
-                       /* sorry, don't know about them */
+                       /* Sorry, don't know about them. */
                        break;
                }
                break;
        default:
-               /* sorry, don't know about them */
+               /* Sorry, don't know about them. */
                break;
        }
 }
 
-void ds_free(struct ds_context *context)
+static inline void ds_take_timestamp(struct ds_context *context,
+                                    enum bts_qualifier qualifier,
+                                    struct task_struct *task)
+{
+       struct bts_tracer *tracer = context->bts_master;
+       struct bts_struct ts;
+
+       /* Prevent compilers from reading the tracer pointer twice. */
+       barrier();
+
+       if (!tracer || !(tracer->flags & BTS_TIMESTAMPS))
+               return;
+
+       memset(&ts, 0, sizeof(ts));
+       ts.qualifier            = qualifier;
+       ts.variant.event.clock  = trace_clock_global();
+       ts.variant.event.pid    = task->pid;
+
+       bts_write(tracer, &ts);
+}
+
+/*
+ * Change the DS configuration from tracing prev to tracing next.
+ */
+void ds_switch_to(struct task_struct *prev, struct task_struct *next)
+{
+       struct ds_context *prev_ctx     = prev->thread.ds_ctx;
+       struct ds_context *next_ctx     = next->thread.ds_ctx;
+       unsigned long debugctlmsr       = next->thread.debugctlmsr;
+
+       /* Make sure all data is read before we start. */
+       barrier();
+
+       if (prev_ctx) {
+               update_debugctlmsr(0);
+
+               ds_take_timestamp(prev_ctx, bts_task_departs, prev);
+       }
+
+       if (next_ctx) {
+               ds_take_timestamp(next_ctx, bts_task_arrives, next);
+
+               wrmsrl(MSR_IA32_DS_AREA, (unsigned long)next_ctx->ds);
+       }
+
+       update_debugctlmsr(debugctlmsr);
+}
+
+static __init int ds_selftest(void)
 {
-       /* This is called when the task owning the parameter context
-        * is dying. There should not be any user of that context left
-        * to disturb us, anymore. */
-       unsigned long leftovers = context->count;
-       while (leftovers--) {
-               put_tracer(context->task);
-               ds_put_context(context);
+       if (ds_cfg.sizeof_rec[ds_bts]) {
+               int error;
+
+               error = ds_selftest_bts();
+               if (error) {
+                       WARN(1, "[ds] selftest failed. disabling bts.\n");
+                       ds_cfg.sizeof_rec[ds_bts] = 0;
+               }
        }
+
+       if (ds_cfg.sizeof_rec[ds_pebs]) {
+               int error;
+
+               error = ds_selftest_pebs();
+               if (error) {
+                       WARN(1, "[ds] selftest failed. disabling pebs.\n");
+                       ds_cfg.sizeof_rec[ds_pebs] = 0;
+               }
+       }
+
+       return 0;
 }
+device_initcall(ds_selftest);