Group19-Biorobotics

Dependencies:   HIDScope MODSERIAL PID QEI SigInterpreternovember2 biquadFilter mbed

Fork of Robot_control_v3 by Fabian van Hummel

initialize.h

Committer:
fabian101
Date:
2016-10-28
Revision:
4:bfdcf3da7cff
Parent:
2:6b913f93bc0b
Child:
6:a4440eec3652

File content as of revision 4:bfdcf3da7cff:

#include "mbed.h"
#include "MODSERIAL.h"
#include "BiQuad.h"
#include "math.h"
#include "HIDScope.h"
#include "QEI.h"
#include <string>
#include <time.h>
#include "PID.h"



const double b0_1 = 0.70711268813;
const double b1_1 = -1.41363497311;
const double b2_1 = 0.70711268813;
const double a1_1 = -1.24805920374;
const double a2_1 = 0.48711380285;

const double b0_2 = 0.80740871857;
const double b1_2 = -1.61097022054;
const double b2_2 = 0.80740871857;
const double a1_2 = -1.82350353127;
const double a2_2 = 0.9185193031;

const double b0_3 = 0.21109745634;
const double b1_3 = 0.39721518527;
const double b2_3 = 0.21109745634;
const double a1_3 = -0.92654918100;
const double a2_3 = 0.27581060293;

const double b0_4 = 0.18082791262;
const double b1_4 = 0.23319763548;
const double b2_4 = 0.18082791262;
const double a1_4 = -0.66923015321;
const double a2_4 = 0.52307551251;

const double b0_5 = 0.28421571310;
const double b1_5 = 0.25361917977;
const double b2_5 = 0.28421571310;
const double a1_5 = -0.47420826307;
const double a2_5 = 0.8333973552;
    

// occupied pins: A0,A1,A2,A3,D2,D4,D5,D6,D7,D2,D12, D13,D14, D15,