CannonBallSim.cpp 936 Bytes
Newer Older
Yuwei Xiao's avatar
Yuwei Xiao committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
#include "CannonBallSim.h"


bool CannonBallSim::advance() {
    // perform time integration with different integrators

	// use p_ball, m_dt, m_gravity
	Eigen::Vector3d v = p_ball->getLinearVelocity();
	Eigen::Vector3d p = p_ball->getPosition();

    // TODO
    switch (m_method) {
        case 0:
            // analytical solution
Hui Wang's avatar
Hui Wang committed
15
			// p(t) = v_0*t + 0.5*a*t^2
Yuwei Xiao's avatar
Yuwei Xiao committed
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
            break;

        case 1:
            // explicit euler
			// p' = p + dt*v
			// v' = v + dt*a
            break;

        case 2:
            // symplectic euler
			// v' = v + dt*a
			// p' = p + dt*v'
            break;

        default:
            std::cerr << m_method << " is not a valid integrator method."
                        << std::endl;
    }

    // advance time
    m_time += m_dt;
    m_step++;

    // log
    if ((m_step % m_log_frequency) == 0) {
        m_trajectories.back().push_back(p_ball->getPosition());
    }

    return false;
}