use crate::behavior_tests::TestActions::{Dec, Inc, LessThan, LessThanRunningSuccess};
use bonsai_bt::{
    Action, ActionArgs, After, AlwaysSucceed, Event, Failure, If, Invert, Select, Sequence, State, Status::Running,
    Success, UpdateArgs, Wait, WaitForever, WhenAll, While, WhileAll,
};

/// Some test actions.
#[derive(Clone, Debug)]
enum TestActions {
    /// Increment accumulator.
    Inc,
    /// Decrement accumulator.
    Dec,
    ///, Check if less than
    LessThan(i32),
    /// Check if less than and return [Running]. If more or equal return [Success].
    LessThanRunningSuccess(i32),
}

// A test state machine that can increment and decrement.
fn tick(mut acc: i32, dt: f64, state: &mut State<TestActions>) -> (i32, bonsai_bt::Status, f64) {
    let e: Event = UpdateArgs { dt }.into();
    println!("acc {}", acc);
    let (s, t) = state.tick(
        &e,
        &mut (),
        &mut |args: ActionArgs<Event, TestActions>, _| match *args.action {
            Inc => {
                acc += 1;
                (Success, args.dt)
            }
            Dec => {
                acc -= 1;
                (Success, args.dt)
            }
            LessThan(v) => {
                println!("inside less than with acc: {}", acc);
                if acc < v {
                    println!("success {}<{}", acc, v);
                    (Success, args.dt)
                } else {
                    println!("failure {}>={}", acc, v);
                    (Failure, args.dt)
                }
            }
            TestActions::LessThanRunningSuccess(v) => {
                println!("inside LessThanRunningSuccess with acc: {}", acc);
                if acc < v {
                    println!("success {}<{}", acc, v);
                    (Running, args.dt)
                } else {
                    println!("failure {}>={}", acc, v);
                    (Success, args.dt)
                }
            }
        },
    );
    println!("status: {:?} dt: {}", s, t);

    (acc, s, t)
}

// A test state machine that can increment and decrement.
fn tick_with_ref(acc: &mut i32, dt: f64, state: &mut State<TestActions>) {
    let e: Event = UpdateArgs { dt }.into();

    state.tick(
        &e,
        &mut (),
        &mut |args: ActionArgs<Event, TestActions>, _| match *args.action {
            Inc => {
                *acc += 1;
                (Success, args.dt)
            }
            Dec => {
                *acc -= 1;
                (Success, args.dt)
            }
            TestActions::LessThanRunningSuccess(_) | LessThan(_) => todo!(),
        },
    );
}

// Each action that terminates immediately
// consumes a time of 0.0 seconds.
// This makes it possible to execute one action
// after another without delay or waiting for next update.
#[test]
fn test_immediate_termination() {
    let mut a: i32 = 0;

    let seq = Sequence(vec![Action(Inc), Action(Inc)]);
    let mut state = State::new(seq);
    tick_with_ref(&mut a, 0.0, &mut state);
    assert_eq!(a, 2);
    tick_with_ref(&mut a, 1.0, &mut state);
    assert_eq!(a, 2)
}

// Tree terminates after 2.001 seconds
// This makes it possible to execute several actions within
// the lifetime of the behavior tree
#[test]
fn while_wait_sequence_twice() {
    let mut a: i32 = 0;
    let w = While(
        Box::new(Wait(2.001)),
        vec![Sequence(vec![Wait(0.5), Action(Inc), Wait(0.5), Action(Inc)])],
    );
    let mut state = State::new(w);
    tick_with_ref(&mut a, 1.0, &mut state);
    assert_eq!(a, 2);
    tick_with_ref(&mut a, 1.0, &mut state);
    assert_eq!(a, 4);
    tick_with_ref(&mut a, 1.0, &mut state);
    assert_eq!(a, 4);
}

// If you wait the exact amount before to execute an action,
// it will execute. This behavior makes it easy to predict
// when an action will run.
#[test]
fn wait_sec() {
    let a: i32 = 0;
    let seq = Sequence(vec![Wait(1.0), Action(Inc)]);
    let mut state = State::new(seq);
    let (a, _, _) = tick(a, 1.0, &mut state);
    assert_eq!(a, 1);
}

// When we execute half the time and then the other half,
// then the action should be executed.
#[test]
fn wait_half_sec() {
    let a: i32 = 0;
    let seq = Sequence(vec![Wait(1.0), Action(Inc)]);
    let mut state = State::new(seq);
    let (a, _, _) = tick(a, 0.5, &mut state);
    assert_eq!(a, 0);
    let (a, _, _) = tick(a, 0.5, &mut state);
    assert_eq!(a, 1);
}

