Cleaned up SetSysClock to remove duplicated code when configuring HSE or HSI

git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@359 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61