/*
 * Cell Broadband Engine OProfile Support
 *
 * (C) Copyright IBM Corporation 2006
 *
 * Author: Maynard Johnson <maynardj@us.ibm.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */

/* The purpose of this file is to handle SPU event task switching
 * and to record SPU context information into the OProfile
 * event buffer.
 *
 * Additionally, the spu_sync_buffer function is provided as a helper
 * for recoding actual SPU program counter samples to the event buffer.
 */
#include <linux/dcookies.h>
#include <linux/kref.h>
#include <linux/mm.h>
#include <linux/fs.h>
#include <linux/module.h>
#include <linux/notifier.h>
#include <linux/numa.h>
#include <linux/oprofile.h>
#include <linux/spinlock.h>
#include "pr_util.h"

#define RELEASE_ALL 9999

static DEFINE_SPINLOCK(buffer_lock);
static DEFINE_SPINLOCK(cache_lock);
static int num_spu_nodes;
int spu_prof_num_nodes;

struct spu_buffer spu_buff[MAX_NUMNODES * SPUS_PER_NODE];
struct delayed_work spu_work;
static unsigned max_spu_buff;

static void spu_buff_add(unsigned long int value, int spu)
{
        /* spu buff is a circular buffer.  Add entries to the
         * head.  Head is the index to store the next value.
         * The buffer is full when there is one available entry
         * in the queue, i.e. head and tail can't be equal.
         * That way we can tell the difference between the
         * buffer being full versus empty.
         *
         *  ASSUPTION: the buffer_lock is held when this function
         *             is called to lock the buffer, head and tail.
         */
        int full = 1;

        if (spu_buff[spu].head >= spu_buff[spu].tail) {
                if ((spu_buff[spu].head - spu_buff[spu].tail)
                    <  (max_spu_buff - 1))
                        full = 0;

        } else if (spu_buff[spu].tail > spu_buff[spu].head) {
                if ((spu_buff[spu].tail - spu_buff[spu].head)
                    > 1)
                        full = 0;
        }

        if (!full) {
                spu_buff[spu].buff[spu_buff[spu].head] = value;
                spu_buff[spu].head++;

                if (spu_buff[spu].head >= max_spu_buff)
                        spu_buff[spu].head = 0;
        } else {
                /* From the user's perspective make the SPU buffer
                 * size management/overflow look like we are using
                 * per cpu buffers.  The user uses the same
                 * per cpu parameter to adjust the SPU buffer size.
                 * Increment the sample_lost_overflow to inform
                 * the user the buffer size needs to be increased.
                 */
                oprofile_cpu_buffer_inc_smpl_lost();
        }
}

/* This function copies the per SPU buffers to the
 * OProfile kernel buffer.
 */
void sync_spu_buff(void)
{
        int spu;
        unsigned long flags;
        int curr_head;

        for (spu = 0; spu < num_spu_nodes; spu++) {
                /* In case there was an issue and the buffer didn't
                 * get created skip it.
                 */
                if (spu_buff[spu].buff == NULL)
                        continue;

                /* Hold the lock to make sure the head/tail
                 * doesn't change while spu_buff_add() is
                 * deciding if the buffer is full or not.
                 * Being a little paranoid.
                 */
                spin_lock_irqsave(&buffer_lock, flags);
                curr_head = spu_buff[spu].head;
                spin_unlock_irqrestore(&buffer_lock, flags);

                /* Transfer the current contents to the kernel buffer.
                 * data can still be added to the head of the buffer.
                 */
                oprofile_put_buff(spu_buff[spu].buff,
                                  spu_buff[spu].tail,
                                  curr_head, max_spu_buff);

                spin_lock_irqsave(&buffer_lock, flags);
                spu_buff[spu].tail = curr_head;
                spin_unlock_irqrestore(&buffer_lock, flags);
        }

}

static void wq_sync_spu_buff(struct work_struct *work)
{
        /* move data from spu buffers to kernel buffer */
        sync_spu_buff();

        /* only reschedule if profiling is not done */
        if (spu_prof_running)
                schedule_delayed_work(&spu_work, DEFAULT_TIMER_EXPIRE);
}

