Updated Coordinate Descent code

Need to check second algorithm's accuracy with Noah