1 1.2 riastrad /* $NetBSD: linux_notifier.c,v 1.2 2021/12/19 11:47:08 riastradh Exp $ */ 2 1.1 riastrad 3 1.1 riastrad /*- 4 1.1 riastrad * Copyright (c) 2021 The NetBSD Foundation, Inc. 5 1.1 riastrad * All rights reserved. 6 1.1 riastrad * 7 1.1 riastrad * This code is derived from software contributed to The NetBSD Foundation 8 1.1 riastrad * by Taylor R. Campbell. 9 1.1 riastrad * 10 1.1 riastrad * Redistribution and use in source and binary forms, with or without 11 1.1 riastrad * modification, are permitted provided that the following conditions 12 1.1 riastrad * are met: 13 1.1 riastrad * 1. Redistributions of source code must retain the above copyright 14 1.1 riastrad * notice, this list of conditions and the following disclaimer. 15 1.1 riastrad * 2. Redistributions in binary form must reproduce the above copyright 16 1.1 riastrad * notice, this list of conditions and the following disclaimer in the 17 1.1 riastrad * documentation and/or other materials provided with the distribution. 18 1.1 riastrad * 19 1.1 riastrad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.1 riastrad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.1 riastrad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.1 riastrad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.1 riastrad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.1 riastrad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.1 riastrad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.1 riastrad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.1 riastrad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.1 riastrad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.1 riastrad * POSSIBILITY OF SUCH DAMAGE. 30 1.1 riastrad */ 31 1.1 riastrad 32 1.1 riastrad #include <sys/cdefs.h> 33 1.2 riastrad __KERNEL_RCSID(0, "$NetBSD: linux_notifier.c,v 1.2 2021/12/19 11:47:08 riastradh Exp $"); 34 1.1 riastrad 35 1.1 riastrad #include <sys/types.h> 36 1.1 riastrad 37 1.1 riastrad #include <sys/pserialize.h> 38 1.1 riastrad #include <sys/xcall.h> 39 1.1 riastrad 40 1.1 riastrad #include <linux/notifier.h> 41 1.1 riastrad #include <linux/spinlock.h> 42 1.1 riastrad 43 1.1 riastrad void 44 1.1 riastrad ATOMIC_INIT_NOTIFIER_HEAD(struct atomic_notifier_head *H) 45 1.1 riastrad { 46 1.1 riastrad 47 1.1 riastrad spin_lock_init(&H->anh_lock); 48 1.1 riastrad PSLIST_INIT(&H->anh_list); 49 1.1 riastrad } 50 1.1 riastrad 51 1.1 riastrad void 52 1.1 riastrad ATOMIC_CLEANUP_NOTIFIER_HEAD(struct atomic_notifier_head *H) 53 1.1 riastrad { 54 1.1 riastrad 55 1.1 riastrad PSLIST_DESTROY(&H->anh_list); 56 1.1 riastrad spin_lock_destroy(&H->anh_lock); 57 1.1 riastrad } 58 1.1 riastrad 59 1.1 riastrad void 60 1.1 riastrad atomic_notifier_chain_register(struct atomic_notifier_head *H, 61 1.1 riastrad struct notifier_block *B) 62 1.1 riastrad { 63 1.1 riastrad 64 1.1 riastrad spin_lock(&H->anh_lock); 65 1.1 riastrad PSLIST_WRITER_INSERT_HEAD(&H->anh_list, B, nb_entry); 66 1.1 riastrad spin_unlock(&H->anh_lock); 67 1.1 riastrad } 68 1.1 riastrad 69 1.1 riastrad void 70 1.1 riastrad atomic_notifier_chain_unregister(struct atomic_notifier_head *H, 71 1.1 riastrad struct notifier_block *B) 72 1.1 riastrad { 73 1.1 riastrad 74 1.1 riastrad spin_lock(&H->anh_lock); 75 1.1 riastrad PSLIST_WRITER_REMOVE(B, nb_entry); 76 1.1 riastrad spin_unlock(&H->anh_lock); 77 1.1 riastrad 78 1.1 riastrad xc_barrier(0); 79 1.1 riastrad } 80 1.1 riastrad 81 1.1 riastrad void 82 1.2 riastrad atomic_notifier_call_chain(struct atomic_notifier_head *H, 83 1.1 riastrad unsigned long arg0, void *arg1) 84 1.1 riastrad { 85 1.1 riastrad struct notifier_block *B; 86 1.1 riastrad int s; 87 1.1 riastrad 88 1.1 riastrad s = pserialize_read_enter(); 89 1.1 riastrad PSLIST_READER_FOREACH(B, &H->anh_list, struct notifier_block, nb_entry) 90 1.1 riastrad { 91 1.1 riastrad if ((*B->notifier_call)(B, arg0, arg1) == NOTIFY_DONE) 92 1.1 riastrad break; 93 1.1 riastrad } 94 1.1 riastrad pserialize_read_exit(s); 95 1.1 riastrad } 96