Added start up code for the filter with all gains and added create zero matrix