通过振动向Linux ThinkPad传输信息(3)

while(1) 
{  
ret = hdaps_read_pair(HDAPS_PORT_XPOS, HDAPS_PORT_YPOS, &x, &y);  
if (!ret)  {   if( x != 0 && y != 0 )   
{    
// if its a successful read and not a zero read    
if( baseX == -5000 )    
{     baseX = x;     
baseY = y;    
}

if( abs(baseX - x) > dimShiftX || abs(baseY - y) > dimShiftY )    
{     
totalDev += abs(baseX - x);     
totalDev += abs(baseY - y);     
baseX = x;     baseY = y;    
}    
if( totalDev > devThreshold )    
{     printk(KERN_EMERG 
"ok, ok! you're shaking my substrate - restarting");     
emergency_restart();    }   
}//if not a zero value  
}//if successful read of hdaps data 
}//infinite while