···1+/*****************************************/2+Kernel Connector.3+/*****************************************/4+5+Kernel connector - new netlink based userspace <-> kernel space easy6+to use communication module.7+8+Connector driver adds possibility to connect various agents using9+netlink based network. One must register callback and10+identifier. When driver receives special netlink message with11+appropriate identifier, appropriate callback will be called.12+13+From the userspace point of view it's quite straightforward:14+15+ socket();16+ bind();17+ send();18+ recv();19+20+But if kernelspace want to use full power of such connections, driver21+writer must create special sockets, must know about struct sk_buff22+handling... Connector allows any kernelspace agents to use netlink23+based networking for inter-process communication in a significantly24+easier way:25+26+int cn_add_callback(struct cb_id *id, char *name, void (*callback) (void *));27+void cn_netlink_send(struct cn_msg *msg, u32 __group, int gfp_mask);28+29+struct cb_id30+{31+ __u32 idx;32+ __u32 val;33+};34+35+idx and val are unique identifiers which must be registered in36+connector.h for in-kernel usage. void (*callback) (void *) - is a37+callback function which will be called when message with above idx.val38+will be received by connector core. Argument for that function must39+be dereferenced to struct cn_msg *.40+41+struct cn_msg42+{43+ struct cb_id id;44+45+ __u32 seq;46+ __u32 ack;47+48+ __u32 len; /* Length of the following data */49+ __u8 data[0];50+};51+52+/*****************************************/53+Connector interfaces.54+/*****************************************/55+56+int cn_add_callback(struct cb_id *id, char *name, void (*callback) (void *));57+58+Registers new callback with connector core.59+60+struct cb_id *id - unique connector's user identifier.61+ It must be registered in connector.h for legal in-kernel users.62+char *name - connector's callback symbolic name.63+void (*callback) (void *) - connector's callback.64+ Argument must be dereferenced to struct cn_msg *.65+66+void cn_del_callback(struct cb_id *id);67+68+Unregisters new callback with connector core.69+70+struct cb_id *id - unique connector's user identifier.71+72+void cn_netlink_send(struct cn_msg *msg, u32 __groups, int gfp_mask);73+74+Sends message to the specified groups. It can be safely called from75+any context, but may silently fail under strong memory pressure.76+77+struct cn_msg * - message header(with attached data).78+u32 __group - destination group.79+ If __group is zero, then appropriate group will80+ be searched through all registered connector users,81+ and message will be delivered to the group which was82+ created for user with the same ID as in msg.83+ If __group is not zero, then message will be delivered84+ to the specified group.85+int gfp_mask - GFP mask.86+87+Note: When registering new callback user, connector core assigns88+netlink group to the user which is equal to it's id.idx.89+90+/*****************************************/91+Protocol description.92+/*****************************************/93+94+Current offers transport layer with fixed header. Recommended95+protocol which uses such header is following:96+97+msg->seq and msg->ack are used to determine message genealogy. When98+someone sends message it puts there locally unique sequence and random99+acknowledge numbers. Sequence number may be copied into100+nlmsghdr->nlmsg_seq too.101+102+Sequence number is incremented with each message to be sent.103+104+If we expect reply to our message, then sequence number in received105+message MUST be the same as in original message, and acknowledge106+number MUST be the same + 1.107+108+If we receive message and it's sequence number is not equal to one we109+are expecting, then it is new message. If we receive message and it's110+sequence number is the same as one we are expecting, but it's111+acknowledge is not equal acknowledge number in original message + 1,112+then it is new message.113+114+Obviously, protocol header contains above id.115+116+connector allows event notification in the following form: kernel117+driver or userspace process can ask connector to notify it when118+selected id's will be turned on or off(registered or unregistered it's119+callback). It is done by sending special command to connector120+driver(it also registers itself with id={-1, -1}).121+122+As example of usage Documentation/connector now contains cn_test.c -123+testing module which uses connector to request notification and to124+send messages.125+126+/*****************************************/127+Reliability.128+/*****************************************/129+130+Netlink itself is not reliable protocol, that means that messages can131+be lost due to memory pressure or process' receiving queue overflowed,132+so caller is warned must be prepared. That is why struct cn_msg [main133+connector's message header] contains u32 seq and u32 ack fields.
···17# default.18obj-y += char/190020# i810fb and intelfb depend on char/agp/21obj-$(CONFIG_FB_I810) += video/i810/22obj-$(CONFIG_FB_INTEL) += video/intelfb/
···17# default.18obj-y += char/1920+obj-$(CONFIG_CONNECTOR) += connector/21+22# i810fb and intelfb depend on char/agp/23obj-$(CONFIG_FB_I810) += video/i810/24obj-$(CONFIG_FB_INTEL) += video/intelfb/
+13
drivers/connector/Kconfig
···0000000000000
···1+menu "Connector - unified userspace <-> kernelspace linker"2+3+config CONNECTOR4+ tristate "Connector - unified userspace <-> kernelspace linker"5+ depends on NET6+ ---help---7+ This is unified userspace <-> kernelspace connector working on top8+ of the netlink socket protocol.9+10+ Connector support can also be built as a module. If so, the module11+ will be called cn.ko.12+13+endmenu
···1+/*2+ * cn_queue.c3+ * 4+ * 2004-2005 Copyright (c) Evgeniy Polyakov <johnpol@2ka.mipt.ru>5+ * All rights reserved.6+ * 7+ * This program is free software; you can redistribute it and/or modify8+ * it under the terms of the GNU General Public License as published by9+ * the Free Software Foundation; either version 2 of the License, or10+ * (at your option) any later version.11+ *12+ * This program is distributed in the hope that it will be useful,13+ * but WITHOUT ANY WARRANTY; without even the implied warranty of14+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the15+ * GNU General Public License for more details.16+ *17+ * You should have received a copy of the GNU General Public License18+ * along with this program; if not, write to the Free Software19+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA20+ *21+ */22+23+#include <linux/kernel.h>24+#include <linux/module.h>25+#include <linux/list.h>26+#include <linux/workqueue.h>27+#include <linux/spinlock.h>28+#include <linux/slab.h>29+#include <linux/skbuff.h>30+#include <linux/suspend.h>31+#include <linux/connector.h>32+#include <linux/delay.h>33+34+static void cn_queue_wrapper(void *data)35+{36+ struct cn_callback_entry *cbq = data;37+38+ cbq->cb->callback(cbq->cb->priv);39+ cbq->destruct_data(cbq->ddata);40+ cbq->ddata = NULL;41+}42+43+static struct cn_callback_entry *cn_queue_alloc_callback_entry(struct cn_callback *cb)44+{45+ struct cn_callback_entry *cbq;46+47+ cbq = kzalloc(sizeof(*cbq), GFP_KERNEL);48+ if (!cbq) {49+ printk(KERN_ERR "Failed to create new callback queue.\n");50+ return NULL;51+ }52+53+ cbq->cb = cb;54+ INIT_WORK(&cbq->work, &cn_queue_wrapper, cbq);55+ return cbq;56+}57+58+static void cn_queue_free_callback(struct cn_callback_entry *cbq)59+{60+ cancel_delayed_work(&cbq->work);61+ flush_workqueue(cbq->pdev->cn_queue);62+63+ kfree(cbq);64+}65+66+int cn_cb_equal(struct cb_id *i1, struct cb_id *i2)67+{68+ return ((i1->idx == i2->idx) && (i1->val == i2->val));69+}70+71+int cn_queue_add_callback(struct cn_queue_dev *dev, struct cn_callback *cb)72+{73+ struct cn_callback_entry *cbq, *__cbq;74+ int found = 0;75+76+ cbq = cn_queue_alloc_callback_entry(cb);77+ if (!cbq)78+ return -ENOMEM;79+80+ atomic_inc(&dev->refcnt);81+ cbq->pdev = dev;82+83+ spin_lock_bh(&dev->queue_lock);84+ list_for_each_entry(__cbq, &dev->queue_list, callback_entry) {85+ if (cn_cb_equal(&__cbq->cb->id, &cb->id)) {86+ found = 1;87+ break;88+ }89+ }90+ if (!found)91+ list_add_tail(&cbq->callback_entry, &dev->queue_list);92+ spin_unlock_bh(&dev->queue_lock);93+94+ if (found) {95+ atomic_dec(&dev->refcnt);96+ cn_queue_free_callback(cbq);97+ return -EINVAL;98+ }99+100+ cbq->nls = dev->nls;101+ cbq->seq = 0;102+ cbq->group = cbq->cb->id.idx;103+104+ return 0;105+}106+107+void cn_queue_del_callback(struct cn_queue_dev *dev, struct cb_id *id)108+{109+ struct cn_callback_entry *cbq, *n;110+ int found = 0;111+112+ spin_lock_bh(&dev->queue_lock);113+ list_for_each_entry_safe(cbq, n, &dev->queue_list, callback_entry) {114+ if (cn_cb_equal(&cbq->cb->id, id)) {115+ list_del(&cbq->callback_entry);116+ found = 1;117+ break;118+ }119+ }120+ spin_unlock_bh(&dev->queue_lock);121+122+ if (found) {123+ cn_queue_free_callback(cbq);124+ atomic_dec_and_test(&dev->refcnt);125+ }126+}127+128+struct cn_queue_dev *cn_queue_alloc_dev(char *name, struct sock *nls)129+{130+ struct cn_queue_dev *dev;131+132+ dev = kzalloc(sizeof(*dev), GFP_KERNEL);133+ if (!dev)134+ return NULL;135+136+ snprintf(dev->name, sizeof(dev->name), "%s", name);137+ atomic_set(&dev->refcnt, 0);138+ INIT_LIST_HEAD(&dev->queue_list);139+ spin_lock_init(&dev->queue_lock);140+141+ dev->nls = nls;142+ dev->netlink_groups = 0;143+144+ dev->cn_queue = create_workqueue(dev->name);145+ if (!dev->cn_queue) {146+ kfree(dev);147+ return NULL;148+ }149+150+ return dev;151+}152+153+void cn_queue_free_dev(struct cn_queue_dev *dev)154+{155+ struct cn_callback_entry *cbq, *n;156+157+ flush_workqueue(dev->cn_queue);158+ destroy_workqueue(dev->cn_queue);159+160+ spin_lock_bh(&dev->queue_lock);161+ list_for_each_entry_safe(cbq, n, &dev->queue_list, callback_entry)162+ list_del(&cbq->callback_entry);163+ spin_unlock_bh(&dev->queue_lock);164+165+ while (atomic_read(&dev->refcnt)) {166+ printk(KERN_INFO "Waiting for %s to become free: refcnt=%d.\n",167+ dev->name, atomic_read(&dev->refcnt));168+ msleep(1000);169+ }170+171+ kfree(dev);172+ dev = NULL;173+}
···1+/*2+ * connector.c3+ * 4+ * 2004-2005 Copyright (c) Evgeniy Polyakov <johnpol@2ka.mipt.ru>5+ * All rights reserved.6+ * 7+ * This program is free software; you can redistribute it and/or modify8+ * it under the terms of the GNU General Public License as published by9+ * the Free Software Foundation; either version 2 of the License, or10+ * (at your option) any later version.11+ *12+ * This program is distributed in the hope that it will be useful,13+ * but WITHOUT ANY WARRANTY; without even the implied warranty of14+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the15+ * GNU General Public License for more details.16+ *17+ * You should have received a copy of the GNU General Public License18+ * along with this program; if not, write to the Free Software19+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA20+ */21+22+#include <linux/kernel.h>23+#include <linux/module.h>24+#include <linux/list.h>25+#include <linux/skbuff.h>26+#include <linux/netlink.h>27+#include <linux/moduleparam.h>28+#include <linux/connector.h>29+30+#include <net/sock.h>31+32+MODULE_LICENSE("GPL");33+MODULE_AUTHOR("Evgeniy Polyakov <johnpol@2ka.mipt.ru>");34+MODULE_DESCRIPTION("Generic userspace <-> kernelspace connector.");35+36+static u32 cn_idx = CN_IDX_CONNECTOR;37+static u32 cn_val = CN_VAL_CONNECTOR;38+39+module_param(cn_idx, uint, 0);40+module_param(cn_val, uint, 0);41+MODULE_PARM_DESC(cn_idx, "Connector's main device idx.");42+MODULE_PARM_DESC(cn_val, "Connector's main device val.");43+44+static DECLARE_MUTEX(notify_lock);45+static LIST_HEAD(notify_list);46+47+static struct cn_dev cdev;48+49+int cn_already_initialized = 0;50+51+/*52+ * msg->seq and msg->ack are used to determine message genealogy.53+ * When someone sends message it puts there locally unique sequence54+ * and random acknowledge numbers. Sequence number may be copied into55+ * nlmsghdr->nlmsg_seq too.56+ *57+ * Sequence number is incremented with each message to be sent.58+ *59+ * If we expect reply to our message then the sequence number in60+ * received message MUST be the same as in original message, and61+ * acknowledge number MUST be the same + 1.62+ *63+ * If we receive a message and its sequence number is not equal to the64+ * one we are expecting then it is a new message.65+ *66+ * If we receive a message and its sequence number is the same as one67+ * we are expecting but it's acknowledgement number is not equal to68+ * the acknowledgement number in the original message + 1, then it is69+ * a new message.70+ *71+ */72+int cn_netlink_send(struct cn_msg *msg, u32 __group, int gfp_mask)73+{74+ struct cn_callback_entry *__cbq;75+ unsigned int size;76+ struct sk_buff *skb;77+ struct nlmsghdr *nlh;78+ struct cn_msg *data;79+ struct cn_dev *dev = &cdev;80+ u32 group = 0;81+ int found = 0;82+83+ if (!__group) {84+ spin_lock_bh(&dev->cbdev->queue_lock);85+ list_for_each_entry(__cbq, &dev->cbdev->queue_list,86+ callback_entry) {87+ if (cn_cb_equal(&__cbq->cb->id, &msg->id)) {88+ found = 1;89+ group = __cbq->group;90+ }91+ }92+ spin_unlock_bh(&dev->cbdev->queue_lock);93+94+ if (!found)95+ return -ENODEV;96+ } else {97+ group = __group;98+ }99+100+ size = NLMSG_SPACE(sizeof(*msg) + msg->len);101+102+ skb = alloc_skb(size, gfp_mask);103+ if (!skb)104+ return -ENOMEM;105+106+ nlh = NLMSG_PUT(skb, 0, msg->seq, NLMSG_DONE, size - sizeof(*nlh));107+108+ data = NLMSG_DATA(nlh);109+110+ memcpy(data, msg, sizeof(*data) + msg->len);111+112+ NETLINK_CB(skb).dst_group = group;113+114+ netlink_broadcast(dev->nls, skb, 0, group, gfp_mask);115+116+ return 0;117+118+nlmsg_failure:119+ kfree_skb(skb);120+ return -EINVAL;121+}122+123+/*124+ * Callback helper - queues work and setup destructor for given data.125+ */126+static int cn_call_callback(struct cn_msg *msg, void (*destruct_data)(void *), void *data)127+{128+ struct cn_callback_entry *__cbq;129+ struct cn_dev *dev = &cdev;130+ int found = 0;131+132+ spin_lock_bh(&dev->cbdev->queue_lock);133+ list_for_each_entry(__cbq, &dev->cbdev->queue_list, callback_entry) {134+ if (cn_cb_equal(&__cbq->cb->id, &msg->id)) {135+ /*136+ * Let's scream if there is some magic and the137+ * data will arrive asynchronously here.138+ * [i.e. netlink messages will be queued].139+ * After the first warning I will fix it140+ * quickly, but now I think it is141+ * impossible. --zbr (2004_04_27).142+ */143+ if (likely(!test_bit(0, &__cbq->work.pending) &&144+ __cbq->ddata == NULL)) {145+ __cbq->cb->priv = msg;146+147+ __cbq->ddata = data;148+ __cbq->destruct_data = destruct_data;149+150+ if (queue_work(dev->cbdev->cn_queue,151+ &__cbq->work))152+ found = 1;153+ } else {154+ printk("%s: cbq->data=%p, "155+ "work->pending=%08lx.\n",156+ __func__, __cbq->ddata,157+ __cbq->work.pending);158+ WARN_ON(1);159+ }160+ break;161+ }162+ }163+ spin_unlock_bh(&dev->cbdev->queue_lock);164+165+ return found ? 0 : -ENODEV;166+}167+168+/*169+ * Skb receive helper - checks skb and msg size and calls callback170+ * helper.171+ */172+static int __cn_rx_skb(struct sk_buff *skb, struct nlmsghdr *nlh)173+{174+ u32 pid, uid, seq, group;175+ struct cn_msg *msg;176+177+ pid = NETLINK_CREDS(skb)->pid;178+ uid = NETLINK_CREDS(skb)->uid;179+ seq = nlh->nlmsg_seq;180+ group = NETLINK_CB((skb)).dst_group;181+ msg = NLMSG_DATA(nlh);182+183+ return cn_call_callback(msg, (void (*)(void *))kfree_skb, skb);184+}185+186+/*187+ * Main netlink receiving function.188+ *189+ * It checks skb and netlink header sizes and calls the skb receive190+ * helper with a shared skb.191+ */192+static void cn_rx_skb(struct sk_buff *__skb)193+{194+ struct nlmsghdr *nlh;195+ u32 len;196+ int err;197+ struct sk_buff *skb;198+199+ skb = skb_get(__skb);200+201+ if (skb->len >= NLMSG_SPACE(0)) {202+ nlh = (struct nlmsghdr *)skb->data;203+204+ if (nlh->nlmsg_len < sizeof(struct cn_msg) ||205+ skb->len < nlh->nlmsg_len ||206+ nlh->nlmsg_len > CONNECTOR_MAX_MSG_SIZE) {207+ kfree_skb(skb);208+ goto out;209+ }210+211+ len = NLMSG_ALIGN(nlh->nlmsg_len);212+ if (len > skb->len)213+ len = skb->len;214+215+ err = __cn_rx_skb(skb, nlh);216+ if (err < 0)217+ kfree_skb(skb);218+ }219+220+out:221+ kfree_skb(__skb);222+}223+224+/*225+ * Netlink socket input callback - dequeues the skbs and calls the226+ * main netlink receiving function.227+ */228+static void cn_input(struct sock *sk, int len)229+{230+ struct sk_buff *skb;231+232+ while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL)233+ cn_rx_skb(skb);234+}235+236+/*237+ * Notification routing.238+ *239+ * Gets id and checks if there are notification request for it's idx240+ * and val. If there are such requests notify the listeners with the241+ * given notify event.242+ *243+ */244+static void cn_notify(struct cb_id *id, u32 notify_event)245+{246+ struct cn_ctl_entry *ent;247+248+ down(¬ify_lock);249+ list_for_each_entry(ent, ¬ify_list, notify_entry) {250+ int i;251+ struct cn_notify_req *req;252+ struct cn_ctl_msg *ctl = ent->msg;253+ int idx_found, val_found;254+255+ idx_found = val_found = 0;256+257+ req = (struct cn_notify_req *)ctl->data;258+ for (i = 0; i < ctl->idx_notify_num; ++i, ++req) {259+ if (id->idx >= req->first && 260+ id->idx < req->first + req->range) {261+ idx_found = 1;262+ break;263+ }264+ }265+266+ for (i = 0; i < ctl->val_notify_num; ++i, ++req) {267+ if (id->val >= req->first && 268+ id->val < req->first + req->range) {269+ val_found = 1;270+ break;271+ }272+ }273+274+ if (idx_found && val_found) {275+ struct cn_msg m = { .ack = notify_event, };276+277+ memcpy(&m.id, id, sizeof(m.id));278+ cn_netlink_send(&m, ctl->group, GFP_KERNEL);279+ }280+ }281+ up(¬ify_lock);282+}283+284+/*285+ * Callback add routing - adds callback with given ID and name.286+ * If there is registered callback with the same ID it will not be added.287+ *288+ * May sleep.289+ */290+int cn_add_callback(struct cb_id *id, char *name, void (*callback)(void *))291+{292+ int err;293+ struct cn_dev *dev = &cdev;294+ struct cn_callback *cb;295+296+ cb = kzalloc(sizeof(*cb), GFP_KERNEL);297+ if (!cb)298+ return -ENOMEM;299+300+ scnprintf(cb->name, sizeof(cb->name), "%s", name);301+302+ memcpy(&cb->id, id, sizeof(cb->id));303+ cb->callback = callback;304+305+ err = cn_queue_add_callback(dev->cbdev, cb);306+ if (err) {307+ kfree(cb);308+ return err;309+ }310+311+ cn_notify(id, 0);312+313+ return 0;314+}315+316+/*317+ * Callback remove routing - removes callback318+ * with given ID.319+ * If there is no registered callback with given320+ * ID nothing happens.321+ *322+ * May sleep while waiting for reference counter to become zero.323+ */324+void cn_del_callback(struct cb_id *id)325+{326+ struct cn_dev *dev = &cdev;327+328+ cn_queue_del_callback(dev->cbdev, id);329+ cn_notify(id, 1);330+}331+332+/*333+ * Checks two connector's control messages to be the same.334+ * Returns 1 if they are the same or if the first one is corrupted.335+ */336+static int cn_ctl_msg_equals(struct cn_ctl_msg *m1, struct cn_ctl_msg *m2)337+{338+ int i;339+ struct cn_notify_req *req1, *req2;340+341+ if (m1->idx_notify_num != m2->idx_notify_num)342+ return 0;343+344+ if (m1->val_notify_num != m2->val_notify_num)345+ return 0;346+347+ if (m1->len != m2->len)348+ return 0;349+350+ if ((m1->idx_notify_num + m1->val_notify_num) * sizeof(*req1) !=351+ m1->len)352+ return 1;353+354+ req1 = (struct cn_notify_req *)m1->data;355+ req2 = (struct cn_notify_req *)m2->data;356+357+ for (i = 0; i < m1->idx_notify_num; ++i) {358+ if (req1->first != req2->first || req1->range != req2->range)359+ return 0;360+ req1++;361+ req2++;362+ }363+364+ for (i = 0; i < m1->val_notify_num; ++i) {365+ if (req1->first != req2->first || req1->range != req2->range)366+ return 0;367+ req1++;368+ req2++;369+ }370+371+ return 1;372+}373+374+/*375+ * Main connector device's callback.376+ *377+ * Used for notification of a request's processing.378+ */379+static void cn_callback(void *data)380+{381+ struct cn_msg *msg = data;382+ struct cn_ctl_msg *ctl;383+ struct cn_ctl_entry *ent;384+ u32 size;385+386+ if (msg->len < sizeof(*ctl))387+ return;388+389+ ctl = (struct cn_ctl_msg *)msg->data;390+391+ size = (sizeof(*ctl) + ((ctl->idx_notify_num +392+ ctl->val_notify_num) *393+ sizeof(struct cn_notify_req)));394+395+ if (msg->len != size)396+ return;397+398+ if (ctl->len + sizeof(*ctl) != msg->len)399+ return;400+401+ /*402+ * Remove notification.403+ */404+ if (ctl->group == 0) {405+ struct cn_ctl_entry *n;406+407+ down(¬ify_lock);408+ list_for_each_entry_safe(ent, n, ¬ify_list, notify_entry) {409+ if (cn_ctl_msg_equals(ent->msg, ctl)) {410+ list_del(&ent->notify_entry);411+ kfree(ent);412+ }413+ }414+ up(¬ify_lock);415+416+ return;417+ }418+419+ size += sizeof(*ent);420+421+ ent = kzalloc(size, GFP_KERNEL);422+ if (!ent)423+ return;424+425+ ent->msg = (struct cn_ctl_msg *)(ent + 1);426+427+ memcpy(ent->msg, ctl, size - sizeof(*ent));428+429+ down(¬ify_lock);430+ list_add(&ent->notify_entry, ¬ify_list);431+ up(¬ify_lock);432+}433+434+static int __init cn_init(void)435+{436+ struct cn_dev *dev = &cdev;437+ int err;438+439+ dev->input = cn_input;440+ dev->id.idx = cn_idx;441+ dev->id.val = cn_val;442+443+ dev->nls = netlink_kernel_create(NETLINK_CONNECTOR,444+ CN_NETLINK_USERS + 0xf,445+ dev->input, THIS_MODULE);446+ if (!dev->nls)447+ return -EIO;448+449+ dev->cbdev = cn_queue_alloc_dev("cqueue", dev->nls);450+ if (!dev->cbdev) {451+ if (dev->nls->sk_socket)452+ sock_release(dev->nls->sk_socket);453+ return -EINVAL;454+ }455+456+ err = cn_add_callback(&dev->id, "connector", &cn_callback);457+ if (err) {458+ cn_queue_free_dev(dev->cbdev);459+ if (dev->nls->sk_socket)460+ sock_release(dev->nls->sk_socket);461+ return -EINVAL;462+ }463+464+ cn_already_initialized = 1;465+466+ return 0;467+}468+469+static void __exit cn_fini(void)470+{471+ struct cn_dev *dev = &cdev;472+473+ cn_already_initialized = 0;474+475+ cn_del_callback(&dev->id);476+ cn_queue_free_dev(dev->cbdev);477+ if (dev->nls->sk_socket)478+ sock_release(dev->nls->sk_socket);479+}480+481+module_init(cn_init);482+module_exit(cn_fini);483+484+EXPORT_SYMBOL_GPL(cn_add_callback);485+EXPORT_SYMBOL_GPL(cn_del_callback);486+EXPORT_SYMBOL_GPL(cn_netlink_send);
+2
drivers/net/bnx2.c
···5015 .phys_id = bnx2_phys_id,5016 .get_stats_count = bnx2_get_stats_count,5017 .get_ethtool_stats = bnx2_get_ethtool_stats,05018};50195020/* Called with rtnl_lock */···5443 pci_set_drvdata(pdev, dev);54445445 memcpy(dev->dev_addr, bp->mac_addr, 6);05446 bp->name = board_info[ent->driver_data].name,5447 printk(KERN_INFO "%s: %s (%c%d) PCI%s %s %dMHz found at mem %lx, "5448 "IRQ %d, ",
···5015 .phys_id = bnx2_phys_id,5016 .get_stats_count = bnx2_get_stats_count,5017 .get_ethtool_stats = bnx2_get_ethtool_stats,5018+ .get_perm_addr = ethtool_op_get_perm_addr,5019};50205021/* Called with rtnl_lock */···5442 pci_set_drvdata(pdev, dev);54435444 memcpy(dev->dev_addr, bp->mac_addr, 6);5445+ memcpy(dev->perm_addr, bp->mac_addr, 6);5446 bp->name = board_info[ent->driver_data].name,5447 printk(KERN_INFO "%s: %s (%c%d) PCI%s %s %dMHz found at mem %lx, "5448 "IRQ %d, ",
···1+/*2+ * connector.h3+ * 4+ * 2004-2005 Copyright (c) Evgeniy Polyakov <johnpol@2ka.mipt.ru>5+ * All rights reserved.6+ * 7+ * This program is free software; you can redistribute it and/or modify8+ * it under the terms of the GNU General Public License as published by9+ * the Free Software Foundation; either version 2 of the License, or10+ * (at your option) any later version.11+ *12+ * This program is distributed in the hope that it will be useful,13+ * but WITHOUT ANY WARRANTY; without even the implied warranty of14+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the15+ * GNU General Public License for more details.16+ *17+ * You should have received a copy of the GNU General Public License18+ * along with this program; if not, write to the Free Software19+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA20+ */21+22+#ifndef __CONNECTOR_H23+#define __CONNECTOR_H24+25+#include <asm/types.h>26+27+#define CN_IDX_CONNECTOR 0xffffffff28+#define CN_VAL_CONNECTOR 0xffffffff29+30+#define CN_NETLINK_USERS 131+32+/*33+ * Maximum connector's message size.34+ */35+#define CONNECTOR_MAX_MSG_SIZE 102436+37+/*38+ * idx and val are unique identifiers which 39+ * are used for message routing and 40+ * must be registered in connector.h for in-kernel usage.41+ */42+43+struct cb_id {44+ __u32 idx;45+ __u32 val;46+};47+48+struct cn_msg {49+ struct cb_id id;50+51+ __u32 seq;52+ __u32 ack;53+54+ __u16 len; /* Length of the following data */55+ __u16 flags;56+ __u8 data[0];57+};58+59+/*60+ * Notify structure - requests notification about61+ * registering/unregistering idx/val in range [first, first+range].62+ */63+struct cn_notify_req {64+ __u32 first;65+ __u32 range;66+};67+68+/*69+ * Main notification control message70+ * *_notify_num - number of appropriate cn_notify_req structures after 71+ * this struct.72+ * group - notification receiver's idx.73+ * len - total length of the attached data.74+ */75+struct cn_ctl_msg {76+ __u32 idx_notify_num;77+ __u32 val_notify_num;78+ __u32 group;79+ __u32 len;80+ __u8 data[0];81+};82+83+#ifdef __KERNEL__84+85+#include <asm/atomic.h>86+87+#include <linux/list.h>88+#include <linux/workqueue.h>89+90+#include <net/sock.h>91+92+#define CN_CBQ_NAMELEN 3293+94+struct cn_queue_dev {95+ atomic_t refcnt;96+ unsigned char name[CN_CBQ_NAMELEN];97+98+ struct workqueue_struct *cn_queue;99+100+ struct list_head queue_list;101+ spinlock_t queue_lock;102+103+ int netlink_groups;104+ struct sock *nls;105+};106+107+struct cn_callback {108+ unsigned char name[CN_CBQ_NAMELEN];109+110+ struct cb_id id;111+ void (*callback) (void *);112+ void *priv;113+};114+115+struct cn_callback_entry {116+ struct list_head callback_entry;117+ struct cn_callback *cb;118+ struct work_struct work;119+ struct cn_queue_dev *pdev;120+121+ void (*destruct_data) (void *);122+ void *ddata;123+124+ int seq, group;125+ struct sock *nls;126+};127+128+struct cn_ctl_entry {129+ struct list_head notify_entry;130+ struct cn_ctl_msg *msg;131+};132+133+struct cn_dev {134+ struct cb_id id;135+136+ u32 seq, groups;137+ struct sock *nls;138+ void (*input) (struct sock * sk, int len);139+140+ struct cn_queue_dev *cbdev;141+};142+143+int cn_add_callback(struct cb_id *, char *, void (*callback) (void *));144+void cn_del_callback(struct cb_id *);145+int cn_netlink_send(struct cn_msg *, u32, int);146+147+int cn_queue_add_callback(struct cn_queue_dev *dev, struct cn_callback *cb);148+void cn_queue_del_callback(struct cn_queue_dev *dev, struct cb_id *id);149+150+struct cn_queue_dev *cn_queue_alloc_dev(char *name, struct sock *);151+void cn_queue_free_dev(struct cn_queue_dev *dev);152+153+int cn_cb_equal(struct cb_id *, struct cb_id *);154+155+extern int cn_already_initialized;156+157+#endif /* __KERNEL__ */158+#endif /* __CONNECTOR_H */
···1095{1096 const struct ccid3_hc_rx_sock *hcrx = ccid3_hc_rx_sk(sk);10971098+ /* Listen socks doesn't have a private CCID block */1099+ if (sk->sk_state == DCCP_LISTEN)1100+ return;1101+1102 BUG_ON(hcrx == NULL);11031104 info->tcpi_ca_state = hcrx->ccid3hcrx_state;···1105static void ccid3_hc_tx_get_info(struct sock *sk, struct tcp_info *info)1106{1107 const struct ccid3_hc_tx_sock *hctx = ccid3_hc_tx_sk(sk);1108+1109+ /* Listen socks doesn't have a private CCID block */1110+ if (sk->sk_state == DCCP_LISTEN)1111+ return;11121113 BUG_ON(hctx == NULL);1114
+2-4
net/ipv4/ipconfig.c
···1103#endif11041105 jiff = jiffies + (d->next ? CONF_INTER_TIMEOUT : timeout);1106- while (time_before(jiffies, jiff) && !ic_got_reply) {1107- set_current_state(TASK_UNINTERRUPTIBLE);1108- schedule_timeout(1);1109- }1110#ifdef IPCONFIG_DHCP1111 /* DHCP isn't done until we get a DHCPACK. */1112 if ((ic_got_reply & IC_BOOTP)
···1103#endif11041105 jiff = jiffies + (d->next ? CONF_INTER_TIMEOUT : timeout);1106+ while (time_before(jiffies, jiff) && !ic_got_reply)1107+ schedule_timeout_uninterruptible(1);001108#ifdef IPCONFIG_DHCP1109 /* DHCP isn't done until we get a DHCPACK. */1110 if ((ic_got_reply & IC_BOOTP)
+3-6
net/irda/ircomm/ircomm_tty.c
···567 self->tty = NULL;568569 if (self->blocked_open) {570- if (self->close_delay) {571- current->state = TASK_INTERRUPTIBLE;572- schedule_timeout(self->close_delay);573- }574 wake_up_interruptible(&self->open_wait);575 }576···861 spin_lock_irqsave(&self->spinlock, flags);862 while (self->tx_skb && self->tx_skb->len) {863 spin_unlock_irqrestore(&self->spinlock, flags);864- current->state = TASK_INTERRUPTIBLE;865- schedule_timeout(poll_time);866 spin_lock_irqsave(&self->spinlock, flags);867 if (signal_pending(current))868 break;
···567 self->tty = NULL;568569 if (self->blocked_open) {570+ if (self->close_delay)571+ schedule_timeout_interruptible(self->close_delay);00572 wake_up_interruptible(&self->open_wait);573 }574···863 spin_lock_irqsave(&self->spinlock, flags);864 while (self->tx_skb && self->tx_skb->len) {865 spin_unlock_irqrestore(&self->spinlock, flags);866+ schedule_timeout_interruptible(poll_time);0867 spin_lock_irqsave(&self->spinlock, flags);868 if (signal_pending(current))869 break;
+13-15
net/netrom/af_netrom.c
···56int sysctl_netrom_transport_no_activity_timeout = NR_DEFAULT_IDLE;57int sysctl_netrom_routing_control = NR_DEFAULT_ROUTING;58int sysctl_netrom_link_fails_count = NR_DEFAULT_FAILS;05960static unsigned short circuit = 0x101;61···909 if (frametype != NR_CONNREQ) {910 /*911 * Here it would be nice to be able to send a reset but912- * NET/ROM doesn't have one. The following hack would913- * have been a way to extend the protocol but apparently914- * it kills BPQ boxes... :-(000915 */916-#if 0917- /*918- * Never reply to a CONNACK/CHOKE.919- */920- if (frametype != NR_CONNACK || flags != NR_CHOKE_FLAG)921- nr_transmit_refusal(skb, 1);922-#endif923 return 0;924 }925···1188 }11891190 case SIOCGSTAMP:1191- ret = -EINVAL;1192- if (sk != NULL)1193- ret = sock_get_timestamp(sk, argp);1194 release_sock(sk);1195 return ret;1196···1392 struct net_device *dev;13931394 sprintf(name, "nr%d", i);1395- dev = alloc_netdev(sizeof(struct net_device_stats), name,1396- nr_setup);1397 if (!dev) {1398 printk(KERN_ERR "NET/ROM: nr_proto_init - unable to allocate device structure\n");1399 goto fail;
···56int sysctl_netrom_transport_no_activity_timeout = NR_DEFAULT_IDLE;57int sysctl_netrom_routing_control = NR_DEFAULT_ROUTING;58int sysctl_netrom_link_fails_count = NR_DEFAULT_FAILS;59+int sysctl_netrom_reset_circuit = NR_DEFAULT_RESET;6061static unsigned short circuit = 0x101;62···908 if (frametype != NR_CONNREQ) {909 /*910 * Here it would be nice to be able to send a reset but911+ * NET/ROM doesn't have one. We've tried to extend the protocol912+ * by sending NR_CONNACK | NR_CHOKE_FLAGS replies but that913+ * apparently kills BPQ boxes... :-(914+ * So now we try to follow the established behaviour of915+ * G8PZT's Xrouter which is sending packets with command type 7916+ * as an extension of the protocol.917 */918+ if (sysctl_netrom_reset_circuit &&919+ (frametype != NR_RESET || flags != 0))920+ nr_transmit_reset(skb, 1);921+000922 return 0;923 }924···1187 }11881189 case SIOCGSTAMP:1190+ ret = sock_get_timestamp(sk, argp);001191 release_sock(sk);1192 return ret;1193···1393 struct net_device *dev;13941395 sprintf(name, "nr%d", i);1396+ dev = alloc_netdev(sizeof(struct nr_private), name, nr_setup);01397 if (!dev) {1398 printk(KERN_ERR "NET/ROM: nr_proto_init - unable to allocate device structure\n");1399 goto fail;
···98 nr_disconnect(sk, ECONNREFUSED);99 break;100101+ case NR_RESET:102+ if (sysctl_netrom_reset_circuit);103+ nr_disconnect(sk, ECONNRESET);104+ break;105+106 default:107 break;108 }···122123 case NR_DISCACK:124 nr_disconnect(sk, 0);125+ break;126+127+ case NR_RESET:128+ if (sysctl_netrom_reset_circuit);129+ nr_disconnect(sk, ECONNRESET);130 break;131132 default:···252 nr_start_t2timer(sk);253 }254 }255+ break;256+257+ case NR_RESET:258+ if (sysctl_netrom_reset_circuit);259+ nr_disconnect(sk, ECONNRESET);260 break;261262 default:
+3-4
net/netrom/nr_subr.c
···210}211212/*213- * This routine is called when a Connect Acknowledge with the Choke Flag214- * set is needed to refuse a connection.215 */216-void nr_transmit_refusal(struct sk_buff *skb, int mine)217{218 struct sk_buff *skbn;219 unsigned char *dptr;···253 *dptr++ = 0;254 }255256- *dptr++ = NR_CONNACK | NR_CHOKE_FLAG;257 *dptr++ = 0;258259 if (!nr_route_frame(skbn, NULL))
···210}211212/*213+ * This routine is called to send an error reply.0214 */215+void __nr_transmit_reply(struct sk_buff *skb, int mine, unsigned char cmdflags)216{217 struct sk_buff *skbn;218 unsigned char *dptr;···254 *dptr++ = 0;255 }256257+ *dptr++ = cmdflags;258 *dptr++ = 0;259260 if (!nr_route_frame(skbn, NULL))
···1243 amount = sk->sk_sndbuf - atomic_read(&sk->sk_wmem_alloc);1244 if (amount < 0)1245 amount = 0;1246- return put_user(amount, (unsigned int __user *)argp);1247 }12481249 case TIOCINQ: {···1252 /* These two are safe on a single CPU system as only user tasks fiddle here */1253 if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)1254 amount = skb->len;1255- return put_user(amount, (unsigned int __user *)argp);1256 }12571258 case SIOCGSTAMP:1259- if (sk != NULL) 1260- return sock_get_timestamp(sk, (struct timeval __user *)argp);1261- return -EINVAL;12621263 case SIOCGIFADDR:1264 case SIOCSIFADDR:
···1243 amount = sk->sk_sndbuf - atomic_read(&sk->sk_wmem_alloc);1244 if (amount < 0)1245 amount = 0;1246+ return put_user(amount, (unsigned int __user *) argp);1247 }12481249 case TIOCINQ: {···1252 /* These two are safe on a single CPU system as only user tasks fiddle here */1253 if ((skb = skb_peek(&sk->sk_receive_queue)) != NULL)1254 amount = skb->len;1255+ return put_user(amount, (unsigned int __user *) argp);1256 }12571258 case SIOCGSTAMP:1259+ return sock_get_timestamp(sk, (struct timeval __user *) argp);0012601261 case SIOCGIFADDR:1262 case SIOCSIFADDR: