diff options
Diffstat (limited to 'rs422lib/main.c')
| -rw-r--r-- | rs422lib/main.c | 11 |
1 files changed, 8 insertions, 3 deletions
diff --git a/rs422lib/main.c b/rs422lib/main.c index 34cb03e..0b1b946 100644 --- a/rs422lib/main.c +++ b/rs422lib/main.c @@ -5,6 +5,7 @@ int cnt=0; int cnt2=0; +int cnt3=0; void port_init(void) { @@ -22,6 +23,7 @@ void received(unsigned char* str,unsigned int len) { SWITCH_STATE(ST_RUN); cnt2=0; + cnt3=0; STATE(0)=0; SYSCALL(TEST); } @@ -115,10 +117,13 @@ void init_devices(void) // Clock tick using cycle estimation void basic_running_ex() { - int i; - for (i=950;i>0;--i) - delay_ms(1); + delay_ms(2); ++cnt2; + if (cnt2==250) + { + ++cnt3; + cnt2=0; + } SYSCALL(TEST); } |