Optimized code

Optimized code to run faster.

Optimize Point Extraction and Boolean Masking
Reuse Conversions and Precompute Constants
Efficient Point Cloud Filtering in find_human_center_on_ray
Vectorize Circle Creation in create_circle_line_set

Author: aavideora