examples/JAcoustics/JSeabed.cc File Reference

Auxiliary application to determine tilt angles of seabed based on tripod positions. More...

#include <string>
#include <iostream>
#include <iomanip>
#include <vector>
#include "JDetector/JTripod.hh"
#include "JMath/JSVD3D.hh"
#include "Jeep/JContainer.hh"
#include "Jeep/JParser.hh"
#include "Jeep/JMessage.hh"

Go to the source code of this file.

Functions
int	main (int argc, char **argv)

Detailed Description

Auxiliary application to determine tilt angles of seabed based on tripod positions.

Author

mdejong

Definition in file examples/JAcoustics/JSeabed.cc.

Function Documentation

int main	(	int	argc,
		char **	argv
	)

Definition at line 21 of file examples/JAcoustics/JSeabed.cc.

{
  using namespace std;
  using namespace JPP;

  typedef JContainer< vector<JTripod> >      tripods_container;

  tripods_container  tripods;
  int                debug;

  try { 

    JParser<> zap("Auxiliary application to determine tilt angles of seabed based on tripod positions.");
    
    zap['T'] = make_field(tripods);
    zap['d'] = make_field(debug)   = 1;
    
    zap(argc, argv);
  }
  catch(const exception& error) {
    FATAL(error.what() << endl);
  }

  if (tripods.size() < 3) {
    FATAL("Number of tripods " << tripods.size() << endl);
  }

  // center

  JUTMPosition pos(0.0, 0.0, 0.0);
  
  for (tripods_container::const_iterator i = tripods.begin(); i != tripods.end(); ++i) {
    pos += i->getUTMPosition();
  }

  pos /= tripods.size();

  DEBUG("center: "
        << showpos << FIXED(12,3) << pos.getX() << ' ' 
        << showpos << FIXED(12,3) << pos.getY() << ' '
        << showpos << FIXED(12,3) << pos.getZ() << endl);

  // solve z(x,y) = a*x + b*y + c

  JMatrix3D A;
  double    Y[3] = { 0.0, 0.0, 0.0 };

  for (tripods_container::const_iterator i = tripods.begin(); i != tripods.end(); ++i) {

    const double x = i->getX() - pos.getX();
    const double y = i->getY() - pos.getY();
    const double z = i->getZ() - pos.getZ();
    
    A.a00 += x * x;  A.a01 += x * y;  A.a02 += x;
    A.a10 += x * y;  A.a11 += y * y;  A.a12 += y;
    A.a20 += x;      A.a21 += y;      A.a22 += 1.0;

    Y[0]  += x * z;
    Y[1]  += y * z;
    Y[2]  += z;
  }

  DEBUG(A);
  
  JSVD3D V(A);

  try {

    A = V.invert();

    const double a  = A.a00 * Y[0] + A.a01 * Y[1] + A.a02 * Y[2];
    const double b  = A.a10 * Y[0] + A.a11 * Y[1] + A.a12 * Y[2];
    //const double c  = A.a20 * Y[0] + A.a21 * Y[1] + A.a22 * Y[2];
    /*
    const double Rx = atan(+b);   // rotation aroud x-axis
    const double Ry = atan(-a);   // rotation aroud y-axis

    cout << showpos << FIXED(12,6) << Rx << ' ' 
         << showpos << FIXED(12,6) << Ry << endl;
    */

    const double Tx =  a;
    const double Ty =  b;

    cout << showpos << FIXED(12,6) << Tx << ' ' 
         << showpos << FIXED(12,6) << Ty << endl;
  }
  catch(const exception& error) {
    FATAL(error.what());
  }

  return 0;
}