2012-05-29 18:10:16 +02:00
|
|
|
// Def.h
|
|
|
|
|
// Define some Hard Coded Variables
|
|
|
|
|
// V3.0
|
2012-04-28 16:42:59 +02:00
|
|
|
|
|
|
|
|
//DEBUG CODES
|
2012-05-29 18:10:16 +02:00
|
|
|
//#define DEBUGC // Converter
|
|
|
|
|
//#define DEBUGIK // InverseKinemetics
|
|
|
|
|
//#define DEBUGS // Servos
|
2012-04-28 16:42:59 +02:00
|
|
|
//#define DEBUGHS // ServosHead
|
2012-05-29 18:10:16 +02:00
|
|
|
//#define DEBUGW // Watchdog
|
|
|
|
|
//#define Freeze // Protect all the servos
|
2012-04-28 16:42:59 +02:00
|
|
|
|
|
|
|
|
//InverseKinemetics VARIABLES
|
|
|
|
|
#define l2 15
|
|
|
|
|
#define l1 10
|
|
|
|
|
|
|
|
|
|
//Converter VARIABLES
|
|
|
|
|
#define smin0 600
|
|
|
|
|
#define smin1 960
|
|
|
|
|
#define smin2 600
|
|
|
|
|
#define smin3 600
|
|
|
|
|
#define smax0 2400
|
|
|
|
|
#define smax1 2100
|
|
|
|
|
#define smax2 2400
|
|
|
|
|
#define smax3 2400
|
