Timer T5 on Mega 2560

Hi all

I already tried several combinations using timer 5 instance but was not successful. Here is the original code

https://dl.dropboxusercontent.com/u/2248531/blog/metal_detector/metal_detector.ino

For Excample I tried the follwing and several combinations of it:
#define SET(x,y) (x |=(1<<y)) //-Bit set/clear macros
#define CLR(x,y) (x &= (~(1<<y))) // |
#define CHK(x,y) (x & (1<<y)) // |
#define TOG(x,y) (x^=(1<<y)) //-+

unsigned long t0=0; //-Last time
int t=0; //-time between ints
unsigned char tflag=0; //-Measurement ready flag

float SENSITIVITY= 1000.0; //-Guess what

//-Generate interrupt every 1000 oscillations of the search coil
SIGNAL(TIMER1_COMPA_vect)
{
OCR5A+=1000;
t=micros()-t0;
t0+=t;
tflag=1;
}

void setup()
{
pinMode(2,OUTPUT); //-piezo pin
digitalWrite(3,HIGH); //-NULL SW. pull up
//-Set up counter1 to count at pin 5
TCCR5A=0;
TCCR5B=0x07;
SET(TIMSK5,OCF5B);
}
//-Float ABS
float absf(float f)
{
if(f<0.0)
return -f;
else
return f;
}

int v0=0; //-NULL value
float f=0; //-Measurement value
unsigned int FTW=0; //-Click generator rate
unsigned int PCW=0; //-Click generator phase
unsigned long timer=0; //-Click timer
void loop()
{
if(tflag)
{
if(digitalRead(2)==LOW) //-Check NULL SW.
v0=t; //-Sample new null value
f=f*0.9+absf(t-v0)*0.1; //-Running average over 10 samples
tflag=0; //-Reset flag

float clf=f*SENSITIVITY; //-Convert measurement to click frequency
if(clf>10000)
clf=10000;
FTW=clf;
}

//-Click generator
if(millis()>timer)
{
timer+=10;
PCW+=FTW;
if(PCW&0x8000)
{
digitalWrite(3,HIGH);
PCW&=0x7fff;
}
else
digitalWrite(3,LOW);
}
}

No solution did work. Then I read the following "
Note that timer1 can be used on a Mega but does not support all three output pins OCR1A, OCR1B & OCR1C. Only A & B are supported. OCR1A is connected to pin 11 of the Mega and OCR1B to pin 12. Using one of the three calls that specify a pin, 1 will map to pin 11 on the Mega and 2 will map to pin 12. Timer3 has only been tested on the Mega"

But as well Timer3 (A) on Pin11 or (B) Pin12 did not work :-(.

Does anyone of you guys know how to handel it?