您的位置:首页 > 其它

使用Erlang UDP做仿真通信

2016-11-19 17:55 92 查看
-module(udpserver).
-import(crc,[comCrc16/1]).
-export([start/0,client/1]). %%服务端
start()->
    spawn(fun()->
        server(19997) end).%%开启进程执行server函数 19997
    server(Port)->
        {ok, Socket} = gen_udp:open(Port, [binary, {active, false}]),%%打开udp端口
        io:format("server open socket:~p~n", [Socket]),%%输出内容
        loop(Socket).%%调用loop函数
 
    loop(Socket)->
        inet:setopts(Socket, [{active, once}]),%%启动Socket
        receive
            {udp, Socket, Host, Port, Bin} ->
                io:format("server received:~p~n", [Bin]),
                {Identity, ReceiveBin} = getReceiveBin(Bin),
                io:format("server send:~p~n", [ReceiveBin]),
                gen_udp:send(Socket, Host, Port, ReceiveBin),
                sendSlaveRequest(Socket, Host, Port, Identity, Bin),
                loop(Socket)
        end.
    getReceiveBin(Bin) ->
         Arr = binary_to_list(Bin),
         [_,_,_,Identity,Len,SerialNum|_Others] = Arr,
         case Identity of
            16#02 ->
                 Res = [16#A5,16#5A,16#00,Identity,16#9,SerialNum,16#1],
                Crc = crc:comCrc16(Res),
                {Identity, Res ++ Crc};
           16#06 ->
                Res = [16#A5,16#5A,16#00,Identity,16#9,SerialNum,16#1],
                Crc = crc:comCrc16(Res),
                %%io:format("CRC:~p~n", [Crc]),%%输出内容
                {Identity, Res ++ Crc};
          16#23 ->
               Res = [16#A5,16#5A,16#00,Identity,16#9,SerialNum,16#1],
              Crc = crc:comCrc16(Res),
              {Identity, Res ++ Crc};
          16#07 ->
               DataLen = (Len - 8) * 8,
              <<_First:48,Data:DataLen,_Crc:16>> = Bin,%%从位数组中截取内如,每个字节8位,First截取前6个字节
              %%io:format("Data:~p~n", [Data]),  %%输出内容
              [16#A5,16#5A,16#00,16#07,Len,16#00,16#11,0,0];
          Other ->
              {Identity, Arr}
          end.
 
          sleep(T) ->
                receive
                after T ->
                     ok
                end.
 
%上发下位机请求
sendSlaveRequest(Socket, Host, Port, Identity, Bin) ->
          case Identity of
                16#02 ->
                        sendFeedback(Socket, Host, Port, Bin);
                 Other ->
                      ok
                 end.
 
%发送调剂动作反馈
sendFeedback(Socket, Host, Port, Bin) ->
        sleep(1000),
         ListData = binary_to_list(Bin),
         [_,_,_,Identity,Len,SerialNo|_T] = ListData,
        OtherLen = (Len-16)*8, <<_:48, _:80,Others:OtherLen>> = Bin,
        %% io:format("CrcAndPulse****:~p~n", [Others]),
        [P1, P2, P3, P4] = getPulseCnt(Others, OtherLen),
         %io:format("P1--P4: ~p, ~p, ~p, ~p ~n", [P1, P2, P3, P4]),
         NewSerialNo = if SerialNo >=255 -> 0; true -> SerialNo + 1 end,
         Body = getFeedbackBody(Bin, OtherLen),
         Request = [16#D3, 16#3D, 16#00, 16#85, 16#12, NewSerialNo] ++ Body,
         Crc = crc:comCrc16(Request),
         RequestList = Request ++ Crc,
         %%io:format("sendFeedback****(begin) ~p~n", [RequestList]),
          gen_udp:send(Socket, Host, Port, RequestList),
          io:format("sendFeedback****(end) ~p~n", [RequestList]).
 
getFeedbackBody(Bin, OtherLen)->
    <<_:48, _:4,IsTurnOffBottle_Ap1:1,_:1,IsAdmix_AP1:1,IsPluginBottle_Ap1:1,
    %%注意 按位运算的时候,字节是反序的,高位在前,低位在后 
     _:4,IsTurnOffBottle_Ap2:1,_:1,IsAdmix_AP2:1,IsPluginBottle_Ap2:1,    _:4,IsTurnOffBottle_Ap3:1,_:1,IsAdmix_AP3:1,IsPluginBottle_Ap3:1,
    _:4,IsTurnOffBottle_Ap4:1,_:1,IsAdmix_AP4:1,IsPluginBottle_Ap4:1, BoxTurnDirection:1,_:2,BoxTurnCnt:5, CellTurnCnt:3,_:4,CellTurnDirection:1,
     PushBoxInfo:8, _:5,IsCutoffFilm:1,IsEncBox:1,IsPushFilm:1, _:8,_:8,Others:OtherLen>> = Bin,
    AP1 = calcAdmixpartFeedback(IsPluginBottle_Ap1,IsAdmix_AP1,IsTurnOffBottle_Ap1),
    AP2 = calcAdmixpartFeedback(IsPluginBottle_Ap2,IsAdmix_AP2,IsTurnOffBottle_Ap2),
    AP3 = calcAdmixpartFeedback(IsPluginBottle_Ap3,IsAdmix_AP3,IsTurnOffBottle_Ap3),
    AP4 = calcAdmixpartFeedback(IsPluginBottle_Ap4,IsAdmix_AP4,IsTurnOffBottle_Ap4),
    io:format("***admixpart command:IsTurnOffBottle_Ap4:~p,IsAdmix_AP4:~p,IsPluginBottle_Ap4:~p ~n", [IsTurnOffBottle_Ap4,IsAdmix_AP4,IsPluginBottle_Ap4]),
    BoxRotate = case BoxTurnCnt > 0 of true -> (BoxTurnDirection bsl 7) bor BoxTurnCnt; _ -> 0 end,
    CellRotate = case CellTurnCnt > 0 of true -> (CellTurnDirection bsl 7) bor CellTurnCnt; _ -> 0 end,
    IsPushInBox = PushBoxInfo band 16#01,
    IsPushOutBox = (PushBoxInfo bsr 1) band 16#01,
    BoxOther = PushBoxInfo band 16#3F,
    %%io:format("++++IsPushInBox:~p IsPushOutBox:~p BoxOther:~p ~n", [IsPushInBox,IsPushOutBox,BoxOther]),
    PushBox = (IsPushOutBox bsl 1) bor IsPushInBox,
    Enc = if IsEncBox =:= 1 -> 2#111; true -> 0 end,
    Body = [AP1, AP2, AP3, AP4, BoxRotate, CellRotate, PushBox, Enc, 0, 0].
 
calcAdmixpartFeedback(IsPluginBottle,IsAdmix,IsTurnOffBottle) ->
    B1 = if IsPluginBottle =:= 1 -> 1; true -> 0 end,
    B2 = if IsAdmix =:= 1 -> 2#111; true -> 0 end,
    B3 = if IsTurnOffBottle =:= 1 -> 1; true -> 0 end,
    (B3 bsl 4) bor (B2 bsl 1) bor B1. getPulseCnt(Crc, 16)-> [0,0,0,0];
 
getPulseCnt(Crc, 48)->
    [Crc bsr 16,0,0,0];
getPulseCnt(Crc, 80)->
    [Crc bsr 48,(Crc bsr 16) band 16#FFFFFFFF,0,0];
getPulseCnt(Crc, 112)->
    [Crc bsr 80, (Crc bsr 48) band 16#FFFFFFFF, (Crc bsr 16) band 16#FFFFFFFF,0];
getPulseCnt(Crc, 144)->
    [Crc bsr 112, (Crc bsr 80) band 16#FFFFFFFF, (Crc bsr 48) band 16#FFFFFFFF, (Crc bsr 16) band 16#FFFFFFFF]. %%客户端
 
client(N) ->
    {Res, Socket} = gen_udp:open(0, [binary]),
     io:format("client opened socket:~p ~p~n", [Res, Socket]),
    ok = gen_udp:send(Socket, "localhost", 4000, N),
    Value = receive
         {udp, Socket, _, _, Bin} ->
            io:format("client received:~p~n", [Bin])
         after
            2000 -> 0
         end,
    gen_udp:close(Socket),
    Value.
 
CRC模块代码:
-module(crc).
-export([comCrc16/1]).
for(Max, Max, F, R)-> F(R);
for(I, Max, F, R)->for(I + 1, Max, F, F(R)).
transform(R1) ->
    for(0, 7, fun(R)->
        begin
            Flag = R band 16#1,
            if Flag =/= 0 -> (R bsr 1) bxor 16#A001;
                true -> R bsr 1
            end
        end
    end, R1).
getCrcValue([H|T], R)->
    Ch = H band 16#FF,
    R1 = R bxor Ch,
    R2 = transform(R1),
    getCrcValue(T, R2);
getCrcValue([], R) ->
    R.
comCrc16(Data) ->
    Crc = getCrcValue(Data, 16#FFFF),
    First = Crc band 16#FF,
    Secend = Crc bsr 8,
     [First, Secend].
内容来自用户分享和网络整理,不保证内容的准确性,如有侵权内容,可联系管理员处理 点击这里给我发消息
标签: