一个算法有关问题

一个算法问题
查表算法：

一个数组999-1121，步进5，在正负2之间变动。
例如输入的数字为999或1000，1001，则index=0;
输入的数字1004±2（1002，1003，1004，1005，1006），则index=1;
输入的数字1009±2（1007，1008，1009，1010，1011），则index=2;

。。。。
以此类推。
请帮我写出C\C++代码。谢谢。

------解决方案--------------------
int fun(int iTest)
{
if (iTest < 1002)
return 0;
iTest = iTest - 1001;
return iTest / 5 + 1;
}