/src/mosquitto/lib/handle_suback.c
Line | Count | Source |
1 | | /* |
2 | | Copyright (c) 2009-2021 Roger Light <roger@atchoo.org> |
3 | | |
4 | | All rights reserved. This program and the accompanying materials |
5 | | are made available under the terms of the Eclipse Public License 2.0 |
6 | | and Eclipse Distribution License v1.0 which accompany this distribution. |
7 | | |
8 | | The Eclipse Public License is available at |
9 | | https://www.eclipse.org/legal/epl-2.0/ |
10 | | and the Eclipse Distribution License is available at |
11 | | http://www.eclipse.org/org/documents/edl-v10.php. |
12 | | |
13 | | SPDX-License-Identifier: EPL-2.0 OR BSD-3-Clause |
14 | | |
15 | | Contributors: |
16 | | Roger Light - initial implementation and documentation. |
17 | | */ |
18 | | |
19 | | #include "config.h" |
20 | | |
21 | | #include <assert.h> |
22 | | |
23 | | #ifdef WITH_BROKER |
24 | | # include "mosquitto_broker_internal.h" |
25 | | #endif |
26 | | |
27 | | #include "callbacks.h" |
28 | | #include "mosquitto.h" |
29 | | #include "mosquitto_internal.h" |
30 | | #include "logging_mosq.h" |
31 | | #include "mosquitto/mqtt_protocol.h" |
32 | | #include "packet_mosq.h" |
33 | | #include "property_mosq.h" |
34 | | #include "read_handle.h" |
35 | | #include "util_mosq.h" |
36 | | |
37 | | |
38 | | int handle__suback(struct mosquitto *mosq) |
39 | 80 | { |
40 | 80 | uint16_t mid; |
41 | 80 | uint8_t qos; |
42 | 80 | int *granted_qos; |
43 | 80 | int qos_count; |
44 | 80 | int i = 0; |
45 | 80 | int rc; |
46 | 80 | mosquitto_property *properties = NULL; |
47 | | |
48 | 80 | assert(mosq); |
49 | | |
50 | 80 | if(mosquitto__get_state(mosq) != mosq_cs_active){ |
51 | 8 | return MOSQ_ERR_PROTOCOL; |
52 | 8 | } |
53 | 72 | if(mosq->in_packet.command != CMD_SUBACK){ |
54 | 4 | return MOSQ_ERR_MALFORMED_PACKET; |
55 | 4 | } |
56 | | |
57 | 68 | #ifdef WITH_BROKER |
58 | 68 | if(mosq->bridge == NULL){ |
59 | | /* Client is not a bridge, so shouldn't be sending SUBACK */ |
60 | 0 | return MOSQ_ERR_PROTOCOL; |
61 | 0 | } |
62 | 68 | log__printf(NULL, MOSQ_LOG_DEBUG, "Received SUBACK from %s", SAFE_PRINT(mosq->id)); |
63 | | #else |
64 | | log__printf(mosq, MOSQ_LOG_DEBUG, "Client %s received SUBACK", SAFE_PRINT(mosq->id)); |
65 | | #endif |
66 | 68 | rc = packet__read_uint16(&mosq->in_packet, &mid); |
67 | 68 | if(rc){ |
68 | 1 | return rc; |
69 | 1 | } |
70 | 67 | if(mid == 0){ |
71 | 1 | return MOSQ_ERR_PROTOCOL; |
72 | 1 | } |
73 | | |
74 | 66 | if(mosq->protocol == mosq_p_mqtt5){ |
75 | 27 | rc = property__read_all(CMD_SUBACK, &mosq->in_packet, &properties); |
76 | 27 | if(rc){ |
77 | 7 | return rc; |
78 | 7 | } |
79 | 27 | } |
80 | | |
81 | 59 | qos_count = (int)(mosq->in_packet.remaining_length - mosq->in_packet.pos); |
82 | 59 | if(qos_count == 0){ |
83 | 8 | mosquitto_property_free_all(&properties); |
84 | 8 | return MOSQ_ERR_PROTOCOL; |
85 | 8 | } |
86 | 51 | granted_qos = mosquitto_malloc((size_t)qos_count*sizeof(int)); |
87 | 51 | if(!granted_qos){ |
88 | 0 | mosquitto_property_free_all(&properties); |
89 | 0 | return MOSQ_ERR_NOMEM; |
90 | 0 | } |
91 | 5.88M | while(mosq->in_packet.pos < mosq->in_packet.remaining_length){ |
92 | 5.88M | rc = packet__read_byte(&mosq->in_packet, &qos); |
93 | 5.88M | if(rc){ |
94 | 0 | mosquitto_FREE(granted_qos); |
95 | 0 | mosquitto_property_free_all(&properties); |
96 | 0 | return rc; |
97 | 0 | } |
98 | 5.88M | granted_qos[i] = (int)qos; |
99 | 5.88M | i++; |
100 | 5.88M | } |
101 | 51 | #ifdef WITH_BROKER |
102 | | /* Immediately free, we don't do anything with Reason String or User Property at the moment */ |
103 | 51 | mosquitto_property_free_all(&properties); |
104 | | #else |
105 | | callback__on_subscribe(mosq, mid, qos_count, granted_qos, properties); |
106 | | mosquitto_property_free_all(&properties); |
107 | | #endif |
108 | 51 | mosquitto_FREE(granted_qos); |
109 | | |
110 | 51 | return MOSQ_ERR_SUCCESS; |
111 | 51 | } |