#include "UGM/UGM.hpp"

using namespace Ubpa;
using namespace std;

int main() {
    pointf3 p0{ 0,0,0 }, p1{ 1,1,0 };
    pointf3 q0{ 254.793335, -6.852415, 43.801746 }, q1{ 156.655655, -70.688034, 5.278168 };
    pointf3 q2 = q0;
    q2.z += 1;
    vecf3 pn{ 0,0,1 }, qn{};
    vecf3 pv = p1 - p0, qv = q1 - q0;
    qn = qn.cross(qv, q2 - q0);
    qn = qn.normalize();

    quat rot{ pv.normalize(), qv.normalize ()};
    transformf mt{rot};
    
    //mt.rotate_with<a_up>(10);
    char buf[1024];
    sprintf(buf, "pointf %d vecf3 %d quatf %d transformf %d ", sizeof(p0), sizeof(pn), sizeof(rot), sizeof(mt));
    std::cout << "hello world  " << buf << endl;
    return 0;
}