bus: mhi: core: Fix some error return code
[linux/fpc-iii.git] / fs / dlm / midcomms.c
blob921322d133e3d9396207335294903e3a8b382b2f
1 // SPDX-License-Identifier: GPL-2.0-only
2 /******************************************************************************
3 *******************************************************************************
4 **
5 ** Copyright (C) Sistina Software, Inc. 1997-2003 All rights reserved.
6 ** Copyright (C) 2004-2008 Red Hat, Inc. All rights reserved.
7 **
8 **
9 *******************************************************************************
10 ******************************************************************************/
13 * midcomms.c
15 * This is the appallingly named "mid-level" comms layer.
17 * Its purpose is to take packets from the "real" comms layer,
18 * split them up into packets and pass them to the interested
19 * part of the locking mechanism.
21 * It also takes messages from the locking layer, formats them
22 * into packets and sends them to the comms layer.
25 #include "dlm_internal.h"
26 #include "lowcomms.h"
27 #include "config.h"
28 #include "lock.h"
29 #include "midcomms.h"
32 static void copy_from_cb(void *dst, const void *base, unsigned offset,
33 unsigned len, unsigned limit)
35 unsigned copy = len;
37 if ((copy + offset) > limit)
38 copy = limit - offset;
39 memcpy(dst, base + offset, copy);
40 len -= copy;
41 if (len)
42 memcpy(dst + copy, base, len);
46 * Called from the low-level comms layer to process a buffer of
47 * commands.
49 * Only complete messages are processed here, any "spare" bytes from
50 * the end of a buffer are saved and tacked onto the front of the next
51 * message that comes in. I doubt this will happen very often but we
52 * need to be able to cope with it and I don't want the task to be waiting
53 * for packets to come in when there is useful work to be done.
56 int dlm_process_incoming_buffer(int nodeid, const void *base,
57 unsigned offset, unsigned len, unsigned limit)
59 union {
60 unsigned char __buf[DLM_INBUF_LEN];
61 /* this is to force proper alignment on some arches */
62 union dlm_packet p;
63 } __tmp;
64 union dlm_packet *p = &__tmp.p;
65 int ret = 0;
66 int err = 0;
67 uint16_t msglen;
68 uint32_t lockspace;
70 while (len > sizeof(struct dlm_header)) {
72 /* Copy just the header to check the total length. The
73 message may wrap around the end of the buffer back to the
74 start, so we need to use a temp buffer and copy_from_cb. */
76 copy_from_cb(p, base, offset, sizeof(struct dlm_header),
77 limit);
79 msglen = le16_to_cpu(p->header.h_length);
80 lockspace = p->header.h_lockspace;
82 err = -EINVAL;
83 if (msglen < sizeof(struct dlm_header))
84 break;
85 if (p->header.h_cmd == DLM_MSG) {
86 if (msglen < sizeof(struct dlm_message))
87 break;
88 } else {
89 if (msglen < sizeof(struct dlm_rcom))
90 break;
92 err = -E2BIG;
93 if (msglen > dlm_config.ci_buffer_size) {
94 log_print("message size %d from %d too big, buf len %d",
95 msglen, nodeid, len);
96 break;
98 err = 0;
100 /* If only part of the full message is contained in this
101 buffer, then do nothing and wait for lowcomms to call
102 us again later with more data. We return 0 meaning
103 we've consumed none of the input buffer. */
105 if (msglen > len)
106 break;
108 /* Allocate a larger temp buffer if the full message won't fit
109 in the buffer on the stack (which should work for most
110 ordinary messages). */
112 if (msglen > sizeof(__tmp) && p == &__tmp.p) {
113 p = kmalloc(dlm_config.ci_buffer_size, GFP_NOFS);
114 if (p == NULL)
115 return ret;
118 copy_from_cb(p, base, offset, msglen, limit);
120 BUG_ON(lockspace != p->header.h_lockspace);
122 ret += msglen;
123 offset += msglen;
124 offset &= (limit - 1);
125 len -= msglen;
127 dlm_receive_buffer(p, nodeid);
130 if (p != &__tmp.p)
131 kfree(p);
133 return err ? err : ret;