M9 Biorobotics Group 8 / Mbed 2 deprecated servomotorcode

servo motor werkt eindelijk!!!! wiehoe!!!

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

main.cpp

Committer:
IsaRobin
Date:
2019-10-29
Revision:
2:f92eadfd1a27
Parent:
1:1b33fd02e6b1
Child:
3:f30c2ded1a58

File content as of revision 2:f92eadfd1a27:

/* servo motor program - biorbotics groep 8 */

#include <Servo.h>
#include <mbed.h>
#include <math.h>    /* cos */
#include <MODSERIAL.h>


MODSERIAL pc(USBTX, USBRX);


Servo myservo(D3);


int main()
{
    pc.baud(115200);
    pc.printf("starting main .\r.\n");
    myservo.Enable(1410,20000);

    while(true) {
        pc.printf("starting.\r.\n");
        
        for (int pos = 1410; pos < 1590; pos += 5) {
            myservo.SetPosition(pos);
            wait_ms(20);
        }
        pc.printf("kant 1.\r.\n");
        for (int pos = 1590; pos > 1410; pos -= 5) {
            myservo.SetPosition(pos);
            wait_ms(20);
        }
        pc.printf("kant 2.\r.\n");
    }

}