|  | /* | 
|  | *  ICSWX and ACOP/PID Management | 
|  | * | 
|  | *  Copyright (C) 2011 Anton Blanchard, IBM Corp. <anton@samba.org> | 
|  | * | 
|  | *  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. | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <linux/sched.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/types.h> | 
|  | #include <linux/mm.h> | 
|  | #include <linux/spinlock.h> | 
|  | #include <linux/idr.h> | 
|  | #include <linux/module.h> | 
|  | #include "icswx.h" | 
|  |  | 
|  | #define COP_PID_MIN (COP_PID_NONE + 1) | 
|  | #define COP_PID_MAX (0xFFFF) | 
|  |  | 
|  | static DEFINE_SPINLOCK(mmu_context_acop_lock); | 
|  | static DEFINE_IDA(cop_ida); | 
|  |  | 
|  | static int new_cop_pid(struct ida *ida, int min_id, int max_id, | 
|  | spinlock_t *lock) | 
|  | { | 
|  | int index; | 
|  | int err; | 
|  |  | 
|  | again: | 
|  | if (!ida_pre_get(ida, GFP_KERNEL)) | 
|  | return -ENOMEM; | 
|  |  | 
|  | spin_lock(lock); | 
|  | err = ida_get_new_above(ida, min_id, &index); | 
|  | spin_unlock(lock); | 
|  |  | 
|  | if (err == -EAGAIN) | 
|  | goto again; | 
|  | else if (err) | 
|  | return err; | 
|  |  | 
|  | if (index > max_id) { | 
|  | spin_lock(lock); | 
|  | ida_remove(ida, index); | 
|  | spin_unlock(lock); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | return index; | 
|  | } | 
|  |  | 
|  | int get_cop_pid(struct mm_struct *mm) | 
|  | { | 
|  | int pid; | 
|  |  | 
|  | if (mm->context.cop_pid == COP_PID_NONE) { | 
|  | pid = new_cop_pid(&cop_ida, COP_PID_MIN, COP_PID_MAX, | 
|  | &mmu_context_acop_lock); | 
|  | if (pid >= 0) | 
|  | mm->context.cop_pid = pid; | 
|  | } | 
|  | return mm->context.cop_pid; | 
|  | } | 
|  |  | 
|  | int disable_cop_pid(struct mm_struct *mm) | 
|  | { | 
|  | int free_pid = COP_PID_NONE; | 
|  |  | 
|  | if ((!mm->context.acop) && (mm->context.cop_pid != COP_PID_NONE)) { | 
|  | free_pid = mm->context.cop_pid; | 
|  | mm->context.cop_pid = COP_PID_NONE; | 
|  | } | 
|  | return free_pid; | 
|  | } | 
|  |  | 
|  | void free_cop_pid(int free_pid) | 
|  | { | 
|  | spin_lock(&mmu_context_acop_lock); | 
|  | ida_remove(&cop_ida, free_pid); | 
|  | spin_unlock(&mmu_context_acop_lock); | 
|  | } |