Amanda Ghassaei / Mbed 2 deprecated Bracky-MPU6050-DMP

bio robot

Dependencies:   MPU6050-DMP QEI_hw mbed-rpc mbed

Fork of MPU6050_Example by Shundo Kishi

Controls/Dynamics.h

Committer:
amandaghassaei
Date:
2015-12-05
Revision:
10:769cc457c3a4
Parent:
9:1d9b24d7ac77
Child:
12:49813131dd15

File content as of revision 10:769cc457c3a4:

#ifndef Dynamics_h
#define Dynamics_h


#include "Kinematics.h"
#include "Gains.h"


float calcTau(volatile float z[4], float p[10], Gains *gains, Serial *pc);
float thetaDesired(float range, float th1, float th2, float dth1, float dth2);
int fix(float val);//round toward zero
int signNonZero(float val);





#endif