-module(udpserver).-import(crc,[comCrc161]).-export([start0,client1]).%%服务端start()->s
-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].
京公网安备 11010802041100号