Removed the convert from float to int
Added @simd and @inbounds
Minor cleanup