Removed floats

Removed floats from most places

Initial port to C

This is the first iteration where we took the code from Salvi et al. and ported it to C