Moved duplicate code to function. Removed superfluous include. Signed-off-by: Morten Priess <mtpr@oticon.com>