Homec4science
Diffusion HHRI-software (hri-gen2) Browse

R2671/MATLAB/Functions/usartSendPacket.m
057403177fbchri-gen2

Last Change
Raw File

usartSendPacket.m
View Options

This document is not UTF8. It was detected as ISO-8859-1 (Latin 1) and converted to UTF8 for display.
function [ERR] = usartSendPacket(Request, PayLoad, COMOPT, s)
% Transmition d'une trame de données via port COM. Deux formats de trame
% disponible :
%
% Trame sans données -> |.START.|
% Trame avec données -> |.START.|.DATA1 ... DATAn.|
%
% Arguments :
% - Request -> Une des requêtes listées dans "HostRequestList.m"
% - PayLoad -> Les données à envoyer sous forme d'un vecteur [data1,data2 ... dataN]
% avec N plus petit ou égal à "COMOPT.MaxPayloadSize".
% Si pas de PayLoad laisser vide ([])
%
% Erreur1 : Si la requète ne doit pas être accompagrnée de donnée et que
% PayLoad != []
%
% Erreur2 : Si la taille de la PayLoad >= COMOPT.MaxPayloadSize
%
PayLoadSize = max(size(PayLoad)); %En nb. de int32
ERR = 0;
if(PayLoadSize>COMOPT.MaxPayloadSize)
disp('PayLoad trop grande pour être envoyée en 1 fois');
ERR = 1;
return;
end
if((Request<5) && (PayLoadSize>0))
disp('Cette requète ne peut pas être accompagnée de donnée');
ERR = 2;
return;
end
if(PayLoadSize) %Si Payload existante
%Crée un packet vide (entête mais sans payload)
packet = [ COMOPT.StartFrame + Request,...
zeros(1,2*PayLoadSize*4)];
%Ajout de la payload sous forme de segments de 2*4 bits
for i=1:PayLoadSize
tmp0 = dec2hex(PayLoad(i),8);
packet(2+(i-1)*8:9+(i-1)*8) = [hex2dec(tmp0(7)),hex2dec(tmp0(8)),hex2dec(tmp0(5)),hex2dec(tmp0(6)),...
hex2dec(tmp0(3)),hex2dec(tmp0(4)),hex2dec(tmp0(1)),hex2dec(tmp0(2))];
%78 56 34 12 because this corresponds to the data bytes 3 2 1 0.
end
else %Si pas de Payload
packet = COMOPT.StartFrame + Request;
end
% Envoit le packet
fwrite(s,packet);
c4science · Help