FireFly library: variant kept in the 2014 GitLab archive
GPS include disabled, out-of-reach flag instead of the 7-segment error. Exact date unknown; dated at the archive's first commit (Feb 2014).
This commit is contained in:
1 parent
6e50819e01
commit
413f52c008
2 files changed
+11
-9
No files matched your search
@@ -3,6 +3,7 @@
|
|||||||
|
|
||||||
//Variables
|
//Variables
|
||||||
boolean error;
|
boolean error;
|
||||||
|
boolean OOF; // OutOfReach
|
||||||
|
|
||||||
void RL3 (int i, Data *DataLine)
|
void RL3 (int i, Data *DataLine)
|
||||||
{
|
{
|
||||||
@@ -72,7 +73,7 @@ float T3 (Data *DataLine)
|
|||||||
|
|
||||||
void setleg (int i, Data *DataLine)
|
void setleg (int i, Data *DataLine)
|
||||||
{
|
{
|
||||||
Segment Seg;
|
//Segment Seg;
|
||||||
|
|
||||||
if (i < 3)
|
if (i < 3)
|
||||||
{
|
{
|
||||||
@@ -90,8 +91,8 @@ void setleg (int i, Data *DataLine)
|
|||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
error = true;
|
OOF = true;
|
||||||
Seg.sevenSegWrite('e');
|
//Seg.sevenSegWrite('e');
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
@@ -110,18 +111,19 @@ void setleg (int i, Data *DataLine)
|
|||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
error = true;
|
OOF = true;
|
||||||
Seg.sevenSegWrite('e');
|
//Seg.sevenSegWrite('e');
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void InverseKinemetics::IK(Data *DataLine)
|
void InverseKinemetics::IK(Data *DataLine)
|
||||||
{
|
{
|
||||||
Segment Seg;
|
//Segment Seg;
|
||||||
Seg.sevenSegWrite('o');
|
//Seg.sevenSegWrite('o');
|
||||||
|
|
||||||
error = false;
|
error = false;
|
||||||
|
OOF = false;
|
||||||
|
|
||||||
for (int i=0; i<6; i++)
|
for (int i=0; i<6; i++)
|
||||||
setleg(i, DataLine);
|
setleg(i, DataLine);
|
||||||
@@ -132,7 +134,7 @@ void InverseKinemetics::IK(Data *DataLine)
|
|||||||
if (i != 0)
|
if (i != 0)
|
||||||
Serial.print(", ");
|
Serial.print(", ");
|
||||||
else
|
else
|
||||||
Serial.print("### InverseKinemetics->ServosPosition's are: ");
|
Serial.print("### InverseKinemetics->ServoData[" + i + "]: ");
|
||||||
|
|
||||||
Serial.print(DataLine->ServoData[i].x);
|
Serial.print(DataLine->ServoData[i].x);
|
||||||
Serial.print(", ");
|
Serial.print(", ");
|
||||||
|
|||||||
@@ -17,7 +17,7 @@
|
|||||||
//Addons
|
//Addons
|
||||||
#include "Segment.h"
|
#include "Segment.h"
|
||||||
#include "IRremote.h"
|
#include "IRremote.h"
|
||||||
#include "TinyGPS.h"
|
//#include "TinyGPS.h"
|
||||||
//#include "WiiChuck.h"
|
//#include "WiiChuck.h"
|
||||||
//#include "Wire.h"
|
//#include "Wire.h"
|
||||||
|
|
||||||
|
|||||||
Reference in new issue
Block a user