int waitForStatusAndBlink(int statusIndex, int statusValue, int blinkGreen, int blinkRed, long timeout)
{
int* status;
int yesNo = 0;
struct timeval startTime;
struct timeval testTime;
long timeDiff;
if (timeout > 0)
{
gettimeofday(&startTime, NULL);
}
do {
status = GetSensorStatus();
if(status[statusIndex] == statusValue)
{
SetLedStatus(0, 0);
return 1;
}
else
{
if(yesNo == 0)
{
if(blinkGreen)
{
SetLedStatus(1, 0);
}
else if (blinkRed)
{
SetLedStatus(0, 1);
}
}
else
{
SetLedStatus(0, 0);
}
yesNo = !yesNo;
millisleep(BLINKING_SLEEP_TIME);
}
free(status);
if (timeout > 0)
{
gettimeofday(&testTime, NULL);
timeDiff = (testTime.tv_usec + 1000000 * testTime.tv_sec) - (startTime.tv_usec + 1000000 * startTime.tv_sec);
}
}
while(timeout == 0 || timeDiff < (timeout * 1000));
return 0;
}
void LedOff(int id)
{
SetLedStatus(id, 0);
}
void LedOn(int id)
{
SetLedStatus(id, 1);
}