^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Author Karsten Keil <kkeil@novell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright 2008 by Karsten Keil <kkeil@novell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/mISDNif.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include "core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) static u_int *debug;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) static struct proto mISDN_proto = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) .name = "misdn",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) .obj_size = sizeof(struct mISDN_sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define _pms(sk) ((struct mISDN_sock *)sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) static struct mISDN_sock_list data_sockets = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) .lock = __RW_LOCK_UNLOCKED(data_sockets.lock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static struct mISDN_sock_list base_sockets = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) .lock = __RW_LOCK_UNLOCKED(base_sockets.lock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define L2_HEADER_LEN 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static inline struct sk_buff *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) _l2_alloc_skb(unsigned int len, gfp_t gfp_mask)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) skb = alloc_skb(len + L2_HEADER_LEN, gfp_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) if (likely(skb))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) skb_reserve(skb, L2_HEADER_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) return skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) mISDN_sock_link(struct mISDN_sock_list *l, struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) write_lock_bh(&l->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) sk_add_node(sk, &l->head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) write_unlock_bh(&l->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) static void mISDN_sock_unlink(struct mISDN_sock_list *l, struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) write_lock_bh(&l->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) sk_del_node_init(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) write_unlock_bh(&l->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) mISDN_send(struct mISDNchannel *ch, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) struct mISDN_sock *msk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) msk = container_of(ch, struct mISDN_sock, ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) printk(KERN_DEBUG "%s len %d %p\n", __func__, skb->len, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) if (msk->sk.sk_state == MISDN_CLOSED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) return -EUNATCH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) __net_timestamp(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) err = sock_queue_rcv_skb(&msk->sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) printk(KERN_WARNING "%s: error %d\n", __func__, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) mISDN_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) struct mISDN_sock *msk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) msk = container_of(ch, struct mISDN_sock, ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) printk(KERN_DEBUG "%s(%p, %x, %p)\n", __func__, ch, cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) case CLOSE_CHANNEL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) msk->sk.sk_state = MISDN_CLOSED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) static inline void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) mISDN_sock_cmsg(struct sock *sk, struct msghdr *msg, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) struct __kernel_old_timeval tv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if (_pms(sk)->cmask & MISDN_TIME_STAMP) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) skb_get_timestamp(skb, &tv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) put_cmsg(msg, SOL_MISDN, MISDN_TIME_STAMP, sizeof(tv), &tv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) mISDN_sock_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) int flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) int copied, err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) printk(KERN_DEBUG "%s: len %d, flags %x ch.nr %d, proto %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) __func__, (int)len, flags, _pms(sk)->ch.nr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) sk->sk_protocol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) if (flags & (MSG_OOB))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) if (sk->sk_state == MISDN_CLOSED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) skb = skb_recv_datagram(sk, flags, flags & MSG_DONTWAIT, &err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) if (msg->msg_name) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) DECLARE_SOCKADDR(struct sockaddr_mISDN *, maddr, msg->msg_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) maddr->family = AF_ISDN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) maddr->dev = _pms(sk)->dev->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if ((sk->sk_protocol == ISDN_P_LAPD_TE) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) (sk->sk_protocol == ISDN_P_LAPD_NT)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) maddr->channel = (mISDN_HEAD_ID(skb) >> 16) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) maddr->tei = (mISDN_HEAD_ID(skb) >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) maddr->sapi = mISDN_HEAD_ID(skb) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) maddr->channel = _pms(sk)->ch.nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) maddr->sapi = _pms(sk)->ch.addr & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) maddr->tei = (_pms(sk)->ch.addr >> 8) & 0xFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) msg->msg_namelen = sizeof(*maddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) copied = skb->len + MISDN_HEADER_LEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) if (len < copied) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (flags & MSG_PEEK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) refcount_dec(&skb->users);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) skb_queue_head(&sk->sk_receive_queue, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) return -ENOSPC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) memcpy(skb_push(skb, MISDN_HEADER_LEN), mISDN_HEAD_P(skb),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) MISDN_HEADER_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) err = skb_copy_datagram_msg(skb, 0, msg, copied);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) mISDN_sock_cmsg(sk, msg, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) skb_free_datagram(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return err ? : copied;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) mISDN_sock_sendmsg(struct socket *sock, struct msghdr *msg, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) int err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) printk(KERN_DEBUG "%s: len %d flags %x ch %d proto %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) __func__, (int)len, msg->msg_flags, _pms(sk)->ch.nr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) sk->sk_protocol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if (msg->msg_flags & MSG_OOB)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) if (msg->msg_flags & ~(MSG_DONTWAIT | MSG_NOSIGNAL | MSG_ERRQUEUE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) if (len < MISDN_HEADER_LEN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) if (sk->sk_state != MISDN_BOUND)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) return -EBADFD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) skb = _l2_alloc_skb(len, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (memcpy_from_msg(skb_put(skb, len), msg, len)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) memcpy(mISDN_HEAD_P(skb), skb->data, MISDN_HEADER_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) skb_pull(skb, MISDN_HEADER_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) if (msg->msg_namelen >= sizeof(struct sockaddr_mISDN)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* if we have a address, we use it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) DECLARE_SOCKADDR(struct sockaddr_mISDN *, maddr, msg->msg_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) mISDN_HEAD_ID(skb) = maddr->channel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) } else { /* use default for L2 messages */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if ((sk->sk_protocol == ISDN_P_LAPD_TE) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) (sk->sk_protocol == ISDN_P_LAPD_NT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) mISDN_HEAD_ID(skb) = _pms(sk)->ch.nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) printk(KERN_DEBUG "%s: ID:%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) __func__, mISDN_HEAD_ID(skb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) if (!_pms(sk)->ch.peer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) err = _pms(sk)->ch.recv(_pms(sk)->ch.peer, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) skb = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) err = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) data_sock_release(struct socket *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if (!sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) switch (sk->sk_protocol) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) case ISDN_P_TE_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) case ISDN_P_NT_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) case ISDN_P_TE_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) case ISDN_P_NT_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (sk->sk_state == MISDN_BOUND)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) delete_channel(&_pms(sk)->ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) mISDN_sock_unlink(&data_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) case ISDN_P_LAPD_TE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) case ISDN_P_LAPD_NT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) case ISDN_P_B_RAW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) case ISDN_P_B_HDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) case ISDN_P_B_X75SLP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) case ISDN_P_B_L2DTMF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) case ISDN_P_B_L2DSP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) case ISDN_P_B_L2DSPHDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) delete_channel(&_pms(sk)->ch);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) mISDN_sock_unlink(&data_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) sock_orphan(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) skb_queue_purge(&sk->sk_receive_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) data_sock_ioctl_bound(struct sock *sk, unsigned int cmd, void __user *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) struct mISDN_ctrl_req cq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) int err = -EINVAL, val[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) struct mISDNchannel *bchan, *next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) if (!_pms(sk)->dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) case IMCTRLREQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) if (copy_from_user(&cq, p, sizeof(cq))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) if ((sk->sk_protocol & ~ISDN_P_B_MASK) == ISDN_P_B_START) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) list_for_each_entry_safe(bchan, next,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) &_pms(sk)->dev->bchannels, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) if (bchan->nr == cq.channel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) err = bchan->ctrl(bchan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) CONTROL_CHANNEL, &cq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) err = _pms(sk)->dev->D.ctrl(&_pms(sk)->dev->D,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) CONTROL_CHANNEL, &cq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) if (copy_to_user(p, &cq, sizeof(cq)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) case IMCLEAR_L2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) if (sk->sk_protocol != ISDN_P_LAPD_NT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) val[0] = cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) if (get_user(val[1], (int __user *)p)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) err = _pms(sk)->dev->teimgr->ctrl(_pms(sk)->dev->teimgr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) CONTROL_CHANNEL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) case IMHOLD_L1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (sk->sk_protocol != ISDN_P_LAPD_NT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) && sk->sk_protocol != ISDN_P_LAPD_TE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) val[0] = cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) if (get_user(val[1], (int __user *)p)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) err = _pms(sk)->dev->teimgr->ctrl(_pms(sk)->dev->teimgr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) CONTROL_CHANNEL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) data_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) int err = 0, id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) struct mISDNdevice *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) struct mISDNversion ver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) case IMGETVERSION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) ver.major = MISDN_MAJOR_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) ver.minor = MISDN_MINOR_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) ver.release = MISDN_RELEASE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (copy_to_user((void __user *)arg, &ver, sizeof(ver)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) case IMGETCOUNT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) id = get_mdevice_count();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (put_user(id, (int __user *)arg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) case IMGETDEVINFO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) if (get_user(id, (int __user *)arg)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) dev = get_mdevice(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) if (dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) struct mISDN_devinfo di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) memset(&di, 0, sizeof(di));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) di.id = dev->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) di.Dprotocols = dev->Dprotocols;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) di.Bprotocols = dev->Bprotocols | get_all_Bprotocols();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) di.protocol = dev->D.protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) memcpy(di.channelmap, dev->channelmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) sizeof(di.channelmap));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) di.nrbchan = dev->nrbchan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) strscpy(di.name, dev_name(&dev->dev), sizeof(di.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) if (copy_to_user((void __user *)arg, &di, sizeof(di)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) if (sk->sk_state == MISDN_BOUND)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) err = data_sock_ioctl_bound(sk, cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) (void __user *)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) err = -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) static int data_sock_setsockopt(struct socket *sock, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) sockptr_t optval, unsigned int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) int err = 0, opt = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) printk(KERN_DEBUG "%s(%p, %d, %x, optval, %d)\n", __func__, sock,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) level, optname, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) case MISDN_TIME_STAMP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) if (copy_from_sockptr(&opt, optval, sizeof(int))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) if (opt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) _pms(sk)->cmask |= MISDN_TIME_STAMP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) _pms(sk)->cmask &= ~MISDN_TIME_STAMP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) err = -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) static int data_sock_getsockopt(struct socket *sock, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) char __user *optval, int __user *optlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) int len, opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (get_user(len, optlen))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (len != sizeof(char))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) case MISDN_TIME_STAMP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) if (_pms(sk)->cmask & MISDN_TIME_STAMP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) opt = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) opt = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) if (put_user(opt, optval))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) return -ENOPROTOOPT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) data_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) struct sock *csk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) if (*debug & DEBUG_SOCKET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) if (addr_len != sizeof(struct sockaddr_mISDN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) if (!maddr || maddr->family != AF_ISDN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) if (_pms(sk)->dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) err = -EALREADY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) _pms(sk)->dev = get_mdevice(maddr->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (!_pms(sk)->dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) if (sk->sk_protocol < ISDN_P_B_START) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) read_lock_bh(&data_sockets.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) sk_for_each(csk, &data_sockets.head) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) if (sk == csk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) if (_pms(csk)->dev != _pms(sk)->dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) if (csk->sk_protocol >= ISDN_P_B_START)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) if (IS_ISDN_P_TE(csk->sk_protocol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) == IS_ISDN_P_TE(sk->sk_protocol))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) read_unlock_bh(&data_sockets.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) err = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) read_unlock_bh(&data_sockets.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) _pms(sk)->ch.send = mISDN_send;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) _pms(sk)->ch.ctrl = mISDN_ctrl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) switch (sk->sk_protocol) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) case ISDN_P_TE_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) case ISDN_P_NT_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) case ISDN_P_TE_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) case ISDN_P_NT_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) mISDN_sock_unlink(&data_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) err = connect_layer1(_pms(sk)->dev, &_pms(sk)->ch,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) sk->sk_protocol, maddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) mISDN_sock_link(&data_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) case ISDN_P_LAPD_TE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) case ISDN_P_LAPD_NT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) err = create_l2entity(_pms(sk)->dev, &_pms(sk)->ch,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) sk->sk_protocol, maddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) case ISDN_P_B_RAW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) case ISDN_P_B_HDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) case ISDN_P_B_X75SLP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) case ISDN_P_B_L2DTMF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) case ISDN_P_B_L2DSP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) case ISDN_P_B_L2DSPHDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) err = connect_Bstack(_pms(sk)->dev, &_pms(sk)->ch,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) sk->sk_protocol, maddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) err = -EPROTONOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) sk->sk_state = MISDN_BOUND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) _pms(sk)->ch.protocol = sk->sk_protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) data_sock_getname(struct socket *sock, struct sockaddr *addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) int peer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) if (!_pms(sk)->dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) return -EBADFD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) maddr->family = AF_ISDN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) maddr->dev = _pms(sk)->dev->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) maddr->channel = _pms(sk)->ch.nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) maddr->sapi = _pms(sk)->ch.addr & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) maddr->tei = (_pms(sk)->ch.addr >> 8) & 0xff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) return sizeof(*maddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) static const struct proto_ops data_sock_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) .family = PF_ISDN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) .release = data_sock_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) .ioctl = data_sock_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) .bind = data_sock_bind,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) .getname = data_sock_getname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) .sendmsg = mISDN_sock_sendmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) .recvmsg = mISDN_sock_recvmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) .poll = datagram_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) .listen = sock_no_listen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) .shutdown = sock_no_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) .setsockopt = data_sock_setsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) .getsockopt = data_sock_getsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) .connect = sock_no_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) .socketpair = sock_no_socketpair,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) .accept = sock_no_accept,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) .mmap = sock_no_mmap
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) data_sock_create(struct net *net, struct socket *sock, int protocol, int kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) struct sock *sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) if (sock->type != SOCK_DGRAM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) return -ESOCKTNOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) sk = sk_alloc(net, PF_ISDN, GFP_KERNEL, &mISDN_proto, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) if (!sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) sock_init_data(sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) sock->ops = &data_sock_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) sock->state = SS_UNCONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) sock_reset_flag(sk, SOCK_ZAPPED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) sk->sk_protocol = protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) sk->sk_state = MISDN_OPEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) mISDN_sock_link(&data_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) base_sock_release(struct socket *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) if (!sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) mISDN_sock_unlink(&base_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) sock_orphan(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) base_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) int err = 0, id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) struct mISDNdevice *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) struct mISDNversion ver;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) case IMGETVERSION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) ver.major = MISDN_MAJOR_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) ver.minor = MISDN_MINOR_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) ver.release = MISDN_RELEASE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) if (copy_to_user((void __user *)arg, &ver, sizeof(ver)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) case IMGETCOUNT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) id = get_mdevice_count();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) if (put_user(id, (int __user *)arg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) case IMGETDEVINFO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) if (get_user(id, (int __user *)arg)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) dev = get_mdevice(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) if (dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) struct mISDN_devinfo di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) memset(&di, 0, sizeof(di));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) di.id = dev->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) di.Dprotocols = dev->Dprotocols;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) di.Bprotocols = dev->Bprotocols | get_all_Bprotocols();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) di.protocol = dev->D.protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) memcpy(di.channelmap, dev->channelmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) sizeof(di.channelmap));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) di.nrbchan = dev->nrbchan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) strscpy(di.name, dev_name(&dev->dev), sizeof(di.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) if (copy_to_user((void __user *)arg, &di, sizeof(di)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) case IMSETDEVNAME:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) struct mISDN_devrename dn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) if (copy_from_user(&dn, (void __user *)arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) sizeof(dn))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) err = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) dn.name[sizeof(dn.name) - 1] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) dev = get_mdevice(dn.id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) if (dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) err = device_rename(&dev->dev, dn.name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) base_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) if (addr_len < sizeof(struct sockaddr_mISDN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) if (!maddr || maddr->family != AF_ISDN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) if (_pms(sk)->dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) err = -EALREADY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) _pms(sk)->dev = get_mdevice(maddr->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) if (!_pms(sk)->dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) sk->sk_state = MISDN_BOUND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) static const struct proto_ops base_sock_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) .family = PF_ISDN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) .release = base_sock_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) .ioctl = base_sock_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) .bind = base_sock_bind,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) .getname = sock_no_getname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) .sendmsg = sock_no_sendmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) .recvmsg = sock_no_recvmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) .listen = sock_no_listen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) .shutdown = sock_no_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) .connect = sock_no_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) .socketpair = sock_no_socketpair,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) .accept = sock_no_accept,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) .mmap = sock_no_mmap
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) base_sock_create(struct net *net, struct socket *sock, int protocol, int kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) struct sock *sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) if (sock->type != SOCK_RAW)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) return -ESOCKTNOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) if (!capable(CAP_NET_RAW))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) sk = sk_alloc(net, PF_ISDN, GFP_KERNEL, &mISDN_proto, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) if (!sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) sock_init_data(sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) sock->ops = &base_sock_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) sock->state = SS_UNCONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) sock_reset_flag(sk, SOCK_ZAPPED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) sk->sk_protocol = protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) sk->sk_state = MISDN_OPEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) mISDN_sock_link(&base_sockets, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) mISDN_sock_create(struct net *net, struct socket *sock, int proto, int kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) int err = -EPROTONOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) switch (proto) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) case ISDN_P_BASE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) err = base_sock_create(net, sock, proto, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) case ISDN_P_TE_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) case ISDN_P_NT_S0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) case ISDN_P_TE_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) case ISDN_P_NT_E1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) case ISDN_P_LAPD_TE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) case ISDN_P_LAPD_NT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) case ISDN_P_B_RAW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) case ISDN_P_B_HDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) case ISDN_P_B_X75SLP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) case ISDN_P_B_L2DTMF:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) case ISDN_P_B_L2DSP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) case ISDN_P_B_L2DSPHDLC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) err = data_sock_create(net, sock, proto, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) static const struct net_proto_family mISDN_sock_family_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) .family = PF_ISDN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) .create = mISDN_sock_create,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) misdn_sock_init(u_int *deb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) debug = deb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) err = sock_register(&mISDN_sock_family_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) printk(KERN_ERR "%s: error(%d)\n", __func__, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) misdn_sock_cleanup(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) sock_unregister(PF_ISDN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags