Code to let Gr20's BioRobotics2017 robot come to live.

Dependencies:   FastPWM MODSERIAL QEI mbed

ref.h

Committer:
megrootens
Date:
2017-11-12
Revision:
0:caa8ee3bd882
Child:
2:df0c6af898ac

File content as of revision 0:caa8ee3bd882:

/**
 * Reference signals
 */
namespace ref
{
const double kSampleTime = 0.01;
const double kCalibrationOmega = 20; // [deg/sec]
const double kCalibrationError = 1;
const double kCalibrationOmegaStep = kCalibrationOmega*kSampleTime;

const double kMinX = 0.290;
const double kMaxX = 0.600;

const double kMinY = -0.140;
const double kMaxY =  0.190;

const double kOriginTheta1 = robot::InverseKinematicsTheta(kMinX,kMinY,1);
const double kOriginTheta2 = robot::InverseKinematicsTheta(kMinX,kMinY,2);

const double kMaxSpeed = 0.05;// [m/s]
const double kMaxStep = kMaxSpeed*kSampleTime;

int i_demo_coord = 0;
const int kNumDemoCoords = 9;
const double kDemoCoords[2][kNumDemoCoords]  {
    {kMinX, kMaxX, kMaxX, kMinX, kMinX, kMaxX, kMaxX, kMinX, kMinX},
    {kMinY, kMinY, kMaxY, kMaxY, kMinY, kMaxY, kMinY, kMaxY, kMaxY}
    };

double theta_1 = 0;
double theta_2 = 0;

double get_ref_x();
double get_ref_y();



void SetPositionAsReference();

void UpdateReference();

void CalibrationReference();
void HomingReference();
void DemoReference();
}