SSSUP / Mbed 2 deprecated sample_servo-motor_sg-90_for_nucleo

サーボモーターの動作確認プログラム(nucleo版)

Dependencies:   mbed

main.cpp

Committer:
taquto
Date:
2 weeks ago
Revision:
3:cf99afcea25f
Parent:
2:80b1aa8ca93d

File content as of revision 3:cf99afcea25f:

#include "mbed.h"

PwmOut servo(A5);
Serial pc(SERIAL_TX, SERIAL_RX);

float calc(float);
int main()
{
    float a,b;
    servo.period_ms(20);
    wait_ms(100);
    pc.printf("\r\n---servo test---\n\r");
    while(1) {
        pc.printf("degree(-90~90) : ");
        pc.scanf("%f",&a);
        if(-90<=a&&a<=90) {
            b=calc(a);
            pc.printf("%f PWM:%f\r\n",a,b);
            servo.pulsewidth(b);
        } else {
            break;
        }
    }
    return 0;
}

float calc(float x)
{
    return (1.45+(2.4-0.5)/180*x)/1000;
}