Rosalyn Sleurink / Mbed 2 deprecated frdm_project_hoek

Script voor het aansturen van de motor

Dependencies:   mbed

main.cpp

Committer:
roosalyn
Date:
2015-09-15
Revision:
0:cceb961bd0de

File content as of revision 0:cceb961bd0de:

#include "mbed.h"
#include <iostream>
#include <string>
#include <math.h>

DigitalOut gpo(D0);
DigitalOut led(LED_RED);

float bereken_hoeken(float x, float y) {
    float langste_zijde = sqrt(pow(x*4,2) + pow(y*4,2));
    float alpha = acos((langste_zijde/2)/30);
    float beta = 0.5*M_PI - alpha;
    float hoek_arm2 = 2*beta;
    float hoek_arm1 = atan((4*y)/(4*x)) + alpha;
    return hoek_arm2;
}

int main()
{   
    printf("%.2f\n",bereken_hoeken(4,4));
    printf("%.4f\n",bereken_hoeken(3,7));
    printf("%.4f\n",bereken_hoeken(5,9));
    
    return 0;
}