Servo (SG-90) test program using FRDM-KL25Z
Test program for SG-90 Servo, using FRDM-KL25Z's TSI and PWM.
Although the servo is supposed to work with 5V, getting 5V from FRDM, it can work with 3.3V PWM out.
秋月でみつけてきた格安サーボ SG-90 を FRDM-KL25Z の TSI と PWM で動かしてみました。
5V仕様のサーボですが、5V電源はFRDMからとって、信号は3.3Vでも動いちゃいました。
ねこは帰り道のガチャポンで・・・
http://akizukidenshi.com/catalog/g/gM-08761/
Connection:
Servo FRDM-KL25Z
PWM=Orange D10(PTD0)
5V=RED FRDM 5V(J9-Pin10)
GND=Brown FRDM GND(J9-Pin12)
PWM spec
PWM Period 20ms (50Hz)
Duty Cycle (Positive Pulse) 1 ~ 2ms
Usage: (Do we really need it?)
使用方法: (いるのか?)
After downloading the program, touch your finger to TSI and move it.
プログラムをダウンロードしたら、TSIに指で触れて動かしてください。
main.cpp
- Committer:
- Rhyme
- Date:
- 2015-08-05
- Revision:
- 0:22feb43e29c6
File content as of revision 0:22feb43e29c6:
#include "mbed.h" #include "TSISensor.h" /** TSI_Cat * Test program for SG-90 * PWM = Orange : D10 (PTD0) * Vcc = Red(+) : 5V * GND = Brown(-) : GND * * PWM Period : 20ms (50Hz) * Duty Cycle : 1 - 2 ms * Note: when I set pulsewidth from 1000us to 2000us * the servo did not move -90degree to 90degree * so I chanced the value from 500us to 3500us * by watching the movement. */ TSISensor tsi ; PwmOut pwm(PTD0) ; // D10 int main() { float tsi_value ; pwm.period_ms(20) ; // 20ms period while(1) { tsi_value = tsi.readPercentage() ; pwm.pulsewidth_us(500+ 3500*(tsi_value)) ; wait(0.01) ; } }