Function to compute witsenhausen cost for any given pair of functions