ipc,msg: introduce msgctl_nolock
[profile/ivi/kernel-x86-ivi.git] / ipc / msg.c
1 /*
2  * linux/ipc/msg.c
3  * Copyright (C) 1992 Krishna Balasubramanian
4  *
5  * Removed all the remaining kerneld mess
6  * Catch the -EFAULT stuff properly
7  * Use GFP_KERNEL for messages as in 1.2
8  * Fixed up the unchecked user space derefs
9  * Copyright (C) 1998 Alan Cox & Andi Kleen
10  *
11  * /proc/sysvipc/msg support (c) 1999 Dragos Acostachioaie <dragos@iname.com>
12  *
13  * mostly rewritten, threaded and wake-one semantics added
14  * MSGMAX limit removed, sysctl's added
15  * (c) 1999 Manfred Spraul <manfred@colorfullife.com>
16  *
17  * support for audit of ipc object properties and permission changes
18  * Dustin Kirkland <dustin.kirkland@us.ibm.com>
19  *
20  * namespaces support
21  * OpenVZ, SWsoft Inc.
22  * Pavel Emelianov <xemul@openvz.org>
23  */
24
25 #include <linux/capability.h>
26 #include <linux/msg.h>
27 #include <linux/spinlock.h>
28 #include <linux/init.h>
29 #include <linux/mm.h>
30 #include <linux/proc_fs.h>
31 #include <linux/list.h>
32 #include <linux/security.h>
33 #include <linux/sched.h>
34 #include <linux/syscalls.h>
35 #include <linux/audit.h>
36 #include <linux/seq_file.h>
37 #include <linux/rwsem.h>
38 #include <linux/nsproxy.h>
39 #include <linux/ipc_namespace.h>
40
41 #include <asm/current.h>
42 #include <asm/uaccess.h>
43 #include "util.h"
44
45 /*
46  * one msg_receiver structure for each sleeping receiver:
47  */
48 struct msg_receiver {
49         struct list_head        r_list;
50         struct task_struct      *r_tsk;
51
52         int                     r_mode;
53         long                    r_msgtype;
54         long                    r_maxsize;
55
56         struct msg_msg          *volatile r_msg;
57 };
58
59 /* one msg_sender for each sleeping sender */
60 struct msg_sender {
61         struct list_head        list;
62         struct task_struct      *tsk;
63 };
64
65 #define SEARCH_ANY              1
66 #define SEARCH_EQUAL            2
67 #define SEARCH_NOTEQUAL         3
68 #define SEARCH_LESSEQUAL        4
69 #define SEARCH_NUMBER           5
70
71 #define msg_ids(ns)     ((ns)->ids[IPC_MSG_IDS])
72
73 #define msg_unlock(msq)         ipc_unlock(&(msq)->q_perm)
74
75 static void freeque(struct ipc_namespace *, struct kern_ipc_perm *);
76 static int newque(struct ipc_namespace *, struct ipc_params *);
77 #ifdef CONFIG_PROC_FS
78 static int sysvipc_msg_proc_show(struct seq_file *s, void *it);
79 #endif
80
81 /*
82  * Scale msgmni with the available lowmem size: the memory dedicated to msg
83  * queues should occupy at most 1/MSG_MEM_SCALE of lowmem.
84  * Also take into account the number of nsproxies created so far.
85  * This should be done staying within the (MSGMNI , IPCMNI/nr_ipc_ns) range.
86  */
87 void recompute_msgmni(struct ipc_namespace *ns)
88 {
89         struct sysinfo i;
90         unsigned long allowed;
91         int nb_ns;
92
93         si_meminfo(&i);
94         allowed = (((i.totalram - i.totalhigh) / MSG_MEM_SCALE) * i.mem_unit)
95                 / MSGMNB;
96         nb_ns = atomic_read(&nr_ipc_ns);
97         allowed /= nb_ns;
98
99         if (allowed < MSGMNI) {
100                 ns->msg_ctlmni = MSGMNI;
101                 return;
102         }
103
104         if (allowed > IPCMNI / nb_ns) {
105                 ns->msg_ctlmni = IPCMNI / nb_ns;
106                 return;
107         }
108
109         ns->msg_ctlmni = allowed;
110 }
111
112 void msg_init_ns(struct ipc_namespace *ns)
113 {
114         ns->msg_ctlmax = MSGMAX;
115         ns->msg_ctlmnb = MSGMNB;
116
117         recompute_msgmni(ns);
118
119         atomic_set(&ns->msg_bytes, 0);
120         atomic_set(&ns->msg_hdrs, 0);
121         ipc_init_ids(&ns->ids[IPC_MSG_IDS]);
122 }
123
124 #ifdef CONFIG_IPC_NS
125 void msg_exit_ns(struct ipc_namespace *ns)
126 {
127         free_ipcs(ns, &msg_ids(ns), freeque);
128         idr_destroy(&ns->ids[IPC_MSG_IDS].ipcs_idr);
129 }
130 #endif
131
132 void __init msg_init(void)
133 {
134         msg_init_ns(&init_ipc_ns);
135
136         printk(KERN_INFO "msgmni has been set to %d\n",
137                 init_ipc_ns.msg_ctlmni);
138
139         ipc_init_proc_interface("sysvipc/msg",
140                                 "       key      msqid perms      cbytes       qnum lspid lrpid   uid   gid  cuid  cgid      stime      rtime      ctime\n",
141                                 IPC_MSG_IDS, sysvipc_msg_proc_show);
142 }
143
144 /*
145  * msg_lock_(check_) routines are called in the paths where the rw_mutex
146  * is not held.
147  */
148 static inline struct msg_queue *msg_lock(struct ipc_namespace *ns, int id)
149 {
150         struct kern_ipc_perm *ipcp = ipc_lock(&msg_ids(ns), id);
151
152         if (IS_ERR(ipcp))
153                 return (struct msg_queue *)ipcp;
154
155         return container_of(ipcp, struct msg_queue, q_perm);
156 }
157
158 static inline struct msg_queue *msg_lock_check(struct ipc_namespace *ns,
159                                                 int id)
160 {
161         struct kern_ipc_perm *ipcp = ipc_lock_check(&msg_ids(ns), id);
162
163         if (IS_ERR(ipcp))
164                 return (struct msg_queue *)ipcp;
165
166         return container_of(ipcp, struct msg_queue, q_perm);
167 }
168
169 static inline void msg_rmid(struct ipc_namespace *ns, struct msg_queue *s)
170 {
171         ipc_rmid(&msg_ids(ns), &s->q_perm);
172 }
173
174 /**
175  * newque - Create a new msg queue
176  * @ns: namespace
177  * @params: ptr to the structure that contains the key and msgflg
178  *
179  * Called with msg_ids.rw_mutex held (writer)
180  */
181 static int newque(struct ipc_namespace *ns, struct ipc_params *params)
182 {
183         struct msg_queue *msq;
184         int id, retval;
185         key_t key = params->key;
186         int msgflg = params->flg;
187
188         msq = ipc_rcu_alloc(sizeof(*msq));
189         if (!msq)
190                 return -ENOMEM;
191
192         msq->q_perm.mode = msgflg & S_IRWXUGO;
193         msq->q_perm.key = key;
194
195         msq->q_perm.security = NULL;
196         retval = security_msg_queue_alloc(msq);
197         if (retval) {
198                 ipc_rcu_putref(msq);
199                 return retval;
200         }
201
202         /* ipc_addid() locks msq upon success. */
203         id = ipc_addid(&msg_ids(ns), &msq->q_perm, ns->msg_ctlmni);
204         if (id < 0) {
205                 security_msg_queue_free(msq);
206                 ipc_rcu_putref(msq);
207                 return id;
208         }
209
210         msq->q_stime = msq->q_rtime = 0;
211         msq->q_ctime = get_seconds();
212         msq->q_cbytes = msq->q_qnum = 0;
213         msq->q_qbytes = ns->msg_ctlmnb;
214         msq->q_lspid = msq->q_lrpid = 0;
215         INIT_LIST_HEAD(&msq->q_messages);
216         INIT_LIST_HEAD(&msq->q_receivers);
217         INIT_LIST_HEAD(&msq->q_senders);
218
219         ipc_unlock_object(&msq->q_perm);
220         rcu_read_unlock();
221
222         return msq->q_perm.id;
223 }
224
225 static inline void ss_add(struct msg_queue *msq, struct msg_sender *mss)
226 {
227         mss->tsk = current;
228         current->state = TASK_INTERRUPTIBLE;
229         list_add_tail(&mss->list, &msq->q_senders);
230 }
231
232 static inline void ss_del(struct msg_sender *mss)
233 {
234         if (mss->list.next != NULL)
235                 list_del(&mss->list);
236 }
237
238 static void ss_wakeup(struct list_head *h, int kill)
239 {
240         struct msg_sender *mss, *t;
241
242         list_for_each_entry_safe(mss, t, h, list) {
243                 if (kill)
244                         mss->list.next = NULL;
245                 wake_up_process(mss->tsk);
246         }
247 }
248
249 static void expunge_all(struct msg_queue *msq, int res)
250 {
251         struct msg_receiver *msr, *t;
252
253         list_for_each_entry_safe(msr, t, &msq->q_receivers, r_list) {
254                 msr->r_msg = NULL;
255                 wake_up_process(msr->r_tsk);
256                 smp_mb();
257                 msr->r_msg = ERR_PTR(res);
258         }
259 }
260
261 /*
262  * freeque() wakes up waiters on the sender and receiver waiting queue,
263  * removes the message queue from message queue ID IDR, and cleans up all the
264  * messages associated with this queue.
265  *
266  * msg_ids.rw_mutex (writer) and the spinlock for this message queue are held
267  * before freeque() is called. msg_ids.rw_mutex remains locked on exit.
268  */
269 static void freeque(struct ipc_namespace *ns, struct kern_ipc_perm *ipcp)
270 {
271         struct msg_msg *msg, *t;
272         struct msg_queue *msq = container_of(ipcp, struct msg_queue, q_perm);
273
274         expunge_all(msq, -EIDRM);
275         ss_wakeup(&msq->q_senders, 1);
276         msg_rmid(ns, msq);
277         msg_unlock(msq);
278
279         list_for_each_entry_safe(msg, t, &msq->q_messages, m_list) {
280                 atomic_dec(&ns->msg_hdrs);
281                 free_msg(msg);
282         }
283         atomic_sub(msq->q_cbytes, &ns->msg_bytes);
284         security_msg_queue_free(msq);
285         ipc_rcu_putref(msq);
286 }
287
288 /*
289  * Called with msg_ids.rw_mutex and ipcp locked.
290  */
291 static inline int msg_security(struct kern_ipc_perm *ipcp, int msgflg)
292 {
293         struct msg_queue *msq = container_of(ipcp, struct msg_queue, q_perm);
294
295         return security_msg_queue_associate(msq, msgflg);
296 }
297
298 SYSCALL_DEFINE2(msgget, key_t, key, int, msgflg)
299 {
300         struct ipc_namespace *ns;
301         struct ipc_ops msg_ops;
302         struct ipc_params msg_params;
303
304         ns = current->nsproxy->ipc_ns;
305
306         msg_ops.getnew = newque;
307         msg_ops.associate = msg_security;
308         msg_ops.more_checks = NULL;
309
310         msg_params.key = key;
311         msg_params.flg = msgflg;
312
313         return ipcget(ns, &msg_ids(ns), &msg_ops, &msg_params);
314 }
315
316 static inline unsigned long
317 copy_msqid_to_user(void __user *buf, struct msqid64_ds *in, int version)
318 {
319         switch(version) {
320         case IPC_64:
321                 return copy_to_user(buf, in, sizeof(*in));
322         case IPC_OLD:
323         {
324                 struct msqid_ds out;
325
326                 memset(&out, 0, sizeof(out));
327
328                 ipc64_perm_to_ipc_perm(&in->msg_perm, &out.msg_perm);
329
330                 out.msg_stime           = in->msg_stime;
331                 out.msg_rtime           = in->msg_rtime;
332                 out.msg_ctime           = in->msg_ctime;
333
334                 if (in->msg_cbytes > USHRT_MAX)
335                         out.msg_cbytes  = USHRT_MAX;
336                 else
337                         out.msg_cbytes  = in->msg_cbytes;
338                 out.msg_lcbytes         = in->msg_cbytes;
339
340                 if (in->msg_qnum > USHRT_MAX)
341                         out.msg_qnum    = USHRT_MAX;
342                 else
343                         out.msg_qnum    = in->msg_qnum;
344
345                 if (in->msg_qbytes > USHRT_MAX)
346                         out.msg_qbytes  = USHRT_MAX;
347                 else
348                         out.msg_qbytes  = in->msg_qbytes;
349                 out.msg_lqbytes         = in->msg_qbytes;
350
351                 out.msg_lspid           = in->msg_lspid;
352                 out.msg_lrpid           = in->msg_lrpid;
353
354                 return copy_to_user(buf, &out, sizeof(out));
355         }
356         default:
357                 return -EINVAL;
358         }
359 }
360
361 static inline unsigned long
362 copy_msqid_from_user(struct msqid64_ds *out, void __user *buf, int version)
363 {
364         switch(version) {
365         case IPC_64:
366                 if (copy_from_user(out, buf, sizeof(*out)))
367                         return -EFAULT;
368                 return 0;
369         case IPC_OLD:
370         {
371                 struct msqid_ds tbuf_old;
372
373                 if (copy_from_user(&tbuf_old, buf, sizeof(tbuf_old)))
374                         return -EFAULT;
375
376                 out->msg_perm.uid       = tbuf_old.msg_perm.uid;
377                 out->msg_perm.gid       = tbuf_old.msg_perm.gid;
378                 out->msg_perm.mode      = tbuf_old.msg_perm.mode;
379
380                 if (tbuf_old.msg_qbytes == 0)
381                         out->msg_qbytes = tbuf_old.msg_lqbytes;
382                 else
383                         out->msg_qbytes = tbuf_old.msg_qbytes;
384
385                 return 0;
386         }
387         default:
388                 return -EINVAL;
389         }
390 }
391
392 /*
393  * This function handles some msgctl commands which require the rw_mutex
394  * to be held in write mode.
395  * NOTE: no locks must be held, the rw_mutex is taken inside this function.
396  */
397 static int msgctl_down(struct ipc_namespace *ns, int msqid, int cmd,
398                        struct msqid_ds __user *buf, int version)
399 {
400         struct kern_ipc_perm *ipcp;
401         struct msqid64_ds uninitialized_var(msqid64);
402         struct msg_queue *msq;
403         int err;
404
405         if (cmd == IPC_SET) {
406                 if (copy_msqid_from_user(&msqid64, buf, version))
407                         return -EFAULT;
408         }
409
410         down_write(&msg_ids(ns).rw_mutex);
411         rcu_read_lock();
412
413         ipcp = ipcctl_pre_down_nolock(ns, &msg_ids(ns), msqid, cmd,
414                                       &msqid64.msg_perm, msqid64.msg_qbytes);
415         if (IS_ERR(ipcp)) {
416                 err = PTR_ERR(ipcp);
417                 goto out_unlock1;
418         }
419
420         msq = container_of(ipcp, struct msg_queue, q_perm);
421
422         err = security_msg_queue_msgctl(msq, cmd);
423         if (err)
424                 goto out_unlock1;
425
426         switch (cmd) {
427         case IPC_RMID:
428                 ipc_lock_object(&msq->q_perm);
429                 /* freeque unlocks the ipc object and rcu */
430                 freeque(ns, ipcp);
431                 goto out_up;
432         case IPC_SET:
433                 if (msqid64.msg_qbytes > ns->msg_ctlmnb &&
434                     !capable(CAP_SYS_RESOURCE)) {
435                         err = -EPERM;
436                         goto out_unlock1;
437                 }
438
439                 ipc_lock_object(&msq->q_perm);
440                 err = ipc_update_perm(&msqid64.msg_perm, ipcp);
441                 if (err)
442                         goto out_unlock0;
443
444                 msq->q_qbytes = msqid64.msg_qbytes;
445
446                 msq->q_ctime = get_seconds();
447                 /* sleeping receivers might be excluded by
448                  * stricter permissions.
449                  */
450                 expunge_all(msq, -EAGAIN);
451                 /* sleeping senders might be able to send
452                  * due to a larger queue size.
453                  */
454                 ss_wakeup(&msq->q_senders, 0);
455                 break;
456         default:
457                 err = -EINVAL;
458                 goto out_unlock1;
459         }
460
461 out_unlock0:
462         ipc_unlock_object(&msq->q_perm);
463 out_unlock1:
464         rcu_read_unlock();
465 out_up:
466         up_write(&msg_ids(ns).rw_mutex);
467         return err;
468 }
469
470 static int msgctl_nolock(struct ipc_namespace *ns, int msqid,
471                          int cmd, int version, void __user *buf)
472 {
473         int err;
474         struct msg_queue *msq;
475
476         switch (cmd) {
477         case IPC_INFO:
478         case MSG_INFO:
479         {
480                 struct msginfo msginfo;
481                 int max_id;
482
483                 if (!buf)
484                         return -EFAULT;
485
486                 /*
487                  * We must not return kernel stack data.
488                  * due to padding, it's not enough
489                  * to set all member fields.
490                  */
491                 err = security_msg_queue_msgctl(NULL, cmd);
492                 if (err)
493                         return err;
494
495                 memset(&msginfo, 0, sizeof(msginfo));
496                 msginfo.msgmni = ns->msg_ctlmni;
497                 msginfo.msgmax = ns->msg_ctlmax;
498                 msginfo.msgmnb = ns->msg_ctlmnb;
499                 msginfo.msgssz = MSGSSZ;
500                 msginfo.msgseg = MSGSEG;
501                 down_read(&msg_ids(ns).rw_mutex);
502                 if (cmd == MSG_INFO) {
503                         msginfo.msgpool = msg_ids(ns).in_use;
504                         msginfo.msgmap = atomic_read(&ns->msg_hdrs);
505                         msginfo.msgtql = atomic_read(&ns->msg_bytes);
506                 } else {
507                         msginfo.msgmap = MSGMAP;
508                         msginfo.msgpool = MSGPOOL;
509                         msginfo.msgtql = MSGTQL;
510                 }
511                 max_id = ipc_get_maxid(&msg_ids(ns));
512                 up_read(&msg_ids(ns).rw_mutex);
513                 if (copy_to_user(buf, &msginfo, sizeof(struct msginfo)))
514                         return -EFAULT;
515                 return (max_id < 0) ? 0 : max_id;
516         }
517
518         case MSG_STAT:
519         case IPC_STAT:
520         {
521                 struct msqid64_ds tbuf;
522                 int success_return;
523
524                 if (!buf)
525                         return -EFAULT;
526
527                 if (cmd == MSG_STAT) {
528                         msq = msg_lock(ns, msqid);
529                         if (IS_ERR(msq))
530                                 return PTR_ERR(msq);
531                         success_return = msq->q_perm.id;
532                 } else {
533                         msq = msg_lock_check(ns, msqid);
534                         if (IS_ERR(msq))
535                                 return PTR_ERR(msq);
536                         success_return = 0;
537                 }
538                 err = -EACCES;
539                 if (ipcperms(ns, &msq->q_perm, S_IRUGO))
540                         goto out_unlock;
541
542                 err = security_msg_queue_msgctl(msq, cmd);
543                 if (err)
544                         goto out_unlock;
545
546                 memset(&tbuf, 0, sizeof(tbuf));
547
548                 kernel_to_ipc64_perm(&msq->q_perm, &tbuf.msg_perm);
549                 tbuf.msg_stime  = msq->q_stime;
550                 tbuf.msg_rtime  = msq->q_rtime;
551                 tbuf.msg_ctime  = msq->q_ctime;
552                 tbuf.msg_cbytes = msq->q_cbytes;
553                 tbuf.msg_qnum   = msq->q_qnum;
554                 tbuf.msg_qbytes = msq->q_qbytes;
555                 tbuf.msg_lspid  = msq->q_lspid;
556                 tbuf.msg_lrpid  = msq->q_lrpid;
557                 msg_unlock(msq);
558                 if (copy_msqid_to_user(buf, &tbuf, version))
559                         return -EFAULT;
560                 return success_return;
561         }
562
563         default:
564                 return -EINVAL;
565         }
566
567         return err;
568 out_unlock:
569         msg_unlock(msq);
570         return err;
571 }
572
573 SYSCALL_DEFINE3(msgctl, int, msqid, int, cmd, struct msqid_ds __user *, buf)
574 {
575         int version;
576         struct ipc_namespace *ns;
577
578         if (msqid < 0 || cmd < 0)
579                 return -EINVAL;
580
581         version = ipc_parse_version(&cmd);
582         ns = current->nsproxy->ipc_ns;
583
584         switch (cmd) {
585         case IPC_INFO:
586         case MSG_INFO:
587         case MSG_STAT:  /* msqid is an index rather than a msg queue id */
588         case IPC_STAT:
589                 return msgctl_nolock(ns, msqid, cmd, version, buf);
590         case IPC_SET:
591         case IPC_RMID:
592                 return msgctl_down(ns, msqid, cmd, buf, version);
593         default:
594                 return  -EINVAL;
595         }
596 }
597
598 static int testmsg(struct msg_msg *msg, long type, int mode)
599 {
600         switch(mode)
601         {
602                 case SEARCH_ANY:
603                 case SEARCH_NUMBER:
604                         return 1;
605                 case SEARCH_LESSEQUAL:
606                         if (msg->m_type <=type)
607                                 return 1;
608                         break;
609                 case SEARCH_EQUAL:
610                         if (msg->m_type == type)
611                                 return 1;
612                         break;
613                 case SEARCH_NOTEQUAL:
614                         if (msg->m_type != type)
615                                 return 1;
616                         break;
617         }
618         return 0;
619 }
620
621 static inline int pipelined_send(struct msg_queue *msq, struct msg_msg *msg)
622 {
623         struct msg_receiver *msr, *t;
624
625         list_for_each_entry_safe(msr, t, &msq->q_receivers, r_list) {
626                 if (testmsg(msg, msr->r_msgtype, msr->r_mode) &&
627                     !security_msg_queue_msgrcv(msq, msg, msr->r_tsk,
628                                                msr->r_msgtype, msr->r_mode)) {
629
630                         list_del(&msr->r_list);
631                         if (msr->r_maxsize < msg->m_ts) {
632                                 msr->r_msg = NULL;
633                                 wake_up_process(msr->r_tsk);
634                                 smp_mb();
635                                 msr->r_msg = ERR_PTR(-E2BIG);
636                         } else {
637                                 msr->r_msg = NULL;
638                                 msq->q_lrpid = task_pid_vnr(msr->r_tsk);
639                                 msq->q_rtime = get_seconds();
640                                 wake_up_process(msr->r_tsk);
641                                 smp_mb();
642                                 msr->r_msg = msg;
643
644                                 return 1;
645                         }
646                 }
647         }
648         return 0;
649 }
650
651 long do_msgsnd(int msqid, long mtype, void __user *mtext,
652                 size_t msgsz, int msgflg)
653 {
654         struct msg_queue *msq;
655         struct msg_msg *msg;
656         int err;
657         struct ipc_namespace *ns;
658
659         ns = current->nsproxy->ipc_ns;
660
661         if (msgsz > ns->msg_ctlmax || (long) msgsz < 0 || msqid < 0)
662                 return -EINVAL;
663         if (mtype < 1)
664                 return -EINVAL;
665
666         msg = load_msg(mtext, msgsz);
667         if (IS_ERR(msg))
668                 return PTR_ERR(msg);
669
670         msg->m_type = mtype;
671         msg->m_ts = msgsz;
672
673         msq = msg_lock_check(ns, msqid);
674         if (IS_ERR(msq)) {
675                 err = PTR_ERR(msq);
676                 goto out_free;
677         }
678
679         for (;;) {
680                 struct msg_sender s;
681
682                 err = -EACCES;
683                 if (ipcperms(ns, &msq->q_perm, S_IWUGO))
684                         goto out_unlock_free;
685
686                 err = security_msg_queue_msgsnd(msq, msg, msgflg);
687                 if (err)
688                         goto out_unlock_free;
689
690                 if (msgsz + msq->q_cbytes <= msq->q_qbytes &&
691                                 1 + msq->q_qnum <= msq->q_qbytes) {
692                         break;
693                 }
694
695                 /* queue full, wait: */
696                 if (msgflg & IPC_NOWAIT) {
697                         err = -EAGAIN;
698                         goto out_unlock_free;
699                 }
700                 ss_add(msq, &s);
701
702                 if (!ipc_rcu_getref(msq)) {
703                         err = -EIDRM;
704                         goto out_unlock_free;
705                 }
706
707                 msg_unlock(msq);
708                 schedule();
709
710                 ipc_lock_by_ptr(&msq->q_perm);
711                 ipc_rcu_putref(msq);
712                 if (msq->q_perm.deleted) {
713                         err = -EIDRM;
714                         goto out_unlock_free;
715                 }
716                 ss_del(&s);
717
718                 if (signal_pending(current)) {
719                         err = -ERESTARTNOHAND;
720                         goto out_unlock_free;
721                 }
722         }
723
724         msq->q_lspid = task_tgid_vnr(current);
725         msq->q_stime = get_seconds();
726
727         if (!pipelined_send(msq, msg)) {
728                 /* no one is waiting for this message, enqueue it */
729                 list_add_tail(&msg->m_list, &msq->q_messages);
730                 msq->q_cbytes += msgsz;
731                 msq->q_qnum++;
732                 atomic_add(msgsz, &ns->msg_bytes);
733                 atomic_inc(&ns->msg_hdrs);
734         }
735
736         err = 0;
737         msg = NULL;
738
739 out_unlock_free:
740         msg_unlock(msq);
741 out_free:
742         if (msg != NULL)
743                 free_msg(msg);
744         return err;
745 }
746
747 SYSCALL_DEFINE4(msgsnd, int, msqid, struct msgbuf __user *, msgp, size_t, msgsz,
748                 int, msgflg)
749 {
750         long mtype;
751
752         if (get_user(mtype, &msgp->mtype))
753                 return -EFAULT;
754         return do_msgsnd(msqid, mtype, msgp->mtext, msgsz, msgflg);
755 }
756
757 static inline int convert_mode(long *msgtyp, int msgflg)
758 {
759         if (msgflg & MSG_COPY)
760                 return SEARCH_NUMBER;
761         /*
762          *  find message of correct type.
763          *  msgtyp = 0 => get first.
764          *  msgtyp > 0 => get first message of matching type.
765          *  msgtyp < 0 => get message with least type must be < abs(msgtype).
766          */
767         if (*msgtyp == 0)
768                 return SEARCH_ANY;
769         if (*msgtyp < 0) {
770                 *msgtyp = -*msgtyp;
771                 return SEARCH_LESSEQUAL;
772         }
773         if (msgflg & MSG_EXCEPT)
774                 return SEARCH_NOTEQUAL;
775         return SEARCH_EQUAL;
776 }
777
778 static long do_msg_fill(void __user *dest, struct msg_msg *msg, size_t bufsz)
779 {
780         struct msgbuf __user *msgp = dest;
781         size_t msgsz;
782
783         if (put_user(msg->m_type, &msgp->mtype))
784                 return -EFAULT;
785
786         msgsz = (bufsz > msg->m_ts) ? msg->m_ts : bufsz;
787         if (store_msg(msgp->mtext, msg, msgsz))
788                 return -EFAULT;
789         return msgsz;
790 }
791
792 #ifdef CONFIG_CHECKPOINT_RESTORE
793 /*
794  * This function creates new kernel message structure, large enough to store
795  * bufsz message bytes.
796  */
797 static inline struct msg_msg *prepare_copy(void __user *buf, size_t bufsz)
798 {
799         struct msg_msg *copy;
800
801         /*
802          * Create dummy message to copy real message to.
803          */
804         copy = load_msg(buf, bufsz);
805         if (!IS_ERR(copy))
806                 copy->m_ts = bufsz;
807         return copy;
808 }
809
810 static inline void free_copy(struct msg_msg *copy)
811 {
812         if (copy)
813                 free_msg(copy);
814 }
815 #else
816 static inline struct msg_msg *prepare_copy(void __user *buf, size_t bufsz)
817 {
818         return ERR_PTR(-ENOSYS);
819 }
820
821 static inline void free_copy(struct msg_msg *copy)
822 {
823 }
824 #endif
825
826 static struct msg_msg *find_msg(struct msg_queue *msq, long *msgtyp, int mode)
827 {
828         struct msg_msg *msg;
829         long count = 0;
830
831         list_for_each_entry(msg, &msq->q_messages, m_list) {
832                 if (testmsg(msg, *msgtyp, mode) &&
833                     !security_msg_queue_msgrcv(msq, msg, current,
834                                                *msgtyp, mode)) {
835                         if (mode == SEARCH_LESSEQUAL && msg->m_type != 1) {
836                                 *msgtyp = msg->m_type - 1;
837                         } else if (mode == SEARCH_NUMBER) {
838                                 if (*msgtyp == count)
839                                         return msg;
840                         } else
841                                 return msg;
842                         count++;
843                 }
844         }
845
846         return ERR_PTR(-EAGAIN);
847 }
848
849
850 long do_msgrcv(int msqid, void __user *buf, size_t bufsz, long msgtyp,
851                int msgflg,
852                long (*msg_handler)(void __user *, struct msg_msg *, size_t))
853 {
854         struct msg_queue *msq;
855         struct msg_msg *msg;
856         int mode;
857         struct ipc_namespace *ns;
858         struct msg_msg *copy = NULL;
859
860         ns = current->nsproxy->ipc_ns;
861
862         if (msqid < 0 || (long) bufsz < 0)
863                 return -EINVAL;
864         if (msgflg & MSG_COPY) {
865                 copy = prepare_copy(buf, min_t(size_t, bufsz, ns->msg_ctlmax));
866                 if (IS_ERR(copy))
867                         return PTR_ERR(copy);
868         }
869         mode = convert_mode(&msgtyp, msgflg);
870
871         msq = msg_lock_check(ns, msqid);
872         if (IS_ERR(msq)) {
873                 free_copy(copy);
874                 return PTR_ERR(msq);
875         }
876
877         for (;;) {
878                 struct msg_receiver msr_d;
879
880                 msg = ERR_PTR(-EACCES);
881                 if (ipcperms(ns, &msq->q_perm, S_IRUGO))
882                         goto out_unlock;
883
884                 msg = find_msg(msq, &msgtyp, mode);
885
886                 if (!IS_ERR(msg)) {
887                         /*
888                          * Found a suitable message.
889                          * Unlink it from the queue.
890                          */
891                         if ((bufsz < msg->m_ts) && !(msgflg & MSG_NOERROR)) {
892                                 msg = ERR_PTR(-E2BIG);
893                                 goto out_unlock;
894                         }
895                         /*
896                          * If we are copying, then do not unlink message and do
897                          * not update queue parameters.
898                          */
899                         if (msgflg & MSG_COPY) {
900                                 msg = copy_msg(msg, copy);
901                                 goto out_unlock;
902                         }
903                         list_del(&msg->m_list);
904                         msq->q_qnum--;
905                         msq->q_rtime = get_seconds();
906                         msq->q_lrpid = task_tgid_vnr(current);
907                         msq->q_cbytes -= msg->m_ts;
908                         atomic_sub(msg->m_ts, &ns->msg_bytes);
909                         atomic_dec(&ns->msg_hdrs);
910                         ss_wakeup(&msq->q_senders, 0);
911                         msg_unlock(msq);
912                         break;
913                 }
914                 /* No message waiting. Wait for a message */
915                 if (msgflg & IPC_NOWAIT) {
916                         msg = ERR_PTR(-ENOMSG);
917                         goto out_unlock;
918                 }
919                 list_add_tail(&msr_d.r_list, &msq->q_receivers);
920                 msr_d.r_tsk = current;
921                 msr_d.r_msgtype = msgtyp;
922                 msr_d.r_mode = mode;
923                 if (msgflg & MSG_NOERROR)
924                         msr_d.r_maxsize = INT_MAX;
925                 else
926                         msr_d.r_maxsize = bufsz;
927                 msr_d.r_msg = ERR_PTR(-EAGAIN);
928                 current->state = TASK_INTERRUPTIBLE;
929                 msg_unlock(msq);
930
931                 schedule();
932
933                 /* Lockless receive, part 1:
934                  * Disable preemption.  We don't hold a reference to the queue
935                  * and getting a reference would defeat the idea of a lockless
936                  * operation, thus the code relies on rcu to guarantee the
937                  * existence of msq:
938                  * Prior to destruction, expunge_all(-EIRDM) changes r_msg.
939                  * Thus if r_msg is -EAGAIN, then the queue not yet destroyed.
940                  * rcu_read_lock() prevents preemption between reading r_msg
941                  * and the spin_lock() inside ipc_lock_by_ptr().
942                  */
943                 rcu_read_lock();
944
945                 /* Lockless receive, part 2:
946                  * Wait until pipelined_send or expunge_all are outside of
947                  * wake_up_process(). There is a race with exit(), see
948                  * ipc/mqueue.c for the details.
949                  */
950                 msg = (struct msg_msg*)msr_d.r_msg;
951                 while (msg == NULL) {
952                         cpu_relax();
953                         msg = (struct msg_msg *)msr_d.r_msg;
954                 }
955
956                 /* Lockless receive, part 3:
957                  * If there is a message or an error then accept it without
958                  * locking.
959                  */
960                 if (msg != ERR_PTR(-EAGAIN)) {
961                         rcu_read_unlock();
962                         break;
963                 }
964
965                 /* Lockless receive, part 3:
966                  * Acquire the queue spinlock.
967                  */
968                 ipc_lock_by_ptr(&msq->q_perm);
969                 rcu_read_unlock();
970
971                 /* Lockless receive, part 4:
972                  * Repeat test after acquiring the spinlock.
973                  */
974                 msg = (struct msg_msg*)msr_d.r_msg;
975                 if (msg != ERR_PTR(-EAGAIN))
976                         goto out_unlock;
977
978                 list_del(&msr_d.r_list);
979                 if (signal_pending(current)) {
980                         msg = ERR_PTR(-ERESTARTNOHAND);
981 out_unlock:
982                         msg_unlock(msq);
983                         break;
984                 }
985         }
986         if (IS_ERR(msg)) {
987                 free_copy(copy);
988                 return PTR_ERR(msg);
989         }
990
991         bufsz = msg_handler(buf, msg, bufsz);
992         free_msg(msg);
993
994         return bufsz;
995 }
996
997 SYSCALL_DEFINE5(msgrcv, int, msqid, struct msgbuf __user *, msgp, size_t, msgsz,
998                 long, msgtyp, int, msgflg)
999 {
1000         return do_msgrcv(msqid, msgp, msgsz, msgtyp, msgflg, do_msg_fill);
1001 }
1002
1003 #ifdef CONFIG_PROC_FS
1004 static int sysvipc_msg_proc_show(struct seq_file *s, void *it)
1005 {
1006         struct user_namespace *user_ns = seq_user_ns(s);
1007         struct msg_queue *msq = it;
1008
1009         return seq_printf(s,
1010                         "%10d %10d  %4o  %10lu %10lu %5u %5u %5u %5u %5u %5u %10lu %10lu %10lu\n",
1011                         msq->q_perm.key,
1012                         msq->q_perm.id,
1013                         msq->q_perm.mode,
1014                         msq->q_cbytes,
1015                         msq->q_qnum,
1016                         msq->q_lspid,
1017                         msq->q_lrpid,
1018                         from_kuid_munged(user_ns, msq->q_perm.uid),
1019                         from_kgid_munged(user_ns, msq->q_perm.gid),
1020                         from_kuid_munged(user_ns, msq->q_perm.cuid),
1021                         from_kgid_munged(user_ns, msq->q_perm.cgid),
1022                         msq->q_stime,
1023                         msq->q_rtime,
1024                         msq->q_ctime);
1025 }
1026 #endif