/* Returns the current frequency in Hz (meaning 97.5MHz will be returned as 97,500,000 etc.  */
uint32_t tea5767GetFrequency(void)
/* Returns the current frequency in Hz (meaning 97.5MHz will be returned as 97,500,000 etc.  */
uint32_t tea5767GetFrequency(void)
{
  uint32_t frequency = 0;
  uint8_t buffer[5] = { 0, 0, 0, 0, 0 };
  if (!_tea5767Initialised) tea5767Init();
  tea5767ReadData(&buffer[0]);
  frequency = ((buffer[0] & 0x3F) << 8) + buffer[1];
  frequency = frequency * 32768 / 4 - 225000;
  return frequency;
}