// A sequence of one tick is like a bare tick.
#[test]
fn sequence_of_one_event() {
    let a: i32 = 0;
    let seq = Sequence(vec![Action(Inc)]);
    let mut state = State::new(seq);
    let (a, _, _) = tick(a, 1.0, &mut state);
    assert_eq!(a, 1);
}

// A sequence of wait events is the same as one wait tick.
#[test]
fn wait_two_waits() {
    let a: i32 = 0;
    let seq = Sequence(vec![Wait(0.5), Wait(0.5), Action(Inc)]);
    let mut state = State::new(seq);
    let (a, _, _) = tick(a, 1.0, &mut state);
    assert_eq!(a, 1);
}

// Increase counter ten times.
#[test]
fn loop_ten_times() {
    let a: i32 = 0;
    let rep = While(Box::new(Wait(50.0)), vec![Wait(0.5), Action(Inc), Wait(0.5)]);
    let mut state = State::new(rep);

    // sample after 10 seconds
    let (a, _, _) = tick(a, 10.0, &mut state);
    assert_eq!(a, 10);
}

#[test]
fn when_all_wait() {
    let a: i32 = 0;
    let all = Sequence(vec![
        // Wait in parallel.
        WhenAll(vec![Wait(0.5), Wait(1.0)]),
        Action(Inc),
    ]);
    let mut state = State::new(all);
    let (a, _, _) = tick(a, 0.5, &mut state);
    assert_eq!(a, 0);
    let (a, _, _) = tick(a, 0.5, &mut state);
    assert_eq!(a, 1);
}

#[test]
fn while_wait_sequence() {
    let mut a: i32 = 0;
    let w = While(
        Box::new(Wait(9.999999)),
        vec![Sequence(vec![Wait(0.5), Action(Inc), Wait(0.5), Action(Inc)])],
    );
    let mut state = State::new(w);
    for _ in 0..100 {
        (a, _, _) = tick(a, 0.1, &mut state);
    }
    // The last increment is never executed, because there is not enough time.
    assert_eq!(a, 19);
}

#[test]
fn while_wait_forever_sequence() {
    let mut a: i32 = 0;
    let w = While(Box::new(WaitForever), vec![Sequence(vec![Action(Inc), Wait(1.0)])]);
    let mut state = State::new(w);
    (a, _, _) = tick(a, 1.001, &mut state);
    assert_eq!(a, 2);
}

#[test]
fn test_if_less_than() {
    let a: i32 = 3;
    let _if = If(
        Box::new(Action(LessThan(1))),
        Box::new(Action(Inc)), // if true
        Box::new(Action(Dec)), // else
    );

    let mut state = State::new(_if);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 1);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 0);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, -1);
    assert_eq!(s, Success);
}

#[test]
fn when_all_if() {
    let a: i32 = 0;
    let inc = Sequence(vec![Action(Inc), Action(Inc)]);
    let dec = Sequence(vec![Action(Dec), Action(Dec)]);
    let _if = If(Box::new(Action(LessThan(1))), Box::new(inc), Box::new(dec));

    // Run sequence over and over for 2 seconds
    let _while = While(Box::new(Wait(50.0)), vec![Wait(0.5), Action(Inc), Wait(0.5)]);

    let w = WhenAll(vec![_if, _while]);
    let mut state = State::new(w);

    // sample state after 8 seconds
    let (a, _, _) = tick(a, 8.0, &mut state);
    assert_eq!(a, 10);

    // // sample state after 10 seconds
    let (a, _, _) = tick(a, 2.0, &mut state);
    assert_eq!(a, 12);
}

#[test]
fn test_alter_wait_time() {
    let a: i32 = 0;
    let rep = While(Box::new(Wait(50.0)), vec![Wait(0.5), Action(Inc), Wait(0.5)]);
    let mut state = State::new(rep);

    // sample after 10 seconds
    let (a, _, _) = tick(a, 10.0, &mut state);
    assert_eq!(a, 10);
}

#[test]
fn test_select_succeed_on_first() {
    let a: i32 = 0;
    let sel = Select(vec![Action(Inc), Action(Inc), Action(Inc)]);
    let mut state = State::new(sel);

    let (a, _, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 1);
    let (a, _, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
}

#[test]
fn test_select_no_state_reset() {
    let a: i32 = 3;
    let sel = Select(vec![Action(LessThan(1)), Action(Dec), Action(Inc)]);
    let mut state = State::new(sel);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 1);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 0);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, -1);
    assert_eq!(s, Success);
}

