Aggiunta restituzione Z_acc su gamba
This commit is contained in:
Binary file not shown.
@@ -6,7 +6,7 @@
|
|||||||
|
|
||||||
class Gamba : public CollectionInterface {
|
class Gamba : public CollectionInterface {
|
||||||
protected:
|
protected:
|
||||||
std::vector<PieceInterface*> sensori;
|
std::vector<Sensore*> sensori;
|
||||||
std::vector<PieceInterface*> pezzi;
|
std::vector<PieceInterface*> pezzi;
|
||||||
std::vector<JointInterface*> joints;
|
std::vector<JointInterface*> joints;
|
||||||
public:
|
public:
|
||||||
@@ -15,6 +15,7 @@ class Gamba : public CollectionInterface {
|
|||||||
PieceInterface* getJointPiece();
|
PieceInterface* getJointPiece();
|
||||||
void setDirection(Direction dir);
|
void setDirection(Direction dir);
|
||||||
bool setTransparency(float alpha) override;
|
bool setTransparency(float alpha) override;
|
||||||
|
float getZ_Acc();
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
@@ -66,4 +66,14 @@ bool Gamba::setTransparency(float alpha){
|
|||||||
if (!i->setTransparency(alpha)) return false;
|
if (!i->setTransparency(alpha)) return false;
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
float Gamba::getZ_Acc(){
|
||||||
|
|
||||||
|
float totZ_Acc = 0;
|
||||||
|
for (auto i : sensori){
|
||||||
|
totZ_Acc += i->getZ_Acc();
|
||||||
|
}
|
||||||
|
|
||||||
|
return totZ_Acc;
|
||||||
}
|
}
|
||||||
@@ -40,7 +40,8 @@ void Sensore::initCSV(std::vector<std::vector<float>> data){
|
|||||||
|
|
||||||
//trovo il modulo di g facendo la media del modulo nei primi 1000 campioni
|
//trovo il modulo di g facendo la media del modulo nei primi 1000 campioni
|
||||||
gModule = 0;
|
gModule = 0;
|
||||||
for(int i = 0; i< data.size()>1000 ? 1000 : 10; i++){
|
int nCampioni = int(data.size())>1000 ? 1000 : 10;
|
||||||
|
for(int i = 0; i<nCampioni ;i++) {
|
||||||
gModule += sqrt(pow(gData[i][0],2)+pow(gData[i][1],2)+pow(gData[i][2],2));
|
gModule += sqrt(pow(gData[i][0],2)+pow(gData[i][1],2)+pow(gData[i][2],2));
|
||||||
}
|
}
|
||||||
gModule = gModule / 1000;
|
gModule = gModule / 1000;
|
||||||
|
|||||||
Reference in New Issue
Block a user