Injo Kim
/
Smart_cruz_control_
hi
Hall_sesor.cpp@0:b9dc28a0bfcc, 2018-12-09 (annotated)
- Committer:
- injokim
- Date:
- Sun Dec 09 01:57:59 2018 +0000
- Revision:
- 0:b9dc28a0bfcc
hi;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
injokim | 0:b9dc28a0bfcc | 1 | #include "header.h" |
injokim | 0:b9dc28a0bfcc | 2 | |
injokim | 0:b9dc28a0bfcc | 3 | DigitalIn hall_value(D15); |
injokim | 0:b9dc28a0bfcc | 4 | |
injokim | 0:b9dc28a0bfcc | 5 | void Hall_sensor() |
injokim | 0:b9dc28a0bfcc | 6 | { |
injokim | 0:b9dc28a0bfcc | 7 | int meas,rev,flag,dist; |
injokim | 0:b9dc28a0bfcc | 8 | |
injokim | 0:b9dc28a0bfcc | 9 | flag = 0; |
injokim | 0:b9dc28a0bfcc | 10 | rev = 0; |
injokim | 0:b9dc28a0bfcc | 11 | int dm = 680; // diameter |
injokim | 0:b9dc28a0bfcc | 12 | |
injokim | 0:b9dc28a0bfcc | 13 | meas = hall_value.read(); |
injokim | 0:b9dc28a0bfcc | 14 | if(meas == 0 && flag ==0) |
injokim | 0:b9dc28a0bfcc | 15 | { |
injokim | 0:b9dc28a0bfcc | 16 | rev += 1; |
injokim | 0:b9dc28a0bfcc | 17 | flag = 1; |
injokim | 0:b9dc28a0bfcc | 18 | } |
injokim | 0:b9dc28a0bfcc | 19 | |
injokim | 0:b9dc28a0bfcc | 20 | else |
injokim | 0:b9dc28a0bfcc | 21 | { |
injokim | 0:b9dc28a0bfcc | 22 | flag = 0; |
injokim | 0:b9dc28a0bfcc | 23 | } |
injokim | 0:b9dc28a0bfcc | 24 | |
injokim | 0:b9dc28a0bfcc | 25 | dist = dm * rev; |
injokim | 0:b9dc28a0bfcc | 26 | |
injokim | 0:b9dc28a0bfcc | 27 | printf("measure = %d mV\n\r", meas); |
injokim | 0:b9dc28a0bfcc | 28 | printf("measure = %d mV\n\r", dist); |
injokim | 0:b9dc28a0bfcc | 29 | wait(0.2); // 200 ms |
injokim | 0:b9dc28a0bfcc | 30 | |
injokim | 0:b9dc28a0bfcc | 31 | } |