Injo Kim
/
Smart_cruz_control_
hi
Laser.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 LaserSensor(D2); |
injokim | 0:b9dc28a0bfcc | 4 | DigitalOut my_led(LED1); |
injokim | 0:b9dc28a0bfcc | 5 | PwmOut my_servo(PB_0); |
injokim | 0:b9dc28a0bfcc | 6 | |
injokim | 0:b9dc28a0bfcc | 7 | int Laser() |
injokim | 0:b9dc28a0bfcc | 8 | { |
injokim | 0:b9dc28a0bfcc | 9 | int cmd; |
injokim | 0:b9dc28a0bfcc | 10 | |
injokim | 0:b9dc28a0bfcc | 11 | if(LaserSensor == 1) |
injokim | 0:b9dc28a0bfcc | 12 | { |
injokim | 0:b9dc28a0bfcc | 13 | my_led = 0; |
injokim | 0:b9dc28a0bfcc | 14 | cmd=0; |
injokim | 0:b9dc28a0bfcc | 15 | } |
injokim | 0:b9dc28a0bfcc | 16 | |
injokim | 0:b9dc28a0bfcc | 17 | else |
injokim | 0:b9dc28a0bfcc | 18 | { |
injokim | 0:b9dc28a0bfcc | 19 | my_led = 1; |
injokim | 0:b9dc28a0bfcc | 20 | cmd=1; |
injokim | 0:b9dc28a0bfcc | 21 | } |
injokim | 0:b9dc28a0bfcc | 22 | wait(0.1); |
injokim | 0:b9dc28a0bfcc | 23 | return cmd; |
injokim | 0:b9dc28a0bfcc | 24 | } |
injokim | 0:b9dc28a0bfcc | 25 | |
injokim | 0:b9dc28a0bfcc | 26 | void Laser_servo(int i) |
injokim | 0:b9dc28a0bfcc | 27 | { |
injokim | 0:b9dc28a0bfcc | 28 | if (i==1) |
injokim | 0:b9dc28a0bfcc | 29 | { |
injokim | 0:b9dc28a0bfcc | 30 | my_servo.period_ms(20); |
injokim | 0:b9dc28a0bfcc | 31 | my_servo.write(0.1); |
injokim | 0:b9dc28a0bfcc | 32 | } |
injokim | 0:b9dc28a0bfcc | 33 | |
injokim | 0:b9dc28a0bfcc | 34 | else |
injokim | 0:b9dc28a0bfcc | 35 | { |
injokim | 0:b9dc28a0bfcc | 36 | my_servo.period_ms(20); |
injokim | 0:b9dc28a0bfcc | 37 | my_servo.write(0.25); |
injokim | 0:b9dc28a0bfcc | 38 | } |
injokim | 0:b9dc28a0bfcc | 39 | } |