Added Schwefel function and SchwefelTest
Fix function and test