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-11
Revision:
20:f13b949b623b
Parent:
18:0cfe72d8a006

File content as of revision 20:f13b949b623b:

#ifndef Dynamics_h
#define Dynamics_h


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


float calcTau(volatile float z[4], float p[10], Gains *gains, Target *target, Serial *pc);
float thetaDesiredForSwingUp(float rangeMin, float rangeMax, volatile float z[4]);
float obstacleAvoidance(volatile float z[4], float p[10], float theta);
float overallGainForSwingUp(volatile float z[4], float th2Des, Gains *gains);


#endif