PS2无线手柄单片机应用，PS2解码，PS2控制舵机，PS2遥控小车stm32，arduino的PS2库

13719272278

u8 PS2_DataKey()
{
        u8 index;

        PS2_ClearData();
        PS2_ReadData();

        Handkey=(Data[4]<<8)|Data[3];     //这是16个按键  按下为0， 未按下为1
        for(index=0;index<16;index++)
        {            
                if((Handkey&(1<<(MASK[index]-1)))==0)
                return index+1;
        }
        return 0;          //没有任何按键按下
}
请问这个检测手柄按键的函数是不是有问题，好像不能准确检测16个按键，求指点