Test probram to setup XBus servo settings.
Dependencies: ACM1602NI XBusServo mbed-src
This is just a working sample. This is setup tool for XBus servo. You can change all setting on XBus servo. Tested only on KL25Z
これはただの動作サンプルです。 これはXBusサーボ用のセットアップツールです。 このコードで、XBusサーボの全てのセッティングが変更できます。 KL25Z上でのみ動作確認しています。
main.cpp@0:3e197b983b65, 2014-10-02 (annotated)
- Committer:
- sawa
- Date:
- Thu Oct 02 08:47:49 2014 +0000
- Revision:
- 0:3e197b983b65
- Child:
- 1:4fdeb414f4ce
proto 0.0.1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sawa | 0:3e197b983b65 | 1 | /* main.c file |
sawa | 0:3e197b983b65 | 2 | * |
sawa | 0:3e197b983b65 | 3 | * for testing mbed XBusServo.cpp |
sawa | 0:3e197b983b65 | 4 | * |
sawa | 0:3e197b983b65 | 5 | * Copyright (c) 2014-2014 JR PROPO |
sawa | 0:3e197b983b65 | 6 | * by Zak Sawa |
sawa | 0:3e197b983b65 | 7 | */ |
sawa | 0:3e197b983b65 | 8 | |
sawa | 0:3e197b983b65 | 9 | #include "mbed.h" |
sawa | 0:3e197b983b65 | 10 | //#include "I2CLCD.h" |
sawa | 0:3e197b983b65 | 11 | #include "XBusServo.h" |
sawa | 0:3e197b983b65 | 12 | |
sawa | 0:3e197b983b65 | 13 | |
sawa | 0:3e197b983b65 | 14 | //I2CLCD LCD(I2C_SDA, I2C_SCL); |
sawa | 0:3e197b983b65 | 15 | XBusServo XBus(PTD3, PTD2, 10); |
sawa | 0:3e197b983b65 | 16 | Ticker timer; |
sawa | 0:3e197b983b65 | 17 | |
sawa | 0:3e197b983b65 | 18 | |
sawa | 0:3e197b983b65 | 19 | |
sawa | 0:3e197b983b65 | 20 | void XbusIntervalHandler() |
sawa | 0:3e197b983b65 | 21 | { |
sawa | 0:3e197b983b65 | 22 | XBus.sendChannelDataPacket(); |
sawa | 0:3e197b983b65 | 23 | } |
sawa | 0:3e197b983b65 | 24 | |
sawa | 0:3e197b983b65 | 25 | |
sawa | 0:3e197b983b65 | 26 | |
sawa | 0:3e197b983b65 | 27 | int main() |
sawa | 0:3e197b983b65 | 28 | { |
sawa | 0:3e197b983b65 | 29 | uint16_t theValue = kXbusServoNeutral; |
sawa | 0:3e197b983b65 | 30 | |
sawa | 0:3e197b983b65 | 31 | XBus.addServo(0x01, kXbusServoNeutral); |
sawa | 0:3e197b983b65 | 32 | |
sawa | 0:3e197b983b65 | 33 | printf("added"); |
sawa | 0:3e197b983b65 | 34 | // timer.attach_us(&XbusIntervalHandler, kXBusInterval * 1000); |
sawa | 0:3e197b983b65 | 35 | |
sawa | 0:3e197b983b65 | 36 | // while(1) { |
sawa | 0:3e197b983b65 | 37 | // theValue += 10; |
sawa | 0:3e197b983b65 | 38 | // XBus.setServo(0x01, theValue); |
sawa | 0:3e197b983b65 | 39 | // } |
sawa | 0:3e197b983b65 | 40 | } |