Floating point routines

Added floating point numbers support for kp ki kd