xref: /aosp_15_r20/external/libwebsockets/lib/roles/mqtt/client/client-mqtt-handshake.c (revision 1c60b9aca93fdbc9b5f19b2d2194c91294b22281)
1*1c60b9acSAndroid Build Coastguard Worker /*
2*1c60b9acSAndroid Build Coastguard Worker  * libwebsockets - small server side websockets and web server implementation
3*1c60b9acSAndroid Build Coastguard Worker  *
4*1c60b9acSAndroid Build Coastguard Worker  * Copyright (C) 2010 - 2020 Andy Green <[email protected]>
5*1c60b9acSAndroid Build Coastguard Worker  *                           Sakthi Kannan <[email protected]>
6*1c60b9acSAndroid Build Coastguard Worker  *
7*1c60b9acSAndroid Build Coastguard Worker  * Permission is hereby granted, free of charge, to any person obtaining a copy
8*1c60b9acSAndroid Build Coastguard Worker  * of this software and associated documentation files (the "Software"), to
9*1c60b9acSAndroid Build Coastguard Worker  * deal in the Software without restriction, including without limitation the
10*1c60b9acSAndroid Build Coastguard Worker  * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
11*1c60b9acSAndroid Build Coastguard Worker  * sell copies of the Software, and to permit persons to whom the Software is
12*1c60b9acSAndroid Build Coastguard Worker  * furnished to do so, subject to the following conditions:
13*1c60b9acSAndroid Build Coastguard Worker  *
14*1c60b9acSAndroid Build Coastguard Worker  * The above copyright notice and this permission notice shall be included in
15*1c60b9acSAndroid Build Coastguard Worker  * all copies or substantial portions of the Software.
16*1c60b9acSAndroid Build Coastguard Worker  *
17*1c60b9acSAndroid Build Coastguard Worker  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18*1c60b9acSAndroid Build Coastguard Worker  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19*1c60b9acSAndroid Build Coastguard Worker  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
20*1c60b9acSAndroid Build Coastguard Worker  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21*1c60b9acSAndroid Build Coastguard Worker  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
22*1c60b9acSAndroid Build Coastguard Worker  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
23*1c60b9acSAndroid Build Coastguard Worker  * IN THE SOFTWARE.
24*1c60b9acSAndroid Build Coastguard Worker  */
25*1c60b9acSAndroid Build Coastguard Worker 
26*1c60b9acSAndroid Build Coastguard Worker #include <private-lib-core.h>
27*1c60b9acSAndroid Build Coastguard Worker 
28*1c60b9acSAndroid Build Coastguard Worker #define MQTT_CONNECT_MSG_BASE_LEN (12)
29*1c60b9acSAndroid Build Coastguard Worker 
30*1c60b9acSAndroid Build Coastguard Worker struct lws *
lws_mqtt_client_send_connect(struct lws * wsi)31*1c60b9acSAndroid Build Coastguard Worker lws_mqtt_client_send_connect(struct lws *wsi)
32*1c60b9acSAndroid Build Coastguard Worker {
33*1c60b9acSAndroid Build Coastguard Worker 	/* static int */
34*1c60b9acSAndroid Build Coastguard Worker 	/* 	lws_mqttc_abs_writeable(lws_abs_protocol_inst_t *api, size_t budget) */
35*1c60b9acSAndroid Build Coastguard Worker 	const lws_mqttc_t *c = &wsi->mqtt->client;
36*1c60b9acSAndroid Build Coastguard Worker 	uint8_t b[256 + LWS_PRE], *start = b + LWS_PRE, *p = start;
37*1c60b9acSAndroid Build Coastguard Worker 	unsigned int len = MQTT_CONNECT_MSG_BASE_LEN;
38*1c60b9acSAndroid Build Coastguard Worker 
39*1c60b9acSAndroid Build Coastguard Worker 	switch (lwsi_state(wsi)) {
40*1c60b9acSAndroid Build Coastguard Worker 	case LRS_MQTTC_IDLE:
41*1c60b9acSAndroid Build Coastguard Worker 		/*
42*1c60b9acSAndroid Build Coastguard Worker 		 * Transport connected - this is our chance to do the
43*1c60b9acSAndroid Build Coastguard Worker 		 * protocol connect action.
44*1c60b9acSAndroid Build Coastguard Worker 		 */
45*1c60b9acSAndroid Build Coastguard Worker 
46*1c60b9acSAndroid Build Coastguard Worker 		/* 1. Fixed Headers */
47*1c60b9acSAndroid Build Coastguard Worker 		if (lws_mqtt_fill_fixed_header(p++, LMQCP_CTOS_CONNECT, 0, 0, 0)) {
48*1c60b9acSAndroid Build Coastguard Worker 			lwsl_err("%s: Failled to fill fixed header\n", __func__);
49*1c60b9acSAndroid Build Coastguard Worker 			return NULL;
50*1c60b9acSAndroid Build Coastguard Worker 		}
51*1c60b9acSAndroid Build Coastguard Worker 
52*1c60b9acSAndroid Build Coastguard Worker 		/*
53*1c60b9acSAndroid Build Coastguard Worker 		 * 2. Remaining length - Add the lengths of client ID,
54*1c60b9acSAndroid Build Coastguard Worker 		 * username and password and their length fields if
55*1c60b9acSAndroid Build Coastguard Worker 		 * the respective flags are set.
56*1c60b9acSAndroid Build Coastguard Worker 		 */
57*1c60b9acSAndroid Build Coastguard Worker 		len +=  c->id->len;
58*1c60b9acSAndroid Build Coastguard Worker 		if (c->conn_flags & LMQCFT_USERNAME && c->username) {
59*1c60b9acSAndroid Build Coastguard Worker 			len = len + (unsigned int)c->username->len + 2;
60*1c60b9acSAndroid Build Coastguard Worker 			if (c->conn_flags & LMQCFT_PASSWORD)
61*1c60b9acSAndroid Build Coastguard Worker 				len += (unsigned int)(c->password ? c->password->len : 0) + 2u;
62*1c60b9acSAndroid Build Coastguard Worker 		}
63*1c60b9acSAndroid Build Coastguard Worker 		if (c->conn_flags & LMQCFT_WILL_FLAG && c->will.topic) {
64*1c60b9acSAndroid Build Coastguard Worker 			len = len + (unsigned int)c->will.topic->len + 2;
65*1c60b9acSAndroid Build Coastguard Worker 			len += (c->will.message ? c->will.message->len : 0) + 2u;
66*1c60b9acSAndroid Build Coastguard Worker 		}
67*1c60b9acSAndroid Build Coastguard Worker 		p += lws_mqtt_vbi_encode(len, p);
68*1c60b9acSAndroid Build Coastguard Worker 
69*1c60b9acSAndroid Build Coastguard Worker 		/*
70*1c60b9acSAndroid Build Coastguard Worker 		 * 3. Variable Header - Protocol name & level, Connect
71*1c60b9acSAndroid Build Coastguard Worker 		 * flags and keep alive time (in secs).
72*1c60b9acSAndroid Build Coastguard Worker 		 */
73*1c60b9acSAndroid Build Coastguard Worker 		lws_ser_wu16be(p, 4); /* Length of protocol name */
74*1c60b9acSAndroid Build Coastguard Worker 		p += 2;
75*1c60b9acSAndroid Build Coastguard Worker 		*p++ = 'M';
76*1c60b9acSAndroid Build Coastguard Worker 		*p++ = 'Q';
77*1c60b9acSAndroid Build Coastguard Worker 		*p++ = 'T';
78*1c60b9acSAndroid Build Coastguard Worker 		*p++ = 'T';
79*1c60b9acSAndroid Build Coastguard Worker 		*p++ = MQTT_VER_3_1_1;
80*1c60b9acSAndroid Build Coastguard Worker 		*p++ = (uint8_t)c->conn_flags;
81*1c60b9acSAndroid Build Coastguard Worker 		lws_ser_wu16be(p, c->keep_alive_secs);
82*1c60b9acSAndroid Build Coastguard Worker 		p += 2;
83*1c60b9acSAndroid Build Coastguard Worker 
84*1c60b9acSAndroid Build Coastguard Worker 		/*
85*1c60b9acSAndroid Build Coastguard Worker 		 * 4. Payload - Client ID, Will topic & message,
86*1c60b9acSAndroid Build Coastguard Worker 		 * Username & password.
87*1c60b9acSAndroid Build Coastguard Worker 		 */
88*1c60b9acSAndroid Build Coastguard Worker 		if (lws_mqtt_str_is_not_empty(c->id)) {
89*1c60b9acSAndroid Build Coastguard Worker 			lws_ser_wu16be(p, c->id->len);
90*1c60b9acSAndroid Build Coastguard Worker 			p += 2;
91*1c60b9acSAndroid Build Coastguard Worker 			memcpy(p, c->id->buf, c->id->len);
92*1c60b9acSAndroid Build Coastguard Worker 			p += c->id->len;
93*1c60b9acSAndroid Build Coastguard Worker 		} else {
94*1c60b9acSAndroid Build Coastguard Worker 			/*
95*1c60b9acSAndroid Build Coastguard Worker 			 * If the Client supplies a zero-byte
96*1c60b9acSAndroid Build Coastguard Worker 			 * ClientId, the Client MUST also set
97*1c60b9acSAndroid Build Coastguard Worker 			 * CleanSession to 1 [MQTT-3.1.3-7].
98*1c60b9acSAndroid Build Coastguard Worker 			 */
99*1c60b9acSAndroid Build Coastguard Worker 			if (!(c->conn_flags & LMQCFT_CLEAN_START)) {
100*1c60b9acSAndroid Build Coastguard Worker 				lwsl_err("%s: Empty client ID needs a clean start\n",
101*1c60b9acSAndroid Build Coastguard Worker 					 __func__);
102*1c60b9acSAndroid Build Coastguard Worker 				return NULL;
103*1c60b9acSAndroid Build Coastguard Worker 			}
104*1c60b9acSAndroid Build Coastguard Worker 			*p++ = 0;
105*1c60b9acSAndroid Build Coastguard Worker 		}
106*1c60b9acSAndroid Build Coastguard Worker 
107*1c60b9acSAndroid Build Coastguard Worker 		if (c->conn_flags & LMQCFT_WILL_FLAG) {
108*1c60b9acSAndroid Build Coastguard Worker 			if (lws_mqtt_str_is_not_empty(c->will.topic)) {
109*1c60b9acSAndroid Build Coastguard Worker 				lws_ser_wu16be(p, c->will.topic->len);
110*1c60b9acSAndroid Build Coastguard Worker 				p += 2;
111*1c60b9acSAndroid Build Coastguard Worker 				memcpy(p, c->will.topic->buf, c->will.topic->len);
112*1c60b9acSAndroid Build Coastguard Worker 				p += c->will.topic->len;
113*1c60b9acSAndroid Build Coastguard Worker 				if (lws_mqtt_str_is_not_empty(c->will.message)) {
114*1c60b9acSAndroid Build Coastguard Worker 					lws_ser_wu16be(p, c->will.message->len);
115*1c60b9acSAndroid Build Coastguard Worker 					p += 2;
116*1c60b9acSAndroid Build Coastguard Worker 					memcpy(p, c->will.message->buf,
117*1c60b9acSAndroid Build Coastguard Worker 					       c->will.message->len);
118*1c60b9acSAndroid Build Coastguard Worker 					p += c->will.message->len;
119*1c60b9acSAndroid Build Coastguard Worker 				} else {
120*1c60b9acSAndroid Build Coastguard Worker 					lws_ser_wu16be(p, 0);
121*1c60b9acSAndroid Build Coastguard Worker 					p += 2;
122*1c60b9acSAndroid Build Coastguard Worker 				}
123*1c60b9acSAndroid Build Coastguard Worker 			} else {
124*1c60b9acSAndroid Build Coastguard Worker 				lwsl_err("%s: Missing Will Topic\n", __func__);
125*1c60b9acSAndroid Build Coastguard Worker 				return NULL;
126*1c60b9acSAndroid Build Coastguard Worker 			}
127*1c60b9acSAndroid Build Coastguard Worker 		}
128*1c60b9acSAndroid Build Coastguard Worker 		if (c->conn_flags & LMQCFT_USERNAME) {
129*1c60b9acSAndroid Build Coastguard Worker 			/*
130*1c60b9acSAndroid Build Coastguard Worker 			 * Detailed sanity check on the username and
131*1c60b9acSAndroid Build Coastguard Worker 			 * password strings.
132*1c60b9acSAndroid Build Coastguard Worker 			 */
133*1c60b9acSAndroid Build Coastguard Worker 			if (lws_mqtt_str_is_not_empty(c->username)) {
134*1c60b9acSAndroid Build Coastguard Worker 				lws_ser_wu16be(p, c->username->len);
135*1c60b9acSAndroid Build Coastguard Worker 				p += 2;
136*1c60b9acSAndroid Build Coastguard Worker 				memcpy(p, c->username->buf, c->username->len);
137*1c60b9acSAndroid Build Coastguard Worker 				p += c->username->len;
138*1c60b9acSAndroid Build Coastguard Worker 			} else {
139*1c60b9acSAndroid Build Coastguard Worker 				lwsl_err("%s: Empty / missing Username!\n",
140*1c60b9acSAndroid Build Coastguard Worker 					 __func__);
141*1c60b9acSAndroid Build Coastguard Worker 				return NULL;
142*1c60b9acSAndroid Build Coastguard Worker 			}
143*1c60b9acSAndroid Build Coastguard Worker 			if (c->conn_flags & LMQCFT_PASSWORD) {
144*1c60b9acSAndroid Build Coastguard Worker 				if (lws_mqtt_str_is_not_empty(c->password)) {
145*1c60b9acSAndroid Build Coastguard Worker 					lws_ser_wu16be(p, c->password->len);
146*1c60b9acSAndroid Build Coastguard Worker 					p += 2;
147*1c60b9acSAndroid Build Coastguard Worker 					memcpy(p, c->password->buf,
148*1c60b9acSAndroid Build Coastguard Worker 					       c->password->len);
149*1c60b9acSAndroid Build Coastguard Worker 					p += c->password->len;
150*1c60b9acSAndroid Build Coastguard Worker 				} else {
151*1c60b9acSAndroid Build Coastguard Worker 					lws_ser_wu16be(p, 0);
152*1c60b9acSAndroid Build Coastguard Worker 					p += 2;
153*1c60b9acSAndroid Build Coastguard Worker 				}
154*1c60b9acSAndroid Build Coastguard Worker 			}
155*1c60b9acSAndroid Build Coastguard Worker 		} else if (c->conn_flags & LMQCFT_PASSWORD) {
156*1c60b9acSAndroid Build Coastguard Worker 			lwsl_err("%s: Unsupported - Password without username\n",
157*1c60b9acSAndroid Build Coastguard Worker 				 __func__);
158*1c60b9acSAndroid Build Coastguard Worker 			return NULL;
159*1c60b9acSAndroid Build Coastguard Worker 		}
160*1c60b9acSAndroid Build Coastguard Worker 		break;
161*1c60b9acSAndroid Build Coastguard Worker 	default:
162*1c60b9acSAndroid Build Coastguard Worker 		lwsl_err("%s: unexpected state %d\n", __func__, lwsi_state(wsi));
163*1c60b9acSAndroid Build Coastguard Worker 
164*1c60b9acSAndroid Build Coastguard Worker 		return NULL;
165*1c60b9acSAndroid Build Coastguard Worker 	}
166*1c60b9acSAndroid Build Coastguard Worker 
167*1c60b9acSAndroid Build Coastguard Worker 	/*
168*1c60b9acSAndroid Build Coastguard Worker 	 * Perform the actual write
169*1c60b9acSAndroid Build Coastguard Worker 	 */
170*1c60b9acSAndroid Build Coastguard Worker 	if (lws_write(wsi, (unsigned char *)&b[LWS_PRE], lws_ptr_diff_size_t(p, start),
171*1c60b9acSAndroid Build Coastguard Worker 		  LWS_WRITE_BINARY) != lws_ptr_diff(p, start)) {
172*1c60b9acSAndroid Build Coastguard Worker 		lwsl_notice("%s: write failed\n", __func__);
173*1c60b9acSAndroid Build Coastguard Worker 
174*1c60b9acSAndroid Build Coastguard Worker 		return NULL;
175*1c60b9acSAndroid Build Coastguard Worker 	}
176*1c60b9acSAndroid Build Coastguard Worker 
177*1c60b9acSAndroid Build Coastguard Worker 	return wsi;
178*1c60b9acSAndroid Build Coastguard Worker }
179*1c60b9acSAndroid Build Coastguard Worker 
180*1c60b9acSAndroid Build Coastguard Worker struct lws *
lws_mqtt_client_send_disconnect(struct lws * wsi)181*1c60b9acSAndroid Build Coastguard Worker lws_mqtt_client_send_disconnect(struct lws *wsi)
182*1c60b9acSAndroid Build Coastguard Worker {
183*1c60b9acSAndroid Build Coastguard Worker 	uint8_t b[256 + LWS_PRE], *start = b + LWS_PRE, *p = start;
184*1c60b9acSAndroid Build Coastguard Worker 
185*1c60b9acSAndroid Build Coastguard Worker 	/* 1. Fixed Headers */
186*1c60b9acSAndroid Build Coastguard Worker 	if (lws_mqtt_fill_fixed_header(p++, LMQCP_DISCONNECT, 0, 0, 0))
187*1c60b9acSAndroid Build Coastguard Worker 	{
188*1c60b9acSAndroid Build Coastguard Worker 		lwsl_err("%s: Failled to fill fixed header\n", __func__);
189*1c60b9acSAndroid Build Coastguard Worker 		return NULL;
190*1c60b9acSAndroid Build Coastguard Worker 	}
191*1c60b9acSAndroid Build Coastguard Worker 	*p++ = 0;
192*1c60b9acSAndroid Build Coastguard Worker 	if (lws_write(wsi, (unsigned char *)&b[LWS_PRE], lws_ptr_diff_size_t(p, start),
193*1c60b9acSAndroid Build Coastguard Worker 				LWS_WRITE_BINARY) != lws_ptr_diff(p, start)) {
194*1c60b9acSAndroid Build Coastguard Worker 		lwsl_err("%s: write failed\n", __func__);
195*1c60b9acSAndroid Build Coastguard Worker 
196*1c60b9acSAndroid Build Coastguard Worker 		return NULL;
197*1c60b9acSAndroid Build Coastguard Worker 	}
198*1c60b9acSAndroid Build Coastguard Worker 
199*1c60b9acSAndroid Build Coastguard Worker 	return wsi;
200*1c60b9acSAndroid Build Coastguard Worker }
201