Re-add removed code to wcd9320.c