#[test]
fn test_select_with_state_reset() {
    let a: i32 = 3;
    let sel = Select(vec![Action(LessThan(1)), Action(Dec), Action(Inc)]);
    let sel_clone = sel.clone();
    let mut state = State::new(sel);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 1);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 0);
    assert_eq!(s, Success);

    // reset state
    state = State::new(sel_clone);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 0);
    assert_eq!(s, Success);
}

#[test]
fn test_select_and_when_all() {
    let a: i32 = 3;
    let sel = Select(vec![Action(LessThan(1)), Action(Dec), Action(Inc)]);
    let whenall = WhenAll(vec![Wait(0.35), sel]);
    let mut state = State::new(whenall);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Running);
    let (a, s, _) = tick(a, 0.3, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Success);
}

#[test]
fn test_select_and_invert() {
    let a: i32 = 3;
    let sel = Invert(Box::new(Select(vec![Action(LessThan(1)), Action(Dec), Action(Inc)])));
    let whenall = WhenAll(vec![Wait(0.35), sel]);
    let mut state = State::new(whenall);

    // Running + Failure = Failure
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 2);
    assert_eq!(s, Failure);
    let (a, s, _) = tick(a, 0.3, &mut state);
    assert_eq!(a, 1);
    assert_eq!(s, Failure);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 0);
    assert_eq!(s, Failure);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, -1);
    assert_eq!(s, Failure);
}

#[test]
fn test_allways_succeed() {
    let a: i32 = 3;
    let sel = Sequence(vec![
        Wait(0.5),
        Action(LessThan(2)),
        Wait(0.5),
        Action(LessThan(1)),
        Wait(0.5),
    ]);
    let behavior = AlwaysSucceed(Box::new(sel));
    let mut state = State::new(behavior);

    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 3);
    assert_eq!(s, Running);
    let (a, s, _) = tick(a, 0.7, &mut state);
    assert_eq!(a, 3);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.4, &mut state);
    assert_eq!(a, 3);
    assert_eq!(s, Success);
    let (a, s, _) = tick(a, 0.1, &mut state);
    assert_eq!(a, 3);
    assert_eq!(s, Success);
}

#[test]
fn test_after_all_succeed_in_order() {
    let a: i32 = 0;
    let after = After(vec![Action(Inc), Wait(0.1), Wait(0.2)]);
    let mut state = State::new(after);

    let (a, s, dt) = tick(a, 0.1, &mut state);

    assert_eq!(a, 1);
    assert_eq!(s, Running);
    assert_eq!(dt, 0.0);

    let (a, s, dt) = tick(a, 0.1, &mut state);

    assert_eq!(a, 1);
    assert_eq!(s, Success);
    assert_eq!(dt, 0.0);
}

#[test]
fn test_after_all_succeed_out_of_order() {
    let a: i32 = 0;
    let after = After(vec![Action(Inc), Wait(0.2), Wait(0.1)]);
    let mut state = State::new(after);

    let (a, s, dt) = tick(a, 0.05, &mut state);

    assert_eq!(a, 1);
    assert_eq!(s, Running);
    assert_eq!(dt, 0.0);

    let (a, s, dt) = tick(a, 0.1, &mut state);

    assert_eq!(a, 1);
    assert_eq!(s, Failure);
    assert_eq!(dt, 0.0);
}

#[test]
fn test_repeat_sequence() {
    {
        let a: i32 = 0;
        let after = WhileAll(Box::new(Action(LessThanRunningSuccess(5))), vec![Action(Inc)]);

        let mut state = State::new(after);

        let (a, s, dt) = tick(a, 0.0, &mut state);

        assert_eq!(a, 5);
        assert_eq!(s, Success);
        assert_eq!(dt, 0.0);
    }
}

