Skip to content

Commit

Permalink
change after review
Browse files Browse the repository at this point in the history
  • Loading branch information
@Hiro-0110
Hiro-0110 committed Jun 10, 2024
1 parent ba14b9c commit c2e4b95
Show file tree
Hide file tree
Showing 2 changed files with 26 additions and 30 deletions.
47 changes: 22 additions & 25 deletions src/components/real/mission/telescope.cpp
View file
Original file line number Diff line number Diff line change
Expand Up @@ -216,25 +216,22 @@ void Telescope::CalculateTargetGroundPosition() {
libra::Vector<3> target_ymin_direction_ecef = dcm_i_to_ecef * target_ymin_direction_i;

libra::Vector<3> current_spacecraft_position_ecef_m = orbit_->GetPosition_ecef_m();
double k_center = (-(InnerProduct(current_spacecraft_position_ecef_m, target_center_direction_ecef)) -
sqrt(pow(InnerProduct(current_spacecraft_position_ecef_m, target_center_direction_ecef), 2) -
pow(target_center_direction_ecef.CalcNorm(), 2) *
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)))) /
pow(target_center_direction_ecef.CalcNorm(), 2);
double k_ymax = (-(InnerProduct(current_spacecraft_position_ecef_m, target_ymax_direction_ecef)) -
sqrt(pow(InnerProduct(current_spacecraft_position_ecef_m, target_ymax_direction_ecef), 2) -
pow(target_ymax_direction_ecef.CalcNorm(), 2) *
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)))) /
pow(target_ymax_direction_ecef.CalcNorm(), 2);
double k_ymin = (-(InnerProduct(current_spacecraft_position_ecef_m, target_ymin_direction_ecef)) -
sqrt(pow(InnerProduct(current_spacecraft_position_ecef_m, target_ymin_direction_ecef), 2) -
pow(target_ymin_direction_ecef.CalcNorm(), 2) *
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)))) /
pow(target_ymin_direction_ecef.CalcNorm(), 2);

target_ground_position_center_ecef_m_ = current_spacecraft_position_ecef_m + k_center * target_center_direction_ecef;
target_ground_position_ymax_ecef_m_ = current_spacecraft_position_ecef_m + k_ymax * target_ymax_direction_ecef;
target_ground_position_ymin_ecef_m_ = current_spacecraft_position_ecef_m + k_ymin * target_ymin_direction_ecef;
double inner_product_spacecraft_target_center_direction_ecef_m = InnerProduct(current_spacecraft_position_ecef_m, target_center_direction_ecef);
double inner_product_spacecraft_target_ymax_direction_ecef_m = InnerProduct(current_spacecraft_position_ecef_m, target_ymax_direction_ecef);
double inner_product_spacecraft_target_ymin_direction_ecef_m = InnerProduct(current_spacecraft_position_ecef_m, target_ymin_direction_ecef);
double k_center_m = inner_product_spacecraft_target_center_direction_ecef_m +
sqrt(pow(inner_product_spacecraft_target_center_direction_ecef_m, 2) -
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)));
double k_ymax_m = inner_product_spacecraft_target_ymax_direction_ecef_m -
sqrt(pow(inner_product_spacecraft_target_ymax_direction_ecef_m, 2) +
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)));
double k_ymin_m = inner_product_spacecraft_target_ymin_direction_ecef_m -
sqrt(pow(inner_product_spacecraft_target_ymin_direction_ecef_m, 2) +
(pow(current_spacecraft_position_ecef_m.CalcNorm(), 2) - pow(environment::earth_equatorial_radius_m, 2)));

target_ground_position_center_ecef_m_ = current_spacecraft_position_ecef_m - k_center_m * target_center_direction_ecef;
target_ground_position_ymax_ecef_m_ = current_spacecraft_position_ecef_m - k_ymax_m * target_ymax_direction_ecef;
target_ground_position_ymin_ecef_m_ = current_spacecraft_position_ecef_m - k_ymin_m * target_ymin_direction_ecef;
}
}

Expand Down Expand Up @@ -268,9 +265,9 @@ void Telescope::ObserveGroundPositionDeviation() {
bool log_flag = simulation_time_->GetState().log_output;
if (start_imaging_jd_ <= current_jd && current_jd <= (start_imaging_jd_ + stage_time_day) && log_flag) {
telescope_flag = 1;
if (startImagingFlag) {
if (startImagingInitializeFlag) {
CalculateTargetGroundPosition();
startImagingFlag = false;
startImagingInitializeFlag = false;
imaging_count = 0;
}
if (imaging_count < stage_mode_) {
Expand All @@ -287,9 +284,9 @@ void Telescope::ObserveGroundPositionDeviation() {
}
} else if (center_imaging_jd <= current_jd && current_jd <= center_imaging_jd + stage_time_day && log_flag) {
telescope_flag = 2;
if (centerImagingFlag) {
if (centerImagingInitializeFlag) {
CalculateTargetGroundPosition();
centerImagingFlag = false;
centerImagingInitializeFlag = false;
imaging_count = 0;
}
if (imaging_count < stage_mode_) {
Expand All @@ -306,9 +303,9 @@ void Telescope::ObserveGroundPositionDeviation() {
}
} else if (end_imaging_jd <= current_jd && current_jd <= end_imaging_jd + stage_time_day && log_flag) {
telescope_flag = 3;
if (endImagingFlag) {
if (endImagingInitializeFlag) {
CalculateTargetGroundPosition();
endImagingFlag = false;
endImagingInitializeFlag = false;
imaging_count = 0;
}
if (imaging_count < stage_mode_) {
Expand Down
9 changes: 4 additions & 5 deletions src/components/real/mission/telescope.hpp
View file
Original file line number Diff line number Diff line change
Expand Up @@ -124,8 +124,7 @@ class Telescope : public Component, public ILoggable {
double start_imaging_sec_; //!< Imaging start seconds
double stage_time_day; //!< Stage time seconds [sec]
int imaging_count; //!< Imaging count
int telescope_flag = 0; //!< Telescope flag

int telescope_flag = 0; //!< Telescope flag for imaging when 0 : no imaging, 1 : start imaging, 2 : center imaging, 3 : end imaging
double center_imaging_jd; //!< Imaging center Julian date [day]
double end_imaging_jd; //!< Imaging end Julian date [day]

Expand All @@ -143,9 +142,9 @@ class Telescope : public Component, public ILoggable {
libra::Vector<3> target_ground_position_center_ecef_m_; //!< Initial center ground position
libra::Vector<3> target_ground_position_ymax_ecef_m_; //!< Initial spacecraft position of ymax
libra::Vector<3> target_ground_position_ymin_ecef_m_; //!< Initial spacecraft position of ymin
bool startImagingFlag = true; //!< Start imaging flag
bool centerImagingFlag = true; //!< Center imaging flag
bool endImagingFlag = true; //!< End imaging flag
bool startImagingInitializeFlag = true; //!< Start imaging flag
bool centerImagingInitializeFlag = true; //!< Center imaging flag
bool endImagingInitializeFlag = true; //!< End imaging flag
int stage_accumulated_lines = 0; //!< Accumulated lines
double start_imaging_jd; //!< Start imaging Julian date

Expand Down

0 comments on commit c2e4b95

Please sign in to comment.