45

Dependencies:   mbed BufferedSerial LS7366LIB FastPWM

Committer:
lsh2205
Date:
Mon Mar 23 08:38:40 2020 +0000
Revision:
0:c21936a3520a
ss

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lsh2205 0:c21936a3520a 1
lsh2205 0:c21936a3520a 2 Timer t;
lsh2205 0:c21936a3520a 3
lsh2205 0:c21936a3520a 4
lsh2205 0:c21936a3520a 5 int delay_time=0;
lsh2205 0:c21936a3520a 6
lsh2205 0:c21936a3520a 7 bool find_delay=false;
lsh2205 0:c21936a3520a 8
lsh2205 0:c21936a3520a 9 uint32_t loop_time = 0;
lsh2205 0:c21936a3520a 10 uint32_t ex_loop_time = 0;
lsh2205 0:c21936a3520a 11 uint32_t dif_loop_time = 0;
lsh2205 0:c21936a3520a 12 double loop_time_f = 0;
lsh2205 0:c21936a3520a 13
lsh2205 0:c21936a3520a 14 void timer_init()
lsh2205 0:c21936a3520a 15 {
lsh2205 0:c21936a3520a 16 //t.start();
lsh2205 0:c21936a3520a 17 }
lsh2205 0:c21936a3520a 18
lsh2205 0:c21936a3520a 19
lsh2205 0:c21936a3520a 20 void loop_time_run()
lsh2205 0:c21936a3520a 21 {
lsh2205 0:c21936a3520a 22 loop_time = t.read_us();
lsh2205 0:c21936a3520a 23 dif_loop_time=loop_time-ex_loop_time;
lsh2205 0:c21936a3520a 24 ex_loop_time = loop_time;
lsh2205 0:c21936a3520a 25
lsh2205 0:c21936a3520a 26 loop_time_f=(double)dif_loop_time;
lsh2205 0:c21936a3520a 27
lsh2205 0:c21936a3520a 28 if(dif_loop_time==2000)
lsh2205 0:c21936a3520a 29 find_delay=true;
lsh2205 0:c21936a3520a 30
lsh2205 0:c21936a3520a 31 if(find_delay==false)
lsh2205 0:c21936a3520a 32 {
lsh2205 0:c21936a3520a 33 if(dif_loop_time>2000)
lsh2205 0:c21936a3520a 34 delay_time--;
lsh2205 0:c21936a3520a 35 if(dif_loop_time<2000)
lsh2205 0:c21936a3520a 36 delay_time++;
lsh2205 0:c21936a3520a 37 }
lsh2205 0:c21936a3520a 38
lsh2205 0:c21936a3520a 39 wait_us(delay_time);
lsh2205 0:c21936a3520a 40 }