Chrip Signal

Hey,

ich habe mir ein Chirp signal in Matlab mir selbst programmiert. Ich 
will das Eingangssignal (hier s1) später mit dem x1 die Kovarainz 
bestimmen für die bestimmung von Timedelay.
meine Parameter für Ultraschallsensoren:

----------------------------
param.B=4*10^3 ;%band width [Hz]
param.fc=40*10^3; %carrier frequency [Hz]
param.Tp=5*10^-3; %Pulslänge [s]f
param.fs = 2*(param.fc+param.B/2);
----------------------------
und mein Chirp Signal selbst:
----------------------------
function [s1,x1,param] = chirp_signal(timedelay,noise,param)

B=param.B;
Tp=param.Tp;
fc=param.fc;
fmin=fc-B/2 ; %frequence minimum
fmax=fc+B/2 ; %frequence maximum
fs=param.fs ;

Nc=floor(Tp*fs);

t=(0:Nc-1)/fs;%[s]

param.N=size(t,2); %sample size



%Chirp Factor
K=B/Tp ;
if fs>=2*(fmax) %Nyquist Theorem eingehalten?

    s1 = cos(2*pi*fmin.*t+pi*K.*t.^2)+noise;
    x1 =cos(2*pi*fmin.*(t-timedelay)+pi*K.*(t-timedelay).^2)+noise;

end

-------------------

Im wesentliche habe ich zwei Probleme:
-1.Ist das Signal korrekt so beschrieben?
-2.Wenn ich mir FFT zeichnen lassen von dem Signal oben sowohl von 
eigenentlichen und verschobenen signal, habe ich das Gefühl, dass die 
verschiebung nicht stimmt.

Kann mir jemand helfen, hänge seit langem an dem Projekt- und ich will 
nicht die Built-In Version von Matlab verwenden. Habe es extra selbst 
gemacht.