calc_mode function

Calculate mode