/* Container for caching information about an active SPU task. */
struct cached_info {
        struct vma_to_fileoffset_map *map;
        struct spu *the_spu;    /* needed to access pointer to local_store */
        struct kref cache_ref;
};

static struct cached_info *spu_info[MAX_NUMNODES * 8];

static void destroy_cached_info(struct kref *kref)
{
        struct cached_info *info;

        info = container_of(kref, struct cached_info, cache_ref);
        vma_map_free(info->map);
        kfree(info);
        module_put(THIS_MODULE);
}

/* Return the cached_info for the passed SPU number.
 * ATTENTION:  Callers are responsible for obtaining the
 *             cache_lock if needed prior to invoking this function.
 */
static struct cached_info *get_cached_info(struct spu *the_spu, int spu_num)
{
        struct kref *ref;
        struct cached_info *ret_info;

        if (spu_num >= num_spu_nodes) {
                printk(KERN_ERR "SPU_PROF: "
                       "%s, line %d: Invalid index %d into spu info cache\n",
                       __func__, __LINE__, spu_num);
                ret_info = NULL;
                goto out;
        }
        if (!spu_info[spu_num] && the_spu) {
                ref = spu_get_profile_private_kref(the_spu->ctx);
                if (ref) {
                        spu_info[spu_num] = container_of(ref, struct cached_info, cache_ref);
                        kref_get(&spu_info[spu_num]->cache_ref);
                }
        }

        ret_info = spu_info[spu_num];
 out:
        return ret_info;
}


/* Looks for cached info for the passed spu.  If not found, the
 * cached info is created for the passed spu.
 * Returns 0 for success; otherwise, -1 for error.
 */
static int
prepare_cached_spu_info(struct spu *spu, unsigned long objectId)
{
        unsigned long flags;
        struct vma_to_fileoffset_map *new_map;
        int retval = 0;
        struct cached_info *info;

        /* We won't bother getting cache_lock here since
         * don't do anything with the cached_info that's returned.
         */
        info = get_cached_info(spu, spu->number);

        if (info) {
                pr_debug("Found cached SPU info.\n");
                goto out;
        }

        /* Create cached_info and set spu_info[spu->number] to point to it.
         * spu->number is a system-wide value, not a per-node value.
         */
        info = kzalloc(sizeof(struct cached_info), GFP_KERNEL);
        if (!info) {
                printk(KERN_ERR "SPU_PROF: "
                       "%s, line %d: create vma_map failed\n",
                       __func__, __LINE__);
                retval = -ENOMEM;
                goto err_alloc;
        }
        new_map = create_vma_map(spu, objectId);
        if (!new_map) {
                printk(KERN_ERR "SPU_PROF: "
                       "%s, line %d: create vma_map failed\n",
                       __func__, __LINE__);
                retval = -ENOMEM;
                goto err_alloc;
        }

        pr_debug("Created vma_map\n");
        info->map = new_map;
        info->the_spu = spu;
        kref_init(&info->cache_ref);
        spin_lock_irqsave(&cache_lock, flags);
        spu_info[spu->number] = info;
        /* Increment count before passing off ref to SPUFS. */
        kref_get(&info->cache_ref);

        /* We increment the module refcount here since SPUFS is
         * responsible for the final destruction of the cached_info,
         * and it must be able to access the destroy_cached_info()
         * function defined in the OProfile module.  We decrement
         * the module refcount in destroy_cached_info.
         */
        try_module_get(THIS_MODULE);
        spu_set_profile_private_kref(spu->ctx, &info->cache_ref,
                                destroy_cached_info);
        spin_unlock_irqrestore(&cache_lock, flags);
        goto out;

err_alloc:
        kfree(info);
out:
        return retval;
}

/*
 * NOTE:  The caller is responsible for locking the
 *        cache_lock prior to calling this function.
 */
static int release_cached_info(int spu_index)
{
        int index, end;

        if (spu_index == RELEASE_ALL) {
                end = num_spu_nodes;
                index = 0;
        } else {
                if (spu_index >= num_spu_nodes) {
                        printk(KERN_ERR "SPU_PROF: "
                                "%s, line %d: "
                                "Invalid index %d into spu info cache\n",
                                __func__, __LINE__, spu_index);
                        goto out;
                }
                end = spu_index + 1;
                index = spu_index;
        }
        for (; index < end; index++) {
                if (spu_info[index]) {
                        kref_put(&spu_info[index]->cache_ref,
                                 destroy_cached_info);
                        spu_info[index] = NULL;
                }
        }

out:
        return 0;
}

