42 int32_t j, start_bx, start_by, start_bz, start_ex, start_ey, start_ez;
44 float alpha, cos_alpha, sin_alpha;
45 int32_t cube_nline_x_t, cube_nline_z_t;
47 int32_t cube_line_x_start, cube_line_x_end;
48 int32_t cube_line_z_start, cube_line_z_end;
75 cube_line_x_start = (cube_pos_x * cube_nline_x_t) /
nav_cube.nsect_x;
76 cube_line_x_end = ((cube_pos_x + 1) * cube_nline_x_t) /
nav_cube.nsect_x;
77 if (cube_line_x_end > cube_nline_x_t) {
78 cube_line_x_end = cube_nline_x_t;
80 nav_cube.nline_x = cube_line_x_end - cube_line_x_start;
87 cube_line_z_start = (cube_pos_z * cube_nline_z_t) /
nav_cube.nsect_z;
88 cube_line_z_end = ((cube_pos_z + 1) * cube_nline_z_t) /
nav_cube.nsect_z;
89 nav_cube.nline_z = cube_line_z_end - cube_line_z_start;
93 cos_alpha = cos(
alpha);
94 sin_alpha = sin(
alpha);
105 start_by = start_ey -
nav_cube.size.y;
121 for (j = 0; j <
nav_cube.nline_x; j++) {
122 int i = cube_line_x_start + j;
bool nav_cube_run(int8_t j, int8_t i, uint8_t dest_b, uint8_t dest_e, uint8_t src_b, uint8_t src_e)