void tea5767SetFreq(unsigned int freq)
{
    unsigned char buffer[6];
    unsigned int div = ((unsigned long)freq * 12500 + 28125)/1024; //>>10
    buffer[0]=0xC0;// tea5767 addr
    buffer[1] = (div >> 8) & 0x3F;
    buffer[2] = div & 0xff;
    buffer[3] = 0b00001010;
    buffer[4] = 0b00011110;
    buffer[5] = 0b00000000;
    if (!(vars&(1 << 1))) //enable mute
    {
  buffer[1] |= 1<<7;
  buffer[4] |= 1<<6;
    }
    asm volatile ("cli");
    i2c_start();
    i2c_master_send(buffer, 6);
    i2c_stop();
    asm volatile ("sei");
}