How to get 20khz PWM on pin D9

You forgot something...

void setup()  {
  analogWriteSAH_Init();
...