Added own math routine and test app.