-Adding init
Return strings instead of floats
- Adding prints for printf like function to serial