#include <sys/param.h>
#include <sys/systm.h>
#include <sys/proc.h>
#include <sys/pool.h>
#include <sys/fcntl.h>
#include <sys/lockf.h>
#include <sys/rwlock.h>
#include <sys/unistd.h>
TAILQ_HEAD(locklist, lockf);
struct lockf {
short lf_flags;
short lf_type;
off_t lf_start;
off_t lf_end;
caddr_t lf_id;
struct lockf_state *lf_state;
TAILQ_ENTRY(lockf) lf_entry;
struct lockf *lf_blk;
struct locklist lf_blkhd;
TAILQ_ENTRY(lockf) lf_block;
uid_t lf_uid;
pid_t lf_pid;
};
struct lockf_state {
TAILQ_HEAD(, lockf) ls_locks;
TAILQ_HEAD(, lockf) ls_pending;
struct lockf_state **ls_owner;
int ls_refs;
};
struct pool lockf_state_pool;
struct pool lockf_pool;
#define SELF 0x1
#define OTHERS 0x2
#ifdef LOCKF_DEBUG
#define DEBUG_SETLOCK 0x01
#define DEBUG_CLEARLOCK 0x02
#define DEBUG_GETLOCK 0x04
#define DEBUG_FINDOVR 0x08
#define DEBUG_SPLIT 0x10
#define DEBUG_WAKELOCK 0x20
#define DEBUG_LINK 0x40
int lockf_debug = DEBUG_SETLOCK|DEBUG_CLEARLOCK|DEBUG_WAKELOCK;
void lf_print(const char *, struct lockf *);
void lf_printlist(const char *, struct lockf *);
#define DPRINTF(args, level) if (lockf_debug & (level)) printf args
#define LFPRINT(args, level) if (lockf_debug & (level)) lf_print args
#else
#define DPRINTF(args, level)
#define LFPRINT(args, level)
#endif
struct lockf *lf_alloc(uid_t, int);
void lf_free(struct lockf *);
int lf_clearlock(struct lockf *);
int lf_findoverlap(struct lockf *, struct lockf *, int, struct lockf **);
struct lockf *lf_getblock(struct lockf *, struct lockf *);
int lf_getlock(struct lockf *, struct flock *);
int lf_setlock(struct lockf *);
void lf_split(struct lockf *, struct lockf *);
void lf_wakelock(struct lockf *, int);
int lf_deadlock(struct lockf *);
void ls_ref(struct lockf_state *);
void ls_rele(struct lockf_state *);
struct rwlock lockf_lock = RWLOCK_INITIALIZER("lockflk");
void
lf_init(void)
{
pool_init(&lockf_state_pool, sizeof(struct lockf_state), 0, IPL_NONE,
PR_WAITOK | PR_RWLOCK, "lockfspl", NULL);
pool_init(&lockf_pool, sizeof(struct lockf), 0, IPL_NONE,
PR_WAITOK | PR_RWLOCK, "lockfpl", NULL);
}
void
ls_ref(struct lockf_state *ls)
{
rw_assert_wrlock(&lockf_lock);
ls->ls_refs++;
}
void
ls_rele(struct lockf_state *ls)
{
rw_assert_wrlock(&lockf_lock);
if (--ls->ls_refs > 0)
return;
KASSERT(TAILQ_EMPTY(&ls->ls_locks));
KASSERT(TAILQ_EMPTY(&ls->ls_pending));
*ls->ls_owner = NULL;
pool_put(&lockf_state_pool, ls);
}
int maxlocksperuid = 1024;
struct lockf *
lf_alloc(uid_t uid, int allowfail)
{
struct uidinfo *uip;
struct lockf *lock;
uip = uid_find(uid);
if (uid && allowfail && uip->ui_lockcnt >
(allowfail == 1 ? maxlocksperuid : (maxlocksperuid * 2))) {
uid_release(uip);
return (NULL);
}
uip->ui_lockcnt++;
uid_release(uip);
lock = pool_get(&lockf_pool, PR_WAITOK);
lock->lf_uid = uid;
return (lock);
}
void
lf_free(struct lockf *lock)
{
struct uidinfo *uip;
rw_assert_wrlock(&lockf_lock);
LFPRINT(("lf_free", lock), DEBUG_LINK);
KASSERT(TAILQ_EMPTY(&lock->lf_blkhd));
ls_rele(lock->lf_state);
uip = uid_find(lock->lf_uid);
uip->ui_lockcnt--;
uid_release(uip);
pool_put(&lockf_pool, lock);
}
int
lf_advlock(struct lockf_state **state, off_t size, caddr_t id, int op,
struct flock *fl, int flags)
{
struct proc *p = curproc;
struct lockf_state *ls;
struct lockf *lock;
off_t start, end;
int error = 0;
switch (fl->l_whence) {
case SEEK_SET:
case SEEK_CUR:
start = fl->l_start;
break;
case SEEK_END:
start = size + fl->l_start;
break;
default:
return (EINVAL);
}
if (start < 0)
return (EINVAL);
if (fl->l_len > 0) {
if (fl->l_len - 1 > LLONG_MAX - start)
return (EOVERFLOW);
end = start + (fl->l_len - 1);
if (end == LLONG_MAX)
end = -1;
} else if (fl->l_len < 0) {
if (start + fl->l_len < 0)
return (EINVAL);
end = start - 1;
start += fl->l_len;
} else {
end = -1;
}
rw_enter_write(&lockf_lock);
ls = *state;
if (ls == NULL && op != F_SETLK) {
fl->l_type = F_UNLCK;
goto out;
}
if (ls == NULL) {
ls = pool_get(&lockf_state_pool, PR_WAITOK | PR_ZERO);
ls->ls_owner = state;
TAILQ_INIT(&ls->ls_locks);
TAILQ_INIT(&ls->ls_pending);
*state = ls;
}
ls_ref(ls);
lock = lf_alloc(p->p_ucred->cr_uid, op == F_SETLK ? 1 : 2);
if (!lock) {
ls_rele(ls);
error = ENOLCK;
goto out;
}
lock->lf_flags = flags;
lock->lf_type = fl->l_type;
lock->lf_start = start;
lock->lf_end = end;
lock->lf_id = id;
lock->lf_state = ls;
lock->lf_blk = NULL;
lock->lf_pid = (flags & F_POSIX) ? p->p_p->ps_pid : -1;
TAILQ_INIT(&lock->lf_blkhd);
switch (op) {
case F_SETLK:
error = lf_setlock(lock);
break;
case F_UNLCK:
error = lf_clearlock(lock);
lf_free(lock);
break;
case F_GETLK:
error = lf_getlock(lock, fl);
lf_free(lock);
break;
default:
lf_free(lock);
error = EINVAL;
break;
}
out:
rw_exit_write(&lockf_lock);
return (error);
}
int
lf_setlock(struct lockf *lock)
{
struct lockf *block;
struct lockf *overlap, *ltmp;
int ovcase, priority, needtolink, error;
rw_assert_wrlock(&lockf_lock);
LFPRINT(("lf_setlock", lock), DEBUG_SETLOCK);
priority = PLOCK;
if (lock->lf_type == F_WRLCK)
priority += 4;
priority |= PCATCH;
for (;;) {
block = lf_getblock(TAILQ_FIRST(&lock->lf_state->ls_locks),
lock);
if (block == NULL)
break;
if ((lock->lf_flags & F_WAIT) == 0) {
lf_free(lock);
return (EAGAIN);
}
if ((lock->lf_flags & F_POSIX) && lf_deadlock(lock)) {
lf_free(lock);
return (EDEADLK);
}
if ((lock->lf_flags & F_FLOCK) && lock->lf_type == F_WRLCK) {
lock->lf_type = F_UNLCK;
(void)lf_clearlock(lock);
lock->lf_type = F_WRLCK;
}
lock->lf_blk = block;
LFPRINT(("lf_setlock", lock), DEBUG_SETLOCK);
LFPRINT(("lf_setlock: blocking on", block), DEBUG_SETLOCK);
TAILQ_INSERT_TAIL(&block->lf_blkhd, lock, lf_block);
TAILQ_INSERT_TAIL(&lock->lf_state->ls_pending, lock, lf_entry);
error = rwsleep_nsec(lock, &lockf_lock, priority, "lockf",
INFSLP);
TAILQ_REMOVE(&lock->lf_state->ls_pending, lock, lf_entry);
wakeup_one(lock->lf_state);
if (lock->lf_blk != NULL) {
TAILQ_REMOVE(&lock->lf_blk->lf_blkhd, lock, lf_block);
lock->lf_blk = NULL;
}
if (error) {
lf_free(lock);
return (error);
}
if (lock->lf_flags & F_INTR) {
lf_free(lock);
return (EINTR);
}
}
block = TAILQ_FIRST(&lock->lf_state->ls_locks);
overlap = NULL;
needtolink = 1;
for (;;) {
ovcase = lf_findoverlap(block, lock, SELF, &overlap);
if (ovcase)
block = TAILQ_NEXT(overlap, lf_entry);
switch (ovcase) {
case 0:
if (needtolink) {
if (overlap)
TAILQ_INSERT_BEFORE(overlap, lock,
lf_entry);
else
TAILQ_INSERT_TAIL(&lock->lf_state->ls_locks,
lock, lf_entry);
}
break;
case 1:
if (lock->lf_type == F_RDLCK &&
overlap->lf_type == F_WRLCK)
lf_wakelock(overlap, 0);
overlap->lf_type = lock->lf_type;
lf_free(lock);
lock = overlap;
break;
case 2:
if (overlap->lf_type == lock->lf_type) {
if (!needtolink)
TAILQ_REMOVE(&lock->lf_state->ls_locks,
lock, lf_entry);
lf_free(lock);
lock = overlap;
break;
}
if (overlap->lf_start == lock->lf_start) {
if (!needtolink)
TAILQ_REMOVE(&lock->lf_state->ls_locks,
lock, lf_entry);
TAILQ_INSERT_BEFORE(overlap, lock, lf_entry);
overlap->lf_start = lock->lf_end + 1;
} else
lf_split(overlap, lock);
lf_wakelock(overlap, 0);
break;
case 3:
if (lock->lf_type == F_RDLCK &&
overlap->lf_type == F_WRLCK) {
lf_wakelock(overlap, 0);
} else {
while ((ltmp =
TAILQ_FIRST(&overlap->lf_blkhd))) {
TAILQ_REMOVE(&overlap->lf_blkhd, ltmp,
lf_block);
ltmp->lf_blk = lock;
TAILQ_INSERT_TAIL(&lock->lf_blkhd,
ltmp, lf_block);
}
}
if (needtolink) {
TAILQ_INSERT_BEFORE(overlap, lock, lf_entry);
needtolink = 0;
}
TAILQ_REMOVE(&lock->lf_state->ls_locks, overlap, lf_entry);
lf_free(overlap);
continue;
case 4:
if (!needtolink)
TAILQ_REMOVE(&lock->lf_state->ls_locks, lock,
lf_entry);
TAILQ_INSERT_AFTER(&lock->lf_state->ls_locks, overlap,
lock, lf_entry);
overlap->lf_end = lock->lf_start - 1;
lf_wakelock(overlap, 0);
needtolink = 0;
continue;
case 5:
if (needtolink)
TAILQ_INSERT_BEFORE(overlap, lock, lf_entry);
overlap->lf_start = lock->lf_end + 1;
lf_wakelock(overlap, 0);
break;
}
break;
}
LFPRINT(("lf_setlock: got the lock", lock), DEBUG_SETLOCK);
return (0);
}
int
lf_clearlock(struct lockf *lock)
{
struct lockf *lf, *overlap;
int ovcase;
rw_assert_wrlock(&lockf_lock);
lf = TAILQ_FIRST(&lock->lf_state->ls_locks);
if (lf == NULL)
return (0);
LFPRINT(("lf_clearlock", lock), DEBUG_CLEARLOCK);
while ((ovcase = lf_findoverlap(lf, lock, SELF, &overlap))) {
lf_wakelock(overlap, 0);
switch (ovcase) {
case 1:
TAILQ_REMOVE(&lock->lf_state->ls_locks, overlap,
lf_entry);
lf_free(overlap);
break;
case 2:
if (overlap->lf_start == lock->lf_start) {
overlap->lf_start = lock->lf_end + 1;
break;
}
lf_split(overlap, lock);
TAILQ_REMOVE(&lock->lf_state->ls_locks, lock, lf_entry);
break;
case 3:
lf = TAILQ_NEXT(overlap, lf_entry);
TAILQ_REMOVE(&lock->lf_state->ls_locks, overlap,
lf_entry);
lf_free(overlap);
continue;
case 4:
overlap->lf_end = lock->lf_start - 1;
lf = TAILQ_NEXT(overlap, lf_entry);
continue;
case 5:
overlap->lf_start = lock->lf_end + 1;
break;
}
break;
}
return (0);
}
int
lf_getlock(struct lockf *lock, struct flock *fl)
{
struct lockf *block, *lf;
rw_assert_wrlock(&lockf_lock);
LFPRINT(("lf_getlock", lock), DEBUG_CLEARLOCK);
lf = TAILQ_FIRST(&lock->lf_state->ls_locks);
if ((block = lf_getblock(lf, lock)) != NULL) {
fl->l_type = block->lf_type;
fl->l_whence = SEEK_SET;
fl->l_start = block->lf_start;
if (block->lf_end == -1)
fl->l_len = 0;
else
fl->l_len = block->lf_end - block->lf_start + 1;
fl->l_pid = block->lf_pid;
} else {
fl->l_type = F_UNLCK;
}
return (0);
}
struct lockf *
lf_getblock(struct lockf *lf, struct lockf *lock)
{
struct lockf *overlap;
rw_assert_wrlock(&lockf_lock);
while (lf_findoverlap(lf, lock, OTHERS, &overlap) != 0) {
if ((lock->lf_type == F_WRLCK || overlap->lf_type == F_WRLCK))
return (overlap);
lf = TAILQ_NEXT(overlap, lf_entry);
}
return (NULL);
}
int
lf_findoverlap(struct lockf *lf, struct lockf *lock, int type,
struct lockf **overlap)
{
off_t start, end;
rw_assert_wrlock(&lockf_lock);
LFPRINT(("lf_findoverlap: looking for overlap in", lock), DEBUG_FINDOVR);
*overlap = lf;
start = lock->lf_start;
end = lock->lf_end;
while (lf != NULL) {
if (((type & SELF) && lf->lf_id != lock->lf_id) ||
((type & OTHERS) && lf->lf_id == lock->lf_id)) {
*overlap = lf = TAILQ_NEXT(lf, lf_entry);
continue;
}
LFPRINT(("\tchecking", lf), DEBUG_FINDOVR);
if ((lf->lf_end != -1 && start > lf->lf_end) ||
(end != -1 && lf->lf_start > end)) {
DPRINTF(("no overlap\n"), DEBUG_FINDOVR);
if ((type & SELF) && end != -1 && lf->lf_start > end)
return (0);
*overlap = lf = TAILQ_NEXT(lf, lf_entry);
continue;
}
if ((lf->lf_start == start) && (lf->lf_end == end)) {
DPRINTF(("overlap == lock\n"), DEBUG_FINDOVR);
return (1);
}
if ((lf->lf_start <= start) &&
(lf->lf_end == -1 || (end != -1 && lf->lf_end >= end))) {
DPRINTF(("overlap contains lock\n"), DEBUG_FINDOVR);
return (2);
}
if (start <= lf->lf_start &&
(end == -1 || (lf->lf_end != -1 && end >= lf->lf_end))) {
DPRINTF(("lock contains overlap\n"), DEBUG_FINDOVR);
return (3);
}
if ((lf->lf_start < start) &&
((lf->lf_end >= start) || (lf->lf_end == -1))) {
DPRINTF(("overlap starts before lock\n"),
DEBUG_FINDOVR);
return (4);
}
if ((lf->lf_start > start) && (end != -1) &&
((lf->lf_end > end) || (lf->lf_end == -1))) {
DPRINTF(("overlap ends after lock\n"), DEBUG_FINDOVR);
return (5);
}
panic("lf_findoverlap: default");
}
return (0);
}
void
lf_purgelocks(struct lockf_state **state)
{
struct lockf_state *ls;
struct lockf *lock;
rw_enter_write(&lockf_lock);
ls = *state;
if (ls == NULL)
goto out;
ls_ref(ls);
TAILQ_FOREACH(lock, &ls->ls_locks, lf_entry) {
LFPRINT(("lf_purgelocks: wakeup", lock), DEBUG_SETLOCK);
lf_wakelock(lock, F_INTR);
}
while (!TAILQ_EMPTY(&ls->ls_pending))
rwsleep_nsec(ls, &lockf_lock, PLOCK, "lockfp", INFSLP);
while ((lock = TAILQ_FIRST(&ls->ls_locks))) {
TAILQ_REMOVE(&ls->ls_locks, lock, lf_entry);
lf_free(lock);
}
KASSERT(ls->ls_refs == 1);
ls_rele(ls);
out:
rw_exit_write(&lockf_lock);
}
void
lf_split(struct lockf *lock1, struct lockf *lock2)
{
struct lockf *splitlock;
rw_assert_wrlock(&lockf_lock);
LFPRINT(("lf_split", lock1), DEBUG_SPLIT);
LFPRINT(("splitting from", lock2), DEBUG_SPLIT);
if (lock1->lf_start == lock2->lf_start) {
lock1->lf_start = lock2->lf_end + 1;
TAILQ_INSERT_BEFORE(lock1, lock2, lf_entry);
return;
}
if (lock1->lf_end == lock2->lf_end) {
lock1->lf_end = lock2->lf_start - 1;
TAILQ_INSERT_AFTER(&lock1->lf_state->ls_locks, lock1, lock2,
lf_entry);
return;
}
splitlock = lf_alloc(lock1->lf_uid, 0);
splitlock->lf_flags = lock1->lf_flags;
splitlock->lf_type = lock1->lf_type;
splitlock->lf_start = lock2->lf_end + 1;
splitlock->lf_end = lock1->lf_end;
splitlock->lf_id = lock1->lf_id;
splitlock->lf_state = lock1->lf_state;
splitlock->lf_blk = NULL;
splitlock->lf_pid = lock1->lf_pid;
TAILQ_INIT(&splitlock->lf_blkhd);
ls_ref(splitlock->lf_state);
lock1->lf_end = lock2->lf_start - 1;
TAILQ_INSERT_AFTER(&lock1->lf_state->ls_locks, lock1, lock2, lf_entry);
TAILQ_INSERT_AFTER(&lock1->lf_state->ls_locks, lock2, splitlock,
lf_entry);
}
void
lf_wakelock(struct lockf *lock, int flags)
{
struct lockf *wakelock;
rw_assert_wrlock(&lockf_lock);
while ((wakelock = TAILQ_FIRST(&lock->lf_blkhd))) {
TAILQ_REMOVE(&lock->lf_blkhd, wakelock, lf_block);
wakelock->lf_blk = NULL;
wakelock->lf_flags |= flags;
wakeup_one(wakelock);
}
}
int
lf_deadlock(struct lockf *lock)
{
struct lockf *block, *lf, *pending;
lf = TAILQ_FIRST(&lock->lf_state->ls_locks);
for (; (block = lf_getblock(lf, lock)) != NULL;
lf = TAILQ_NEXT(block, lf_entry)) {
if ((block->lf_flags & F_POSIX) == 0)
continue;
TAILQ_FOREACH(pending, &lock->lf_state->ls_pending, lf_entry) {
if (pending->lf_blk == NULL)
continue;
if (pending->lf_pid == block->lf_pid &&
pending->lf_blk->lf_pid == lock->lf_pid)
return (1);
}
}
return (0);
}
#ifdef LOCKF_DEBUG
void
lf_print(const char *tag, struct lockf *lock)
{
struct lockf *block;
if (tag)
printf("%s: ", tag);
printf("lock %p", lock);
if (lock == NULL) {
printf("\n");
return;
}
printf(", %s %p %s, start %lld, end %lld",
lock->lf_flags & F_POSIX ? "posix" : "flock",
lock->lf_id,
lock->lf_type == F_RDLCK ? "shared" :
lock->lf_type == F_WRLCK ? "exclusive" :
lock->lf_type == F_UNLCK ? "unlock" :
"unknown", lock->lf_start, lock->lf_end);
printf(", next %p, state %p",
TAILQ_NEXT(lock, lf_entry), lock->lf_state);
block = TAILQ_FIRST(&lock->lf_blkhd);
if (block)
printf(", block");
TAILQ_FOREACH(block, &lock->lf_blkhd, lf_block)
printf(" %p,", block);
printf("\n");
}
void
lf_printlist(const char *tag, struct lockf *lock)
{
struct lockf *lf;
printf("%s: Lock list:\n", tag);
TAILQ_FOREACH(lf, &lock->lf_state->ls_locks, lf_entry) {
if (lock == lf)
printf(" * ");
else
printf(" ");
lf_print(NULL, lf);
}
}
#endif