Pau Espin Pedrol | bb49f95 | 2024-02-27 21:15:01 +0100 | [diff] [blame^] | 1 | % ip.access IPA multiplex protocol |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 2 | |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 3 | % (C) 2010,2012,2019 by Harald Welte <laforge@gnumonks.org> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 4 | % (C) 2010 by On-Waves |
| 5 | % |
| 6 | % All Rights Reserved |
| 7 | % |
| 8 | % This program is free software; you can redistribute it and/or modify |
| 9 | % it under the terms of the GNU General Public License as published by |
| 10 | % the Free Software Foundation; either version 2 of the License, or |
| 11 | % (at your option) any later version. |
| 12 | % |
| 13 | % This program is distributed in the hope that it will be useful, |
| 14 | % but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | % MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | % GNU General Public License for more details. |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 17 | |
| 18 | -module(ipa_proto). |
| 19 | -author('Harald Welte <laforge@gnumonks.org>'). |
| 20 | -compile(export_all). |
| 21 | |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 22 | -include("ipa.hrl"). |
| 23 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 24 | -define(TIMEOUT, 1000). |
| 25 | -define(IPA_SOCKOPTS, [binary, {packet, 0}, {reuseaddr, true}, {active, false}]). |
| 26 | |
| 27 | -define(IPAC_MSGT_PING, 0). |
| 28 | -define(IPAC_MSGT_PONG, 1). |
| 29 | -define(IPAC_MSGT_ID_GET, 4). |
| 30 | -define(IPAC_MSGT_ID_RESP, 5). |
| 31 | -define(IPAC_MSGT_ID_ACK, 6). |
| 32 | |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 33 | -define(IPAC_PROTO_OSMO, 238). |
| 34 | -define(IPAC_PROTO_CCM, 254). |
| 35 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 36 | -export([register_socket/1, register_stream/3, unregister_stream/2, |
| 37 | send/3, connect/3, connect/4, listen_accept_handle/2, |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 38 | start_listen/3, controlling_process/3, register_codec/3]). |
| 39 | |
| 40 | -type stream_id() :: integer() | {osmo, integer()}. |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 41 | |
| 42 | -record(ipa_socket, {socket, ipaPid, streamTbl, listenType}). |
| 43 | |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 44 | -record(ipa_codec, {streamId :: stream_id(), |
| 45 | encodeFn :: fun(), |
| 46 | decodeFn :: fun() |
| 47 | }). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 48 | |
| 49 | % register a TCP socket with this IPA protocol implementation |
| 50 | register_socket(Socket) -> |
| 51 | IpaPid = spawn(?MODULE, init_sock, [Socket, self()]), |
| 52 | % synchronously wait for init_sock to be done |
Pau Espin Pedrol | bb49f95 | 2024-02-27 21:15:01 +0100 | [diff] [blame^] | 53 | receive |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 54 | {ipa_init_sock_done, Socket} -> |
| 55 | % assign ownership of the socket to the new IPA handler process |
| 56 | gen_tcp:controlling_process(Socket, IpaPid), |
| 57 | {ok, IpaPid} |
Pau Espin Pedrol | bb49f95 | 2024-02-27 21:15:01 +0100 | [diff] [blame^] | 58 | after |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 59 | ?TIMEOUT -> |
| 60 | {error, timeout} |
| 61 | end. |
| 62 | |
| 63 | % call_sync() preceeded by a Socket -> Pid lookup |
| 64 | call_sync_sock(Socket, Request) -> |
| 65 | % resolve PID responsible for this socket |
| 66 | case ets:lookup(ipa_sockets, Socket) of |
| 67 | [IpaSock] -> |
| 68 | call_sync(IpaSock#ipa_socket.ipaPid, Request); |
| 69 | _ -> |
| 70 | io:format("No Process for Socket ~p~n", [Socket]), |
| 71 | {error, no_sock_for_pid} |
| 72 | end. |
| 73 | |
| 74 | % a user process wants to register itself for a given Socket/StreamID tuple |
| 75 | register_stream(Socket, StreamID, Pid) -> |
| 76 | call_sync_sock(Socket, {ipa_reg_stream, Socket, StreamID, Pid}). |
| 77 | |
| 78 | register_streams(_S, []) -> |
| 79 | ok; |
| 80 | register_streams(S, [{StreamID, Pid}|SList]) -> |
| 81 | ipa_proto:register_stream(S, StreamID, Pid), |
| 82 | register_streams(S, SList). |
| 83 | |
| 84 | % unregister for a given stream |
| 85 | unregister_stream(Socket, StreamID) -> |
| 86 | call_sync_sock(Socket, {ipa_unreg_stream, Socket, StreamID}). |
| 87 | |
| 88 | % change the controlling process for a given {Socket, StreamID} |
| 89 | controlling_process(Socket, StreamID, NewPid) -> |
| 90 | call_sync_sock(Socket, {ipa_ctrl_proc, Socket, StreamID, NewPid}). |
| 91 | |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 92 | % Set the metadata required for the ipa CCM sub-protocol. |
| 93 | set_ccm_options(Socket, CcmOptions) -> |
| 94 | call_sync_sock(Socket, {ipa_set_ccm_options, Socket, CcmOptions}). |
| 95 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 96 | % unblock the socket from further processing |
| 97 | unblock(Socket) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 98 | call_sync_sock(Socket, {ipa_unblock, Socket}). |
| 99 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 100 | % server-side handler for unregister_stream() |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 101 | request({ipa_reg_stream, Socket, StreamID, Pid}, _) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 102 | io:format("Registering handler ~p for socket ~p Stream ~p~n", [Pid, Socket, StreamID]), |
| 103 | [IpaSock] = ets:lookup(ipa_sockets, Socket), |
| 104 | ets:insert_new(IpaSock#ipa_socket.streamTbl, {{Socket, StreamID}, Pid}); |
| 105 | % server-side handler for unregister_stream() |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 106 | request({ipa_unreg_stream, Socket, StreamID}, _) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 107 | io:format("Unregistering handler for Socket ~p Stream ~p~n", [Socket, StreamID]), |
| 108 | [IpaSock] = ets:lookup(ipa_sockets, Socket), |
| 109 | ets:delete(IpaSock#ipa_socket.streamTbl, {Socket, StreamID}); |
| 110 | % server-side handler for controlling_process() |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 111 | request({ipa_ctrl_proc, Socket, StreamID, NewPid}, _) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 112 | io:format("Changing handler for socket ~p Stream ~p~n", [Socket, StreamID]), |
| 113 | [IpaSock] = ets:lookup(ipa_sockets, Socket), |
| 114 | ets:delete(IpaSock#ipa_socket.streamTbl, {Socket, StreamID}), |
| 115 | ets:insert_new(IpaSock#ipa_socket.streamTbl, {{Socket, StreamID}, NewPid}); |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 116 | % server-side handler for set_ccm_options() |
| 117 | % set ccm protocol metadata options reported with connection setup. |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 118 | request({ipa_set_ccm_options, Socket, CcmOptions}, _) -> |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 119 | io:format("Setting ccm options for socket ~p to ~p~n", [Socket, CcmOptions]), |
| 120 | {ccm_options, CcmOptions}; |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 121 | % server-side handler for unblock() |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 122 | request({ipa_unblock, Socket}, CcmOptions) -> |
| 123 | if |
| 124 | CcmOptions#ipa_ccm_options.initiate_ack -> send_ccm_id_ack(Socket); |
| 125 | true -> send_ccm_id_get(Socket) |
| 126 | end, |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 127 | io:format("Unblocking socket ~p~n", [Socket]), |
| 128 | %[IpaSock] = ets:lookup(ipa_sockets, Socket), |
| 129 | Ret = inet:setopts(Socket, [{active, once}]), |
| 130 | io:format("Unblocking socket ~p:~p~n", [Socket, Ret]). |
| 131 | |
| 132 | % split an incoming IPA message and split it into Length/StreamID/Payload |
| 133 | split_ipa_msg(DataBin) -> |
| 134 | % FIXME: This will throw an exception if DataBin doesn't contain all payload |
| 135 | <<Length:16/big-unsigned-integer, StreamID:8, Payload:Length/binary, Trailer/binary>> = DataBin, |
| 136 | io:format("Stream ~p, ~p bytes~n", [StreamID, Length]), |
| 137 | {StreamID, Payload, Trailer}. |
| 138 | |
| 139 | % deliver an incoming message to the process that is registered for the socket/stream_id |
| 140 | deliver_rx_ipa_msg(Socket, StreamID, StreamMap, DataBin) -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 141 | DataDec = try_decode(StreamID, DataBin), |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 142 | case ets:lookup(StreamMap, {Socket, StreamID}) of |
| 143 | [{_,{process_id, Pid}}] -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 144 | Pid ! {ipa, Socket, StreamID, DataDec}; |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 145 | [{_,{callback_fn, Fn, Args}}] -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 146 | Fn(Socket, StreamID, DataDec, Args); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 147 | [] -> |
| 148 | io:format("No Pid registered for Socket ~p Stream ~p~n", [Socket, StreamID]) |
| 149 | end. |
| 150 | |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 151 | % register a Codec with this IPA protocol implementation |
| 152 | -spec register_codec(stream_id(), fun(), fun()) -> boolean(). |
| 153 | register_codec(StreamID, EncodeFn, DecodeFn) -> |
| 154 | ets:insert(ipa_codecs, #ipa_codec{streamId=StreamID, encodeFn=EncodeFn, decodeFn=DecodeFn}). |
| 155 | |
| 156 | -spec try_decode(stream_id(), binary()) -> any(). |
| 157 | try_decode(StreamID, Data) -> |
| 158 | case ets:lookup(ipa_codecs, StreamID) of |
| 159 | [IpaCodec] -> |
| 160 | Fun = IpaCodec#ipa_codec.decodeFn, |
| 161 | Fun(Data); |
| 162 | [] -> |
| 163 | Data |
| 164 | end. |
| 165 | |
| 166 | -spec try_encode(stream_id(), any()) -> binary(). |
| 167 | try_encode(_StreamID, Data) when is_binary(Data) -> |
| 168 | Data; |
| 169 | try_encode(StreamID, Data) -> |
| 170 | case ets:lookup(ipa_codecs, StreamID) of |
| 171 | [IpaCodec] -> |
| 172 | Fun = IpaCodec#ipa_codec.encodeFn, |
| 173 | Fun(Data); |
| 174 | [] -> |
| 175 | Data |
| 176 | end. |
| 177 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 178 | % process (split + deliver) an incoming IPA message |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 179 | process_rx_ipa_msg(_S, _StreamMap, _, <<>>) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 180 | ok; |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 181 | process_rx_ipa_msg(S, StreamMap, CcmOptions, Data) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 182 | {StreamID, PayloadBin, Trailer} = split_ipa_msg(Data), |
| 183 | case StreamID of |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 184 | ?IPAC_PROTO_CCM -> |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 185 | process_rx_ccm_msg(S, StreamID, CcmOptions, PayloadBin); |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 186 | ?IPAC_PROTO_OSMO -> |
| 187 | <<ExtStreamID:8, PayloadExt/binary>> = PayloadBin, |
| 188 | deliver_rx_ipa_msg(S, {osmo, ExtStreamID}, StreamMap, PayloadExt); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 189 | _ -> |
| 190 | deliver_rx_ipa_msg(S, StreamID, StreamMap, PayloadBin) |
| 191 | end, |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 192 | process_rx_ipa_msg(S, StreamMap, CcmOptions, Trailer). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 193 | |
| 194 | send_close_signal([]) -> |
| 195 | ok; |
| 196 | send_close_signal([StreamSpec|Tail]) -> |
Harald Welte | f66bbfa | 2012-01-28 14:08:52 +0100 | [diff] [blame] | 197 | io:format("send_close_signal ~p ~p~n", [StreamSpec, Tail]), |
| 198 | case StreamSpec of |
| 199 | [{{Socket, StreamID}, {process_id, Pid}}] -> |
| 200 | Pid ! {ipa_closed, {Socket, StreamID}}; |
| 201 | [{{Socket, StreamID}, {callback_fn, Fn, Args}}] -> |
| 202 | Fn(Socket, StreamID, ipa_closed, Args) |
| 203 | end, |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 204 | send_close_signal(Tail). |
Harald Welte | f66bbfa | 2012-01-28 14:08:52 +0100 | [diff] [blame] | 205 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 206 | process_tcp_closed(S, StreamMap) -> |
| 207 | % signal the closed socket to the user |
| 208 | StreamList = ets:match(StreamMap, '$1'), |
| 209 | send_close_signal(StreamList), |
| 210 | % remove the stream map for this socket |
| 211 | ets:delete(StreamMap), |
| 212 | % remove any entry regarding 'S' from ipa_sockets |
| 213 | ets:delete(ipa_sockets, S), |
| 214 | ok. |
| 215 | |
| 216 | % send a binary message through a given Socket / StreamID |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 217 | send(Socket, {osmo, StreamIdExt}, DataBin) -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 218 | DataEnc = try_encode({osmo, StreamIdExt}, DataBin), |
| 219 | send(Socket, ?IPAC_PROTO_OSMO, [StreamIdExt, DataEnc]); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 220 | send(Socket, StreamID, DataBin) -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 221 | DataEnc = try_encode(StreamID, DataBin), |
| 222 | Size = iolist_size(DataEnc), |
| 223 | gen_tcp:send(Socket, iolist_to_binary([<<Size:2/big-unsigned-integer-unit:8>>, StreamID, DataEnc])). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 224 | |
| 225 | |
| 226 | call_sync(Pid, Request) -> |
| 227 | Ref = make_ref(), |
| 228 | Pid ! {request, {self(), Ref}, Request}, |
| 229 | receive |
| 230 | {reply, Ref, Reply} -> Reply |
| 231 | after |
| 232 | ?TIMEOUT -> {error, timeout} |
| 233 | end. |
| 234 | |
| 235 | reply({From, Ref}, Reply) -> |
| 236 | From ! {reply, Ref, Reply}. |
| 237 | |
| 238 | |
| 239 | % global module initialization |
| 240 | init() -> |
Harald Welte | 3b95a7c | 2019-08-11 20:31:41 +0200 | [diff] [blame] | 241 | ipa_sockets = ets:new(ipa_sockets, [named_table, set, public, {keypos, #ipa_socket.socket}]), |
| 242 | ipa_codecs = ets:new(ipa_codecs, [named_table, set, public, {keypos, #ipa_codec.streamId}]). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 243 | |
| 244 | % initialize a signle socket, create its handle process |
| 245 | init_sock(Socket, CallingPid) -> |
| 246 | StreamMap = ets:new(stream_map, [set]), |
| 247 | ets:insert(ipa_sockets, #ipa_socket{socket=Socket, ipaPid=self(), streamTbl=StreamMap}), |
| 248 | CallingPid ! {ipa_init_sock_done, Socket}, |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 249 | loop(Socket, StreamMap, #ipa_ccm_options{}). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 250 | |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 251 | loop(S, StreamMap, CcmOptions) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 252 | receive |
| 253 | {request, From, Request} -> |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 254 | case ipa_proto:request(Request, CcmOptions) of |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 255 | {ccm_options, NewCcmOptions} -> |
| 256 | NextCcmOptions = NewCcmOptions, |
| 257 | Reply = ok; |
| 258 | EmbeddedReply -> |
| 259 | NextCcmOptions = CcmOptions, |
| 260 | Reply = EmbeddedReply |
| 261 | end, |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 262 | ipa_proto:reply(From, Reply), |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 263 | ipa_proto:loop(S, StreamMap, NextCcmOptions); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 264 | {ipa_send, S, StreamId, Data} -> |
| 265 | send(S, StreamId, Data), |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 266 | ipa_proto:loop(S, StreamMap, CcmOptions); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 267 | {tcp, S, Data} -> |
| 268 | % process incoming IPA message and mark socket active once more |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 269 | ipa_proto:process_rx_ipa_msg(S, StreamMap, CcmOptions, Data), |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 270 | inet:setopts(S, [{active, once}]), |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 271 | ipa_proto:loop(S, StreamMap, CcmOptions); |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 272 | {tcp_closed, S} -> |
| 273 | io:format("Socket ~w closed [~w]~n", [S,self()]), |
| 274 | ipa_proto:process_tcp_closed(S, StreamMap), |
| 275 | % terminate the process by not looping further |
| 276 | ok |
| 277 | end. |
| 278 | |
| 279 | % Respond with PONG to PING |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 280 | process_ccm_msg(Socket, StreamID, _, ping, _) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 281 | io:format("Socket ~p Stream ~p: PING -> PONG~n", [Socket, StreamID]), |
| 282 | send(Socket, StreamID, <<?IPAC_MSGT_PONG>>); |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 283 | % Respond to ID_ACK with ID_ACK if this instance did not initiate |
| 284 | process_ccm_msg(Socket, StreamID, CcmOptions, id_ack, _) -> |
| 285 | if |
| 286 | CcmOptions#ipa_ccm_options.initiate_ack /= true -> |
| 287 | % Only respond to an ack if this instance did |
| 288 | % not initiate to prevent an infinite ack loop. |
| 289 | io:format("Socket ~p Stream ~p: ID_ACK -> ID_ACK~n", [Socket, StreamID]), |
| 290 | send(Socket, StreamID, <<?IPAC_MSGT_ID_ACK>>); |
| 291 | true -> |
| 292 | io:format("Socket ~p Stream ~p: ID_ACK -> None~n", [Socket, StreamID]) |
| 293 | end; |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 294 | % Simply respond to ID_RESP with ID_ACK |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 295 | process_ccm_msg(Socket, StreamID, _, id_resp, _) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 296 | io:format("Socket ~p Stream ~p: ID_RESP -> ID_ACK~n", [Socket, StreamID]), |
| 297 | send(Socket, StreamID, <<?IPAC_MSGT_ID_ACK>>); |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 298 | % Simply respond to ID_GET with ID_RESP |
| 299 | process_ccm_msg(Socket, StreamID, CcmOptions, id_req, _) -> |
| 300 | io:format("Socket ~p Stream ~p: ID_GET -> ID_RESP~n", [Socket, StreamID]), |
| 301 | CcmBin = ipa_proto_ccm:encode( |
| 302 | {id_resp, |
| 303 | [{string,serial_nr,CcmOptions#ipa_ccm_options.serial_number}, |
| 304 | {string,unit_id,CcmOptions#ipa_ccm_options.unit_id}, |
| 305 | {string,mac_address,CcmOptions#ipa_ccm_options.mac_address}, |
| 306 | {string,location,CcmOptions#ipa_ccm_options.location}, |
| 307 | {string,unit_type,CcmOptions#ipa_ccm_options.unit_type}, |
| 308 | {string,equip_vers,CcmOptions#ipa_ccm_options.equipment_version}, |
| 309 | {string,sw_version,CcmOptions#ipa_ccm_options.sw_version}, |
| 310 | {string,unit_name,CcmOptions#ipa_ccm_options.unit_name} |
| 311 | ]}), |
| 312 | send(Socket, StreamID, CcmBin); |
| 313 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 314 | % Default message handler for unknown messages |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 315 | process_ccm_msg(Socket, StreamID, _, MsgType, Opts) -> |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 316 | io:format("Socket ~p Stream ~p: Unknown CCM message type ~p Opts ~p~n", |
| 317 | [Socket, StreamID, MsgType, Opts]). |
| 318 | |
| 319 | % process an incoming CCM message (Stream ID 254) |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 320 | process_rx_ccm_msg(Socket, StreamID, CcmOptions, PayloadBin) -> |
Harald Welte | 515aa33 | 2019-08-22 17:58:21 +0200 | [diff] [blame] | 321 | {MsgType, Opts} = ipa_proto_ccm:decode(PayloadBin), |
Matt Johnson | 44a4dd6 | 2020-09-08 01:35:23 -0700 | [diff] [blame] | 322 | process_ccm_msg(Socket, StreamID, CcmOptions, MsgType, Opts). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 323 | |
| 324 | send_ccm_id_get(Socket) -> |
Harald Welte | d0f391e | 2019-08-11 20:00:17 +0200 | [diff] [blame] | 325 | send(Socket, ?IPAC_PROTO_CCM, <<?IPAC_MSGT_ID_GET>>). |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 326 | |
Matt Johnson | 4621456 | 2020-09-08 01:42:49 -0700 | [diff] [blame] | 327 | send_ccm_id_ack(Socket) -> |
| 328 | send(Socket, ?IPAC_PROTO_CCM, <<?IPAC_MSGT_ID_ACK>>). |
| 329 | |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 330 | % convenience wrapper for interactive use / debugging from the shell |
| 331 | listen_accept_handle(LPort, Opts) -> |
| 332 | case gen_tcp:listen(LPort, ?IPA_SOCKOPTS ++ Opts) of |
| 333 | {ok, ListenSock} -> |
| 334 | {ok, Port} = inet:port(ListenSock), |
| 335 | {ok, Sock} = gen_tcp:accept(ListenSock), |
| 336 | {ok, IpaPid} = ipa_proto:register_socket(Sock), |
| 337 | ipa_proto:register_stream(Sock, 0, self()), |
| 338 | ipa_proto:register_stream(Sock, 255, self()), |
| 339 | gen_tcp:controlling_process(Sock, IpaPid), |
| 340 | {ok, Port}; |
| 341 | {error, Reason} -> |
| 342 | {error, Reason} |
| 343 | end. |
| 344 | |
| 345 | % gen_tcp:connect() convenience wrappers |
| 346 | connect(Address, Port, Options) -> |
| 347 | connect(Address, Port, Options, infinity). |
| 348 | |
| 349 | connect(Address, Port, Options, Timeout) -> |
| 350 | case gen_tcp:connect(Address, Port, ?IPA_SOCKOPTS ++ Options, Timeout) of |
| 351 | {ok, Socket} -> |
| 352 | case ipa_proto:register_socket(Socket) of |
Harald Welte | 5cde762 | 2012-01-23 23:18:28 +0100 | [diff] [blame] | 353 | {ok, IpaPid} -> |
| 354 | {ok, {Socket, IpaPid}}; |
Harald Welte | 176e28c | 2010-12-19 22:56:58 +0100 | [diff] [blame] | 355 | {error, Reason} -> |
| 356 | gen_tcp:close(Socket), |
| 357 | {error, Reason} |
| 358 | end; |
| 359 | {error, Reason} -> |
| 360 | {error, Reason} |
| 361 | end. |
| 362 | |
| 363 | % Utility function to continuously server incomming IPA connections on a |
| 364 | % listening TCP socket |
| 365 | start_listen(LPort, NumServers, Opts) -> |
| 366 | case gen_tcp:listen(LPort, ?IPA_SOCKOPTS ++ Opts) of |
| 367 | {ok, ListenSock} -> |
| 368 | start_servers(NumServers, ListenSock, self()), |
| 369 | {ok, Port} = inet:port(ListenSock), |
| 370 | Port; |
| 371 | {error, Reason} -> |
| 372 | {error, Reason} |
| 373 | end. |
| 374 | |
| 375 | start_servers(0, _, _) -> |
| 376 | ok; |
| 377 | start_servers(Num, LS, CtrlPid) -> |
| 378 | spawn(?MODULE, listen_server, [LS, CtrlPid]), |
| 379 | start_servers(Num-1, LS, CtrlPid). |
| 380 | |
| 381 | listen_server(LS, CtrlPid) -> |
| 382 | case gen_tcp:accept(LS) of |
| 383 | {ok, S} -> |
| 384 | io:format("Accepted TCP connection from ~p~n", [inet:peername(S)]), |
| 385 | % assign the socket to the Controlling process |
| 386 | gen_tcp:controlling_process(S, CtrlPid), |
| 387 | CtrlPid ! {ipa_tcp_accept, S}, |
| 388 | listen_server(LS, CtrlPid); |
| 389 | Other -> |
| 390 | io:format("accept returned ~w - goodbye!~n", [Other]), |
| 391 | ok |
| 392 | end. |