Simple example for the SimonK_I2C_ESC. Tested on the FRDM K64F.
Dependencies: SimonK_I2C_ESC mbed
main.cpp@0:f30c4157d617, 2016-04-01 (annotated)
- Committer:
- azazeal88
- Date:
- Fri Apr 01 07:11:15 2016 +0000
- Revision:
- 0:f30c4157d617
Added comments
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
azazeal88 | 0:f30c4157d617 | 1 | #include "mbed.h" |
azazeal88 | 0:f30c4157d617 | 2 | #include "SimonK_I2C_ESC.h" |
azazeal88 | 0:f30c4157d617 | 3 | |
azazeal88 | 0:f30c4157d617 | 4 | #define ESC_ADDRESS 0x2B |
azazeal88 | 0:f30c4157d617 | 5 | |
azazeal88 | 0:f30c4157d617 | 6 | I2C i2c(D14, D15); |
azazeal88 | 0:f30c4157d617 | 7 | SimonK_I2C_ESC motor(i2c, ESC_ADDRESS); |
azazeal88 | 0:f30c4157d617 | 8 | Serial pc(USBTX, USBRX); |
azazeal88 | 0:f30c4157d617 | 9 | |
azazeal88 | 0:f30c4157d617 | 10 | int main() { |
azazeal88 | 0:f30c4157d617 | 11 | i2c.frequency (400); |
azazeal88 | 0:f30c4157d617 | 12 | motor.set(0); |
azazeal88 | 0:f30c4157d617 | 13 | while(true){ |
azazeal88 | 0:f30c4157d617 | 14 | |
azazeal88 | 0:f30c4157d617 | 15 | motor.update(); |
azazeal88 | 0:f30c4157d617 | 16 | pc.printf("ESC: "); |
azazeal88 | 0:f30c4157d617 | 17 | |
azazeal88 | 0:f30c4157d617 | 18 | if(motor.isAlive()) pc.printf("OK\t\t"); |
azazeal88 | 0:f30c4157d617 | 19 | else pc.printf("NA\t\t"); |
azazeal88 | 0:f30c4157d617 | 20 | |
azazeal88 | 0:f30c4157d617 | 21 | pc.printf("%d",motor.rpm());pc.printf(" RPM\t\t"); |
azazeal88 | 0:f30c4157d617 | 22 | pc.printf("%f",motor.voltage());pc.printf(" V\t\t"); |
azazeal88 | 0:f30c4157d617 | 23 | pc.printf("%f",motor.current());pc.printf(" A\t\t"); |
azazeal88 | 0:f30c4157d617 | 24 | pc.printf("%f",motor.temperature());pc.printf(" `C"); |
azazeal88 | 0:f30c4157d617 | 25 | pc.printf("\n\r"); |
azazeal88 | 0:f30c4157d617 | 26 | |
azazeal88 | 0:f30c4157d617 | 27 | wait_ms(250); |
azazeal88 | 0:f30c4157d617 | 28 | //motor.set(10); |
azazeal88 | 0:f30c4157d617 | 29 | |
azazeal88 | 0:f30c4157d617 | 30 | |
azazeal88 | 0:f30c4157d617 | 31 | } |
azazeal88 | 0:f30c4157d617 | 32 | } |