function addpz(Editor,CurrentAxes)
%ADDPZ  Adds pole or zero to editor.

%   Author(s): P. Gahinet
%   Copyright 1986-2002 The MathWorks, Inc. 
%   $Revision: 1.25 $  $Date: 2002/04/10 04:56:10 $

% Pointers
Ts = Editor.EditedObject.Ts;
PlotAxes = getaxes(Editor.Axes);
EventMgr = Editor.EventManager;

% Gather info about added root
AddInfo =  Editor.EditModeData; 

% Acquire new pole/zero position 
PlotAxes = PlotAxes(PlotAxes==CurrentAxes);
CP = get(PlotAxes,'CurrentPoint');
X = unitconv(CP(1,1),Editor.Axes.XUnits,'rad/sec');

% Determine root value based on pole/zero type
[Zeros,Poles,GroupType,Status,Action] = ...
    LocalGetRootValue(X,AddInfo.Group,AddInfo.Root,Ts,Editor.EditedObject.Identifier);

% Start transaction
T = ctrluis.transaction(Editor.LoopData,'Name',Action,...
    'OperationStore','on','InverseOperationStore','on');

% Add new pole/zero group to database
Editor.EditedObject.addpz(GroupType,Zeros,Poles);

% Register transaction 
EventMgr.record(T);

% Notify peers of data change
Editor.LoopData.dataevent('all');

% Confirm operation in status bar and update history
EventMgr.newstatus(Status);
EventMgr.recordtxt('history',Status);


%----------------- Local functions -----------------

%%%%%%%%%%%%%%%%%%%%%
% LocalGetRootValue %
%%%%%%%%%%%%%%%%%%%%%
function [Zeros,Poles,GroupType,Status,Action] = LocalGetRootValue(X,GroupType,PZType,Ts,CompID)
% Infers specified root value from mouse location

% RE: * Uses only the natural frequency info (X = Wn)
%     * X is in rad/sec
if Ts
    DomainVar = 'z';
else
    DomainVar = 's';
end
CompID = sprintf('%s(%s)',CompID,DomainVar);


switch GroupType
case 'Real'
    % Real pole/zero. RE: Assume stability
    R = LocalRootValue(-X,Ts);
    if strcmpi(PZType,'Zero')
        Zeros = R;  Poles = zeros(0,1);
    else
        Poles = R;  Zeros = zeros(0,1);
    end
    Status = sprintf('Added real %s to %s at %s = %.3g',lower(PZType),CompID,DomainVar,R);
    Action = sprintf('Add %s',PZType);
    
case 'Complex'
    % Complex pole zero: assume stability + damping = 1.0
    R = LocalRootValue(-X,Ts);
    if strcmpi(PZType,'Zero')
        Zeros = [R;R];  Poles = zeros(0,1);
    else
        Poles = [R;R];  Zeros = zeros(0,1);
    end
    Status = sprintf('Added complex pair of %ss to %s at %s = %.3g %s %.3gi',...
        lower(PZType),CompID,DomainVar,real(R),char(177),0);
    Action = sprintf('Add %s',PZType);
    
case 'Lead'
    % Lead network (s+tau1)/(s+tau2)  tau1<tau2
    Zeros = LocalRootValue(-X/1.5,Ts);
    Poles = LocalRootValue(-X,Ts);
    GroupType = 'LeadLag';
    Status = sprintf('Added lead network to %s with zero at %s = %.3g and pole at %s = %.3g',...
        CompID,DomainVar,Zeros,DomainVar,Poles);
    Action = 'Add Lead';
    
case 'Lag'
    % Lag network (s+tau1)/(s+tau2)  tau1>tau2
    Zeros = LocalRootValue(-1.5*X,Ts);
    Poles = LocalRootValue(-X,Ts);
    GroupType = 'LeadLag';
    Status = sprintf('Added lag network to %s with zero at %s = %.3g and pole at %s = %.3g',...
        CompID,DomainVar,Zeros,DomainVar,Poles);
    Action = 'Add Lag';

case 'Notch'
    % Notch filter: default is zeta1=0.05,zeta2=0.5 (1/2 max width and 20dB depth)
    z1 = 0.05;   z2 = 0.5;
    r1 = X * (-z1 + 1i*sqrt(1-z1^2));
    r2 = X * (-z2 + 1i*sqrt(1-z2^2));
    Zeros = LocalRootValue([r1;conj(r1)],Ts);
    Poles = LocalRootValue([r2;conj(r2)],Ts);
    Status = sprintf('Added notch filter to %s with zeros at %s = %.3g %s %.3gi and poles at %s = %.3g %s %.3gi',...
        CompID,DomainVar,real(Zeros(1)),char(177),abs(imag(Zeros(1))),...
        DomainVar,real(Poles(1)),char(177),abs(imag(Poles(1))));
    Action = 'Add Notch';

end


%%%%%%%%%%%%%%%%%%
% LocalRootValue %
%%%%%%%%%%%%%%%%%%
function R = LocalRootValue(R,Ts)
% Convert to discrete time values if necessary
if Ts,
    R = exp(Ts*R);
end