Aggiunta restituzione Z_acc su gamba
This commit is contained in:
Binary file not shown.
@@ -6,7 +6,7 @@
|
||||
|
||||
class Gamba : public CollectionInterface {
|
||||
protected:
|
||||
std::vector<PieceInterface*> sensori;
|
||||
std::vector<Sensore*> sensori;
|
||||
std::vector<PieceInterface*> pezzi;
|
||||
std::vector<JointInterface*> joints;
|
||||
public:
|
||||
@@ -15,6 +15,7 @@ class Gamba : public CollectionInterface {
|
||||
PieceInterface* getJointPiece();
|
||||
void setDirection(Direction dir);
|
||||
bool setTransparency(float alpha) override;
|
||||
float getZ_Acc();
|
||||
};
|
||||
|
||||
#endif
|
||||
@@ -67,3 +67,13 @@ bool Gamba::setTransparency(float alpha){
|
||||
}
|
||||
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
|
||||
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 = gModule / 1000;
|
||||
|
||||
Reference in New Issue
Block a user