A
Dependencies: mbed Servo SRF02
main.cpp@0:79e503305664, 2021-12-14 (annotated)
- Committer:
- kosukesuzuki
- Date:
- Tue Dec 14 10:58:05 2021 +0000
- Revision:
- 0:79e503305664
A
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kosukesuzuki | 0:79e503305664 | 1 | #include "mbed.h" |
kosukesuzuki | 0:79e503305664 | 2 | #include "SRF02.h" |
kosukesuzuki | 0:79e503305664 | 3 | #include "Servo.h" |
kosukesuzuki | 0:79e503305664 | 4 | |
kosukesuzuki | 0:79e503305664 | 5 | SRF02 sensor(p9,p10,0xE0); |
kosukesuzuki | 0:79e503305664 | 6 | Servo myservo(p21); |
kosukesuzuki | 0:79e503305664 | 7 | Serial pc(USBTX,USBRX,9600); |
kosukesuzuki | 0:79e503305664 | 8 | |
kosukesuzuki | 0:79e503305664 | 9 | int main() { |
kosukesuzuki | 0:79e503305664 | 10 | while(1) { |
kosukesuzuki | 0:79e503305664 | 11 | int d = sensor.getDistanceCm(); |
kosukesuzuki | 0:79e503305664 | 12 | pc.printf("Distance = %d cm\r\n",d); |
kosukesuzuki | 0:79e503305664 | 13 | |
kosukesuzuki | 0:79e503305664 | 14 | if(d <= 30){ |
kosukesuzuki | 0:79e503305664 | 15 | pc.printf("motor"); |
kosukesuzuki | 0:79e503305664 | 16 | for(int m =0; m <100; m++) { |
kosukesuzuki | 0:79e503305664 | 17 | myservo = m/100.0; |
kosukesuzuki | 0:79e503305664 | 18 | wait(0.01); |
kosukesuzuki | 0:79e503305664 | 19 | } |
kosukesuzuki | 0:79e503305664 | 20 | } |
kosukesuzuki | 0:79e503305664 | 21 | } |
kosukesuzuki | 0:79e503305664 | 22 | } |