-module(rose). -export([decode/1, invoke/2, 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(Op, {ok, Data}) -> Id = counter:next(), 'Remote-Operations-Generic-ROS-PDUs':encode('ROS', {invoke, #'Invoke'{invokeId = Id, opcode = Op, argument = Data}}). dispatch({invoke, #'Invoke'{invokeId = Id, opcode = Op, argument = Data}}) -> counter:set(Id), case Op of {local, 21} -> ok; {local, 51} -> {ok, Esc} = csta:decode(Data), io:format("Esc ~p~n", [Esc]), ok; {local, 71} -> ok; {local, 74} -> ok; {local, 211} -> return(Id, Op, csta:status()); _ -> error end; dispatch({returnResult, #'ReturnResult'{result = Data}}) -> dispatch(Data); dispatch({returnError, #'ReturnError'{errcode = Code, parameter = Par}}) -> io:format("Err: ~p ~p~n", [Code, Par]), error; dispatch(#'ReturnResult_result'{opcode = Op, result = Data}) -> case Op of {local, 74} -> {ok, Status} = 'CSTA-snapshot-device':decode( 'SnapshotDeviceResult', Data), io:format("Result: ~p~n", [Status]); _ -> io:format("Result: ~p~n", [Data]) end, ok.