
Octopus!!
Dependencies: 2017NHKpin_config FEP HMC6352 PID QEI R1307 ikarashiMDC omni_wheel
Fork of KANIv3 by
main.cpp@4:1073deb368df, 2017-09-06 (annotated)
- Committer:
- uchitake
- Date:
- Wed Sep 06 00:01:47 2017 +0900
- Revision:
- 4:1073deb368df
- Parent:
- 3:369d9ee17e84
- Child:
- 6:fe9767a50891
fix Drive Func
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
uchitake |
1:845af5425eec | 1 | #include "mbed.h" |
uchitake |
1:845af5425eec | 2 | #include "pin_config.h" |
uchitake |
1:845af5425eec | 3 | #include "bot.h" |
uchitake |
1:845af5425eec | 4 | |
uchitake |
1:845af5425eec | 5 | Bot KANI; |
uchitake |
1:845af5425eec | 6 | Serial pc(USBTX, USBRX, 115200); |
uchitake |
1:845af5425eec | 7 | |
uchitake |
1:845af5425eec | 8 | int main() |
uchitake |
1:845af5425eec | 9 | { |
uchitake |
1:845af5425eec | 10 | int i = 0; |
uchitake |
1:845af5425eec | 11 | pc.printf("const\n\r"); |
uchitake |
1:845af5425eec | 12 | while(1) { |
uchitake |
1:845af5425eec | 13 | KANI.confirmAll(); |
uchitake |
4:1073deb368df | 14 | // KANI.controllDrive(); |
uchitake |
4:1073deb368df | 15 | KANI.controllDrive2(); |
uchitake |
1:845af5425eec | 16 | KANI.controllMech(); |
uchitake |
3:369d9ee17e84 | 17 | KANI.calibrate(); |
uchitake |
1:845af5425eec | 18 | wait(INTERVAL); |
uchitake |
3:369d9ee17e84 | 19 | // pc.printf("%d\n\r", i++); |
uchitake |
1:845af5425eec | 20 | } |
uchitake |
1:845af5425eec | 21 | } |