/* The source code for fast_get_dcookie was "borrowed"
 * from drivers/oprofile/buffer_sync.c.
 */

/* Optimisation. We can manage without taking the dcookie sem
 * because we cannot reach this code without at least one
 * dcookie user still being registered (namely, the reader
 * of the event buffer).
 */
static inline unsigned long fast_get_dcookie(struct path *path)
{
        unsigned long cookie;

        if (path->dentry->d_flags & DCACHE_COOKIE)
                return (unsigned long)path->dentry;
        get_dcookie(path, &cookie);
        return cookie;
}

/* Look up the dcookie for the task's first VM_EXECUTABLE mapping,
 * which corresponds loosely to "application name". Also, determine
 * the offset for the SPU ELF object.  If computed offset is
 * non-zero, it implies an embedded SPU object; otherwise, it's a
 * separate SPU binary, in which case we retrieve it's dcookie.
 * For the embedded case, we must determine if SPU ELF is embedded
 * in the executable application or another file (i.e., shared lib).
 * If embedded in a shared lib, we must get the dcookie and return
 * that to the caller.
 */
static unsigned long
get_exec_dcookie_and_offset(struct spu *spu, unsigned int *offsetp,
                            unsigned long *spu_bin_dcookie,
                            unsigned long spu_ref)
{
        unsigned long app_cookie = 0;
        unsigned int my_offset = 0;
        struct file *app = NULL;
        struct vm_area_struct *vma;
        struct mm_struct *mm = spu->mm;

        if (!mm)
                goto out;

        down_read(&mm->mmap_sem);

        for (vma = mm->mmap; vma; vma = vma->vm_next) {
                if (!vma->vm_file)
                        continue;
                if (!(vma->vm_flags & VM_EXECUTABLE))
                        continue;
                app_cookie = fast_get_dcookie(&vma->vm_file->f_path);
                pr_debug("got dcookie for %s\n",
                         vma->vm_file->f_dentry->d_name.name);
                app = vma->vm_file;
                break;
        }

        for (vma = mm->mmap; vma; vma = vma->vm_next) {
                if (vma->vm_start > spu_ref || vma->vm_end <= spu_ref)
                        continue;
                my_offset = spu_ref - vma->vm_start;
                if (!vma->vm_file)
                        goto fail_no_image_cookie;

                pr_debug("Found spu ELF at %X(object-id:%lx) for file %s\n",
                         my_offset, spu_ref,
                         vma->vm_file->f_dentry->d_name.name);
                *offsetp = my_offset;
                break;
        }

        *spu_bin_dcookie = fast_get_dcookie(&vma->vm_file->f_path);
        pr_debug("got dcookie for %s\n", vma->vm_file->f_dentry->d_name.name);

        up_read(&mm->mmap_sem);

out:
        return app_cookie;

fail_no_image_cookie:
        up_read(&mm->mmap_sem);

        printk(KERN_ERR "SPU_PROF: "
                "%s, line %d: Cannot find dcookie for SPU binary\n",
                __func__, __LINE__);
        goto out;
}



/* This function finds or creates cached context information for the
 * passed SPU and records SPU context information into the OProfile
 * event buffer.
 */
static int process_context_switch(struct spu *spu, unsigned long objectId)
{
        unsigned long flags;
        int retval;
        unsigned int offset = 0;
        unsigned long spu_cookie = 0, app_dcookie;

        retval = prepare_cached_spu_info(spu, objectId);
        if (retval)
                goto out;

        /* Get dcookie first because a mutex_lock is taken in that
         * code path, so interrupts must not be disabled.
         */
        app_dcookie = get_exec_dcookie_and_offset(spu, &offset, &spu_cookie, objectId);
        if (!app_dcookie || !spu_cookie) {
                retval  = -ENOENT;
                goto out;
        }

        /* Record context info in event buffer */
        spin_lock_irqsave(&buffer_lock, flags);
        spu_buff_add(ESCAPE_CODE, spu->number);
        spu_buff_add(SPU_CTX_SWITCH_CODE, spu->number);
        spu_buff_add(spu->number, spu->number);
        spu_buff_add(spu->pid, spu->number);
        spu_buff_add(spu->tgid, spu->number);
        spu_buff_add(app_dcookie, spu->number);
        spu_buff_add(spu_cookie, spu->number);
        spu_buff_add(offset, spu->number);

        /* Set flag to indicate SPU PC data can now be written out.  If
         * the SPU program counter data is seen before an SPU context
         * record is seen, the postprocessing will fail.
         */
        spu_buff[spu->number].ctx_sw_seen = 1;

        spin_unlock_irqrestore(&buffer_lock, flags);
        smp_wmb();      /* insure spu event buffer updates are written */
                        /* don't want entries intermingled... */
out:
        return retval;
}