#[test]
/// Ensure that if the condition behavior and the first sequence behavior both return
/// running initially, then the condition behavior cannot run more than once until the whole
/// sequence has succeeded.
fn test_repeat_sequence_double_running() {
    let after = WhileAll(
        Box::new(Action(LessThanRunningSuccess(5))), // running...
        vec![
            Action(LessThanRunningSuccess(5)), // running... until current value is 5
            Action(Dec),                       // success... 4
            Action(Dec),                       // success... 3
            Action(LessThan(0)),               // failure
        ],
    );
    let mut state = State::new(after);

    let mut current_value = 0;
    loop {
        let (a, s, _) = tick(current_value, 0.0, &mut state);
        current_value = a;
        match s {
            Running => {
                current_value += 1; // increase curent value everytime sequence behavior returns running
            }
            _ => {
                break;
            }
        }
    }

    assert_eq!(current_value, 3);
}

#[test]
fn test_repeat_sequence2() {
    let after = WhileAll(
        Box::new(Action(LessThanRunningSuccess(5))), // running...
        vec![
            Action(LessThanRunningSuccess(10)), // running... until current value is 5
            Action(Dec),                        // success... 4
            Action(Dec),                        // success... 3
            Action(Dec),                        // success... 2
        ],
    );
    let mut state = State::new(after);

    let mut current_value = 0;
    let mut current_status;
    loop {
        let (a, s, _) = tick(current_value, 0.0, &mut state);
        current_value = a;
        current_status = s;
        match s {
            Running => {
                current_value += 1; // increase current value everytime sequence behavior returns running
            }
            _ => {
                break;
            }
        }
    }
    assert_eq!(current_status, bonsai_bt::Status::Success);
    assert_eq!(current_value, 7);
}

#[test]
fn test_repeat_sequence3() {
    let after = WhileAll(
        Box::new(Action(LessThanRunningSuccess(2))),
        vec![
            Action(LessThanRunningSuccess(10)),
            Action(Dec),
            Action(Dec),
            Action(Dec),
            Action(LessThanRunningSuccess(10)),
            Action(Dec),
        ],
    );
    let mut state = State::new(after);

    let mut current_value = 0;
    let mut current_status;
    loop {
        let (a, s, _) = tick(current_value, 0.0, &mut state);
        current_value = a;
        current_status = s;
        match s {
            Running => {
                current_value += 1;
            }
            _ => {
                break;
            }
        }
    }
    assert_eq!(current_status, Success);
    assert_eq!(current_value, 9);
}

#[test]
fn test_repeat_sequence_nested() {
    let dec2 = Sequence(vec![Action(Dec), Action(Dec)]);
    let inc1 = Sequence(vec![Action(Inc)]);

    let nested = WhileAll(Box::new(Action(LessThanRunningSuccess(5))), vec![Action(Inc), inc1]);

    let after = WhileAll(
        Box::new(Action(LessThanRunningSuccess(1))),
        vec![
            nested,      // inc to 6
            Action(Dec), // -1
            dec2,        // -2
        ], // == 3
    );
    let mut state = State::new(after);

    let mut current_value = 0;
    let mut current_status;
    loop {
        let (a, s, _) = tick(current_value, 0.0, &mut state);
        current_value = a;
        current_status = s;
        match s {
            Running => {}
            _ => {
                break;
            }
        }
    }
    assert_eq!(current_status, bonsai_bt::Status::Success);
    assert_eq!(current_value, 3);
}

#[test]
fn test_repeat_sequence_fail() {
    {
        let a: i32 = 4;
        let after = WhileAll(
            Box::new(Action(LessThanRunningSuccess(5))),
            vec![Action(Dec), Action(LessThan(0))],
        );
        let mut state = State::new(after);
        let (a, s, dt) = tick(a, 0.0, &mut state);
        assert_eq!(a, 3);
        assert_eq!(s, Failure);
        assert_eq!(dt, 0.0);
    }
}

#[test]
fn test_repeat_sequence_timed() {
    let a: i32 = 0;
    let time_step = 0.1;
    let steps = 5;
    let after = WhileAll(
        Box::new(Action(LessThanRunningSuccess(steps))),
        vec![Wait(time_step), Action(Inc)],
    );
    let mut state = State::new(after);

    // increment 3 times
    let (a, s, dt) = tick(a, time_step * 3.0, &mut state);
    assert_eq!(dt, 0.0);
    assert_eq!(a, 3);
    assert_eq!(s, Running);

    let (a, s, dt) = tick(a, 100.0, &mut state);
    assert_eq!(dt, 100.0);
    assert_eq!(a, 5);
    assert_eq!(s, Success);
}

#[test]
#[should_panic]
fn test_repeat_sequence_empty() {
    let after = WhileAll(Box::new(Action(LessThanRunningSuccess(0))), vec![]);
    // panics because no behaviors...
    let _state = State::new(after);
}