Added basic math fuctions

Signed-off-by: dragonCASTjosh <dragonCASTjosh@gmail.com>