/*
 * This function is invoked on either a bind_context or unbind_context.
 * If called for an unbind_context, the val arg is 0; otherwise,
 * it is the object-id value for the spu context.
 * The data arg is of type 'struct spu *'.
 */
static int spu_active_notify(struct notifier_block *self, unsigned long val,
                                void *data)
{
        int retval;
        unsigned long flags;
        struct spu *the_spu = data;

        pr_debug("SPU event notification arrived\n");
        if (!val) {
                spin_lock_irqsave(&cache_lock, flags);
                retval = release_cached_info(the_spu->number);
                spin_unlock_irqrestore(&cache_lock, flags);
        } else {
                retval = process_context_switch(the_spu, val);
        }
        return retval;
}

static struct notifier_block spu_active = {
        .notifier_call = spu_active_notify,
};

static int number_of_online_nodes(void)
{
        u32 cpu; u32 tmp;
        int nodes = 0;
        for_each_online_cpu(cpu) {
                tmp = cbe_cpu_to_node(cpu) + 1;
                if (tmp > nodes)
                        nodes++;
        }
        return nodes;
}

static int oprofile_spu_buff_create(void)
{
        int spu;

        max_spu_buff = oprofile_get_cpu_buffer_size();

        for (spu = 0; spu < num_spu_nodes; spu++) {
                /* create circular buffers to store the data in.
                 * use locks to manage accessing the buffers
                 */
                spu_buff[spu].head = 0;
                spu_buff[spu].tail = 0;

                /*
                 * Create a buffer for each SPU.  Can't reliably
                 * create a single buffer for all spus due to not
                 * enough contiguous kernel memory.
                 */

                spu_buff[spu].buff = kzalloc((max_spu_buff
                                              * sizeof(unsigned long)),
                                             GFP_KERNEL);

                if (!spu_buff[spu].buff) {
                        printk(KERN_ERR "SPU_PROF: "
                               "%s, line %d:  oprofile_spu_buff_create "
                       "failed to allocate spu buffer %d.\n",
                               __func__, __LINE__, spu);

                        /* release the spu buffers that have been allocated */
                        while (spu >= 0) {
                                kfree(spu_buff[spu].buff);
                                spu_buff[spu].buff = 0;
                                spu--;
                        }
                        return -ENOMEM;
                }
        }
        return 0;
}

/* The main purpose of this function is to synchronize
 * OProfile with SPUFS by registering to be notified of
 * SPU task switches.
 *
 * NOTE: When profiling SPUs, we must ensure that only
 * spu_sync_start is invoked and not the generic sync_start
 * in drivers/oprofile/oprof.c.  A return value of
 * SKIP_GENERIC_SYNC or SYNC_START_ERROR will
 * accomplish this.
 */
int spu_sync_start(void)
{
        int spu;
        int ret = SKIP_GENERIC_SYNC;
        int register_ret;
        unsigned long flags = 0;

        spu_prof_num_nodes = number_of_online_nodes();
        num_spu_nodes = spu_prof_num_nodes * 8;
        INIT_DELAYED_WORK(&spu_work, wq_sync_spu_buff);

        /* create buffer for storing the SPU data to put in
         * the kernel buffer.
         */
        ret = oprofile_spu_buff_create();
        if (ret)
                goto out;

        spin_lock_irqsave(&buffer_lock, flags);
        for (spu = 0; spu < num_spu_nodes; spu++) {
                spu_buff_add(ESCAPE_CODE, spu);
                spu_buff_add(SPU_PROFILING_CODE, spu);
                spu_buff_add(num_spu_nodes, spu);
        }
        spin_unlock_irqrestore(&buffer_lock, flags);

        for (spu = 0; spu < num_spu_nodes; spu++) {
                spu_buff[spu].ctx_sw_seen = 0;
                spu_buff[spu].last_guard_val = 0;
        }

        /* Register for SPU events  */
        register_ret = spu_switch_event_register(&spu_active);
        if (register_ret) {
                ret = SYNC_START_ERROR;
                goto out;
        }

        pr_debug("spu_sync_start -- running.\n");
out:
        return ret;
}

