FIX: error handling in ps2.c

This commit is contained in:
tmk 2011-01-11 21:30:35 +09:00
parent 035b286b24
commit 1f5cd6d7dc
1 changed files with 7 additions and 1 deletions

8
ps2.c
View File

@ -104,9 +104,9 @@ uint8_t ps2_host_send(uint8_t data)
/* request to send */
clock_lo();
data_lo();
_delay_us(100);
/* start bit [1] */
data_lo();
clock_hi();
WAIT(clock_lo, 15000, 1);
/* data [2-9] */
@ -137,6 +137,9 @@ uint8_t ps2_host_send(uint8_t data)
return 1;
ERROR:
/* inhibit device to send */
data_hi();
clock_lo();
return 0;
}
@ -187,6 +190,9 @@ uint8_t ps2_host_recv(void)
return data;
ERROR:
/* inhibit device to send */
data_hi();
clock_lo();
return 0;
}