function newPitch = pitchSys(RotSpeed, oldRotSpeed, dT, HorWindV, ...

CurrBlPitch, Desired)
% Collective Pitch Control using lookup table

%Takes Rotor speed, Old rotor speed,time step, Horizontal wind speed,
% Current Pitch Angle, desired pitch angle

% Returns new blade pitch angle (vector length numBlades )

% %Set up turbine parameters

ratedRotor = 11.84;
maxRotor = 18.4;
PitchDeg = 8;
maxWind = 25;
maxPitch = 90;

maxPitch = maxPitch*pi/180;
PitchRate = PitchDeg *pi/180; %pitch rate in radians / sec
bldPitch = CurrBlPitch(1)*pi/180;
dRotSpeed = RotSpeed - oldRotSpeed;
Desired = Desired*pi/180; %convert to radians
if (HorWindV > maxWind) && (bldPitch < maxPitch)
%safety over-ride feather to shut down turbine
bldPitch = maxPitch;
elseif (HorWindV < 12) %less than control wind speed
%want pitch constant
bldPitch = 3*pi/180;
elseif (RotSpeed < ratedRotor) %less than rated rotor speed
bldPitch = desired;
elseif dRotSpeed < -0.5; %greater than rated Rotor Speed
%do nothing - rotor is already slowing down
else
bldPitch = desired;
end

newPitch = bldPitch;