61 lines
1.9 KiB
C++
61 lines
1.9 KiB
C++
#include <catch2/catch_test_macros.hpp>
|
|
#include <fmt/core.h>
|
|
#include "systems.hpp"
|
|
#include <cmath>
|
|
#include <numbers>
|
|
|
|
/*
|
|
face_x := rand.Float64() * 100
|
|
face_y := rand.Float64() * 100
|
|
target_x := rand.Float64() * 100
|
|
target_y := rand.Float64() * 100
|
|
rad_angle1 := atan2(target_y, target_x)
|
|
rad_angle2 := atan2(face_y, face_x)
|
|
diff := rad_angle1 - rad_angle2
|
|
|
|
if diff < 0 { fmt.Printf("\nTurn Right") }
|
|
else { fmt.Printf("\nTurn Left") }
|
|
*/
|
|
|
|
|
|
TEST_CASE("figure out best rotation direction", "[systems-rotate]") {
|
|
Matrix map = matrix::make(3, 3);
|
|
|
|
Point player_at{1, 1};
|
|
map[player_at.y][player_at.x] = 2;
|
|
|
|
|
|
for(matrix::box target{map, player_at.x, player_at.y, 1}; target.next();) {
|
|
for(matrix::box aiming_at{map, player_at.x, player_at.y, 1}; aiming_at.next();) {
|
|
map[aiming_at.y][aiming_at.x] = 10;
|
|
|
|
float target_dx = float(player_at.x) - float(target.x);
|
|
float target_dy = float(player_at.y) - float(target.y);
|
|
float aiming_dx = float(player_at.x) - float(aiming_at.x);
|
|
float aiming_dy = float(player_at.y) - float(aiming_at.y);
|
|
|
|
fmt::println("target_d={},{}; aiming_d={},{}",
|
|
target_dx, target_dy, aiming_dx, aiming_dy);
|
|
|
|
float target_angle = atan2(-target_dy, target_dx) * (180.0 / std::numbers::pi);
|
|
float aiming_angle = atan2(-aiming_dy, aiming_dx) * (180.0 / std::numbers::pi);
|
|
|
|
float diff = target_angle - aiming_angle;
|
|
double normalized = fmod(diff + 360.0, 360.0);
|
|
|
|
fmt::println("\n\n>>>>>>>>> BEGIN");
|
|
|
|
if(normalized != diff) fmt::println("YOU NEED NORMALIZED");
|
|
|
|
fmt::println("aming_angle={}, target_angle={}, delta={}, norm={}",
|
|
aiming_angle, target_angle, diff, normalized);
|
|
|
|
fmt::println("TURN {}", normalized < 180.0 ? "LEFT" : "RIGHT");
|
|
|
|
matrix::dump("< is target, a is aim", map, target.x, target.y);
|
|
fmt::println("-----------------END");
|
|
|
|
map[aiming_at.y][aiming_at.x] = 0;
|
|
}
|
|
}
|
|
}
|