diff options
Diffstat (limited to 'drivers/connector')
-rw-r--r-- | drivers/connector/cn_queue.c | 3 | ||||
-rw-r--r-- | drivers/connector/connector.c | 11 |
2 files changed, 7 insertions, 7 deletions
diff --git a/drivers/connector/cn_queue.c b/drivers/connector/cn_queue.c index 4a1dfe1f4ba9..b4cfac93f723 100644 --- a/drivers/connector/cn_queue.c +++ b/drivers/connector/cn_queue.c | |||
@@ -78,8 +78,9 @@ void cn_queue_wrapper(struct work_struct *work) | |||
78 | struct cn_callback_entry *cbq = | 78 | struct cn_callback_entry *cbq = |
79 | container_of(work, struct cn_callback_entry, work); | 79 | container_of(work, struct cn_callback_entry, work); |
80 | struct cn_callback_data *d = &cbq->data; | 80 | struct cn_callback_data *d = &cbq->data; |
81 | struct cn_msg *msg = NLMSG_DATA(nlmsg_hdr(d->skb)); | ||
81 | 82 | ||
82 | d->callback(d->callback_priv); | 83 | d->callback(msg); |
83 | 84 | ||
84 | d->destruct_data(d->ddata); | 85 | d->destruct_data(d->ddata); |
85 | d->ddata = NULL; | 86 | d->ddata = NULL; |
diff --git a/drivers/connector/connector.c b/drivers/connector/connector.c index 74f52af79563..fc9887fa453f 100644 --- a/drivers/connector/connector.c +++ b/drivers/connector/connector.c | |||
@@ -129,10 +129,11 @@ EXPORT_SYMBOL_GPL(cn_netlink_send); | |||
129 | /* | 129 | /* |
130 | * Callback helper - queues work and setup destructor for given data. | 130 | * Callback helper - queues work and setup destructor for given data. |
131 | */ | 131 | */ |
132 | static int cn_call_callback(struct cn_msg *msg, void (*destruct_data)(void *), void *data) | 132 | static int cn_call_callback(struct sk_buff *skb, void (*destruct_data)(void *), void *data) |
133 | { | 133 | { |
134 | struct cn_callback_entry *__cbq, *__new_cbq; | 134 | struct cn_callback_entry *__cbq, *__new_cbq; |
135 | struct cn_dev *dev = &cdev; | 135 | struct cn_dev *dev = &cdev; |
136 | struct cn_msg *msg = NLMSG_DATA(nlmsg_hdr(skb)); | ||
136 | int err = -ENODEV; | 137 | int err = -ENODEV; |
137 | 138 | ||
138 | spin_lock_bh(&dev->cbdev->queue_lock); | 139 | spin_lock_bh(&dev->cbdev->queue_lock); |
@@ -140,7 +141,7 @@ static int cn_call_callback(struct cn_msg *msg, void (*destruct_data)(void *), v | |||
140 | if (cn_cb_equal(&__cbq->id.id, &msg->id)) { | 141 | if (cn_cb_equal(&__cbq->id.id, &msg->id)) { |
141 | if (likely(!work_pending(&__cbq->work) && | 142 | if (likely(!work_pending(&__cbq->work) && |
142 | __cbq->data.ddata == NULL)) { | 143 | __cbq->data.ddata == NULL)) { |
143 | __cbq->data.callback_priv = msg; | 144 | __cbq->data.skb = skb; |
144 | 145 | ||
145 | __cbq->data.ddata = data; | 146 | __cbq->data.ddata = data; |
146 | __cbq->data.destruct_data = destruct_data; | 147 | __cbq->data.destruct_data = destruct_data; |
@@ -156,7 +157,7 @@ static int cn_call_callback(struct cn_msg *msg, void (*destruct_data)(void *), v | |||
156 | __new_cbq = kzalloc(sizeof(struct cn_callback_entry), GFP_ATOMIC); | 157 | __new_cbq = kzalloc(sizeof(struct cn_callback_entry), GFP_ATOMIC); |
157 | if (__new_cbq) { | 158 | if (__new_cbq) { |
158 | d = &__new_cbq->data; | 159 | d = &__new_cbq->data; |
159 | d->callback_priv = msg; | 160 | d->skb = skb; |
160 | d->callback = __cbq->data.callback; | 161 | d->callback = __cbq->data.callback; |
161 | d->ddata = data; | 162 | d->ddata = data; |
162 | d->destruct_data = destruct_data; | 163 | d->destruct_data = destruct_data; |
@@ -191,7 +192,6 @@ static int cn_call_callback(struct cn_msg *msg, void (*destruct_data)(void *), v | |||
191 | */ | 192 | */ |
192 | static void cn_rx_skb(struct sk_buff *__skb) | 193 | static void cn_rx_skb(struct sk_buff *__skb) |
193 | { | 194 | { |
194 | struct cn_msg *msg; | ||
195 | struct nlmsghdr *nlh; | 195 | struct nlmsghdr *nlh; |
196 | int err; | 196 | int err; |
197 | struct sk_buff *skb; | 197 | struct sk_buff *skb; |
@@ -208,8 +208,7 @@ static void cn_rx_skb(struct sk_buff *__skb) | |||
208 | return; | 208 | return; |
209 | } | 209 | } |
210 | 210 | ||
211 | msg = NLMSG_DATA(nlh); | 211 | err = cn_call_callback(skb, (void (*)(void *))kfree_skb, skb); |
212 | err = cn_call_callback(msg, (void (*)(void *))kfree_skb, skb); | ||
213 | if (err < 0) | 212 | if (err < 0) |
214 | kfree_skb(skb); | 213 | kfree_skb(skb); |
215 | } | 214 | } |