Initial checkin

Basic functions implemented and tested.
Replacements for sqrt(), sin(), cos(), tan()
TODO: acos, atan2