summaryrefslogtreecommitdiff
path: root/rose.erl
blob: c00db2f3795cf9d380079ae681534d9fa858850b (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
-module(rose).

-export([decode/1, return/3, invoke/3, dispatch/1]).

-include("Remote-Operations-Generic-ROS-PDUs.hrl").

decode(Data) -> 'Remote-Operations-Generic-ROS-PDUs':decode('ROS', Data).

return(Id, Op, {ok, Data}) -> 'Remote-Operations-Generic-ROS-PDUs':encode('ROS',
	{returnResult, #'ReturnResult'{invokeId = Id,
	result = #'ReturnResult_result'{opcode = Op, result = Data}}}).

invoke(Id, Op, {ok, Data}) -> 'Remote-Operations-Generic-ROS-PDUs':encode('ROS',
	{invoke, #'Invoke'{invokeId = Id, opcode = Op, argument = Data}}).

dispatch({invoke, #'Invoke'{invokeId = Id, opcode = Op}}) ->
	case Op of
		{local, 21} -> ok;
		{local, 51} -> ok;
		{local, 71} -> ok;
		{local, 211} -> return(Id, Op, status:status());
		_ -> error
	end;

dispatch({returnResult, #'ReturnResult'{result = Data}}) ->
	dispatch(Data);

dispatch(#'ReturnResult_result'{result = Data}) ->
	io:format("Result: ~p~n", [Data]),
	ok.