/* Record SPU program counter samples to the oprofile event buffer. */
void spu_sync_buffer(int spu_num, unsigned int *samples,
                     int num_samples)
{
        unsigned long long file_offset;
        unsigned long flags;
        int i;
        struct vma_to_fileoffset_map *map;
        struct spu *the_spu;
        unsigned long long spu_num_ll = spu_num;
        unsigned long long spu_num_shifted = spu_num_ll << 32;
        struct cached_info *c_info;

        /* We need to obtain the cache_lock here because it's
         * possible that after getting the cached_info, the SPU job
         * corresponding to this cached_info may end, thus resulting
         * in the destruction of the cached_info.
         */
        spin_lock_irqsave(&cache_lock, flags);
        c_info = get_cached_info(NULL, spu_num);
        if (!c_info) {
                /* This legitimately happens when the SPU task ends before all
                 * samples are recorded.
                 * No big deal -- so we just drop a few samples.
                 */
                pr_debug("SPU_PROF: No cached SPU contex "
                          "for SPU #%d. Dropping samples.\n", spu_num);
                goto out;
        }

        map = c_info->map;
        the_spu = c_info->the_spu;
        spin_lock(&buffer_lock);
        for (i = 0; i < num_samples; i++) {
                unsigned int sample = *(samples+i);
                int grd_val = 0;
                file_offset = 0;
                if (sample == 0)
                        continue;
                file_offset = vma_map_lookup( map, sample, the_spu, &grd_val);

                /* If overlays are used by this SPU application, the guard
                 * value is non-zero, indicating which overlay section is in
                 * use.  We need to discard samples taken during the time
                 * period which an overlay occurs (i.e., guard value changes).
                 */
                if (grd_val && grd_val != spu_buff[spu_num].last_guard_val) {
                        spu_buff[spu_num].last_guard_val = grd_val;
                        /* Drop the rest of the samples. */
                        break;
                }

                /* We must ensure that the SPU context switch has been written
                 * out before samples for the SPU.  Otherwise, the SPU context
                 * information is not available and the postprocessing of the
                 * SPU PC will fail with no available anonymous map information.
                 */
                if (spu_buff[spu_num].ctx_sw_seen)
                        spu_buff_add((file_offset | spu_num_shifted),
                                         spu_num);
        }
        spin_unlock(&buffer_lock);
out:
        spin_unlock_irqrestore(&cache_lock, flags);
}


int spu_sync_stop(void)
{
        unsigned long flags = 0;
        int ret;
        int k;

        ret = spu_switch_event_unregister(&spu_active);

        if (ret)
                printk(KERN_ERR "SPU_PROF: "
                       "%s, line %d: spu_switch_event_unregister "      \
                       "returned %d\n",
                       __func__, __LINE__, ret);

        /* flush any remaining data in the per SPU buffers */
        sync_spu_buff();

        spin_lock_irqsave(&cache_lock, flags);
        ret = release_cached_info(RELEASE_ALL);
        spin_unlock_irqrestore(&cache_lock, flags);

        /* remove scheduled work queue item rather then waiting
         * for every queued entry to execute.  Then flush pending
         * system wide buffer to event buffer.
         */
        cancel_delayed_work(&spu_work);

        for (k = 0; k < num_spu_nodes; k++) {
                spu_buff[k].ctx_sw_seen = 0;

                /*
                 * spu_sys_buff will be null if there was a problem
                 * allocating the buffer.  Only delete if it exists.
                 */
                kfree(spu_buff[k].buff);
                spu_buff[k].buff = 0;
        }
        pr_debug("spu_sync_stop -- done.\n");
        return ret;
}