Median filter code implementation. More...
#include "ros/ros.h"#include <features.h>#include <bits/wordsize.h>#include <gnu/stubs-32.h>#include <stddef.h>#include <bits/types.h>#include <time.h>#include <string>#include <iostream>#include <cmath>#include <stdexcept>#include "duration.h"#include <cstddef>#include <utility>#include <boost/config.hpp>#include <limits>#include <limits.h>#include <algorithm>#include <climits>#include <iomanip>#include <cerrno>#include <boost/config/no_tr1/cmath.hpp>#include <boost/math/tools/config.hpp>#include <boost/detail/workaround.hpp>#include <boost/mpl/aux_/config/gcc.hpp>#include <boost/mpl/aux_/config/workaround.hpp>#include <boost/mpl/aux_/adl_barrier.hpp>#include <boost/mpl/aux_/config/static_constant.hpp>#include <boost/mpl/aux_/config/msvc.hpp>#include <boost/preprocessor/config/config.hpp>#include <boost/mpl/aux_/config/ctps.hpp>#include <boost/mpl/aux_/config/preprocessor.hpp>#include <boost/preprocessor/cat.hpp>#include <boost/preprocessor/stringize.hpp>#include <boost/mpl/bool.hpp>#include <boost/mpl/has_xxx.hpp>#include <boost/mpl/aux_/na.hpp>#include <boost/mpl/aux_/config/ttp.hpp>#include <boost/mpl/aux_/nttp_decl.hpp>#include <boost/mpl/integral_c_tag.hpp>#include <boost/mpl/int.hpp>#include <boost/mpl/aux_/config/dtp.hpp>#include <boost/mpl/aux_/template_arity_fwd.hpp>#include <boost/preprocessor/logical/bool.hpp>#include <boost/preprocessor/facilities/empty.hpp>#include <boost/mpl/aux_/lambda_arity_param.hpp>#include <boost/mpl/aux_/config/lambda.hpp>#include <boost/mpl/aux_/config/overload_resolution.hpp>#include <boost/mpl/aux_/yes_no.hpp>#include <boost/mpl/aux_/config/eti.hpp>#include <boost/mpl/contains_fwd.hpp>#include <boost/mpl/begin_end_fwd.hpp>#include <boost/mpl/sequence_tag_fwd.hpp>#include <boost/mpl/void_fwd.hpp>#include <boost/mpl/aux_/na_spec.hpp>#include <boost/mpl/aux_/static_cast.hpp>#include <boost/mpl/aux_/config/integral.hpp>#include <boost/mpl/aux_/lambda_support.hpp>#include <boost/mpl/aux_/has_begin.hpp>#include <boost/mpl/void.hpp>#include <boost/mpl/aux_/preprocessor/params.hpp>#include <boost/mpl/sequence_tag.hpp>#include <boost/mpl/aux_/config/use_preprocessed.hpp>#include <boost/mpl/aux_/include_preprocessed.hpp>#include <boost/mpl/aux_/arity.hpp>#include <boost/mpl/aux_/config/has_xxx.hpp>#include <boost/mpl/aux_/value_wknd.hpp>#include <boost/mpl/aux_/nested_type_wknd.hpp>#include <boost/mpl/aux_/config/nttp.hpp>#include <boost/mpl/limits/arity.hpp>#include <boost/mpl/lambda_fwd.hpp>#include <boost/mpl/placeholders.hpp>#include <boost/mpl/apply_wrap.hpp>#include <boost/mpl/aux_/arity_spec.hpp>#include <boost/mpl/aux_/type_wrapper.hpp>#include <boost/mpl/aux_/config/bind.hpp>#include <boost/mpl/bind_fwd.hpp>#include <boost/mpl/protect.hpp>#include <boost/mpl/arg.hpp>#include <boost/mpl/int_fwd.hpp>#include <boost/mpl/aux_/is_msvc_eti_arg.hpp>#include <boost/mpl/not.hpp>#include <boost/mpl/begin_end.hpp>#include <boost/mpl/aux_/preprocessor/def_params_tail.hpp>#include <boost/mpl/eval_if.hpp>#include <boost/mpl/if.hpp>#include <boost/mpl/apply.hpp>#include <boost/mpl/next.hpp>#include <boost/mpl/aux_/integral_wrapper.hpp>#include <boost/mpl/aux_/common_name_wknd.hpp>#include <boost/mpl/aux_/config/forwarding.hpp>#include <boost/type_traits/is_same.hpp>#include <boost/mpl/aux_/traits_lambda_spec.hpp>#include <boost/mpl/find_if.hpp>#include <boost/mpl/O1_size_fwd.hpp>#include <boost/mpl/next_prior.hpp>#include <boost/mpl/deref.hpp>#include <boost/mpl/O1_size.hpp>#include <boost/mpl/identity.hpp>#include <boost/mpl/lambda.hpp>#include <boost/mpl/push_back_fwd.hpp>#include <boost/mpl/assert.hpp>#include <boost/mpl/aux_/has_type.hpp>#include <boost/mpl/push_front_fwd.hpp>#include <boost/mpl/inserter.hpp>#include <boost/mpl/push_back.hpp>#include <boost/mpl/push_front.hpp>#include <boost/mpl/back_inserter.hpp>#include <boost/mpl/front_inserter.hpp>#include <boost/mpl/clear_fwd.hpp>#include <boost/preprocessor/inc.hpp>#include <boost/mpl/aux_/has_tag.hpp>#include <boost/mpl/numeric_cast.hpp>#include <boost/mpl/aux_/msvc_eti_base.hpp>#include <boost/mpl/integral_c.hpp>#include <boost/mpl/long.hpp>#include <boost/mpl/tag.hpp>#include <boost/mpl/size_fwd.hpp>#include <boost/mpl/aux_/comparison_op.hpp>#include <boost/mpl/less.hpp>#include <stdlib.h>#include <endian.h>#include <bits/mathcalls.h>#include <boost/limits.hpp>#include <boost/assert.hpp>#include <boost/static_assert.hpp>#include <boost/math/policies/policy.hpp>#include <math.h>#include <boost/cstdint.hpp>#include <vector>#include <locale>#include <streambuf>#include <ostream>#include <iosfwd>#include <boost/format/detail/compat_workarounds.hpp>#include <boost/format/format_fwd.hpp>#include <new>#include <boost/type_traits/config.hpp>#include <boost/type_traits/detail/template_arity_spec.hpp>#include <boost/type_traits/integral_constant.hpp>#include <boost/preprocessor/arithmetic/inc.hpp>#include <boost/preprocessor/control/iif.hpp>#include <boost/preprocessor/tuple/eat.hpp>#include <boost/preprocessor/debug/error.hpp>#include <boost/preprocessor/detail/auto_rec.hpp>#include <boost/preprocessor/control/while.hpp>#include <boost/preprocessor/control/expr_iif.hpp>#include <boost/preprocessor/list/adt.hpp>#include <boost/preprocessor/list/fold_right.hpp>#include <boost/preprocessor/logical/bitand.hpp>#include <boost/preprocessor/list/fold_left.hpp>#include <boost/preprocessor/tuple/elem.hpp>#include <boost/preprocessor/tuple/rem.hpp>#include <boost/type_traits/alignment_of.hpp>#include <boost/type_traits/detail/bool_trait_def.hpp>#include <boost/type_traits/detail/bool_trait_undef.hpp>#include <boost/type_traits/intrinsics.hpp>#include <boost/type_traits/is_arithmetic.hpp>#include <boost/type_traits/is_reference.hpp>#include <boost/type_traits/add_reference.hpp>#include <boost/type_traits/detail/yes_no_type.hpp>#include <boost/type_traits/detail/ice_or.hpp>#include <boost/type_traits/is_void.hpp>#include <boost/type_traits/detail/type_trait_def.hpp>#include <boost/type_traits/detail/type_trait_undef.hpp>#include <boost/type_traits/detail/ice_and.hpp>#include <boost/type_traits/detail/ice_not.hpp>#include <boost/type_traits/is_array.hpp>#include <boost/type_traits/is_class.hpp>#include <boost/type_traits/is_union.hpp>#include <boost/type_traits/remove_cv.hpp>#include <boost/type_traits/is_member_pointer.hpp>#include <boost/type_traits/broken_compiler_spec.hpp>#include <boost/type_traits/detail/cv_traits_impl.hpp>#include <boost/type_traits/is_pod.hpp>#include <functional>#include <boost/preprocessor/punctuation/comma_if.hpp>#include <boost/preprocessor/repetition/repeat.hpp>#include <boost/preprocessor/arithmetic/dec.hpp>#include <memory>#include <exception>#include <boost/checked_delete.hpp>#include <boost/throw_exception.hpp>#include <typeinfo>#include <boost/smart_ptr/detail/sp_counted_base.hpp>#include <boost/config/no_tr1/memory.hpp>#include <boost/smart_ptr/detail/sp_has_sync.hpp>#include <boost/optional.hpp>#include <boost/format/internals_fwd.hpp>#include <boost/format/internals.hpp>#include <boost/format/alt_sstream.hpp>#include <boost/format/format_class.hpp>#include <boost/format/group.hpp>#include <boost/format/exceptions.hpp>#include <boost/math/special_functions/detail/round_fwd.hpp>#include <boost/type_traits/is_floating_point.hpp>#include <boost/type_traits/is_integral.hpp>#include <boost/type_traits/is_convertible.hpp>#include <boost/mpl/and.hpp>#include <boost/mpl/or.hpp>#include <boost/mpl/comparison.hpp>#include <complex>#include <cstring>#include "rostime_decl.h"#include <bits/time.h>#include <sys/select.h>#include "ros/time.h"#include <cstdio>#include <sstream>#include <cstdarg>#include <log4cxx/logstring.h>#include <log4cxx/log4cxx.h>#include <log4cxx/helpers/objectptr.h>#include <map>#include <log4cxx/helpers/object.h>#include <log4cxx/helpers/objectimpl.h>#include <log4cxx/helpers/pool.h>#include <log4cxx/helpers/mutex.h>#include <log4cxx/appender.h>#include <log4cxx/logger.h>#include <log4cxx/level.h>#include "ros/console.h"#include <ros/platform.h>#include <assert.h>#include "ros/assert.h"#include <set>#include <list>#include <boost/shared_ptr.hpp>#include <boost/smart_ptr/detail/shared_count.hpp>#include <boost/smart_ptr/shared_ptr.hpp>#include <boost/preprocessor/array/size.hpp>#include <cassert>#include <stdarg.h>#include <bits/wchar.h>#include <boost/type_traits/has_trivial_copy.hpp>#include <boost/type_traits/is_volatile.hpp>#include <boost/type_traits/is_enum.hpp>#include <boost/type_traits/is_member_function_pointer.hpp>#include <boost/type_traits/is_pointer.hpp>#include <boost/type_traits/ice.hpp>#include <boost/preprocessor/repetition/enum_params.hpp>#include <ros/macros.h>#include "roscpp_serialization_macros.h"#include <boost/smart_ptr/detail/operator_bool.hpp>#include <boost/shared_array.hpp>#include <stdint.h>#include "ros/forwards.h"#include "ros/common.h"#include <xlocale.h>#include <iterator>#include <ros/types.h>#include "serialized_message.h"#include "message_forward.h"#include <boost/utility/enable_if.hpp>#include <boost/type_traits/remove_reference.hpp>#include "message_traits.h"#include "ros/exception.h"#include <boost/array.hpp>#include <boost/ref.hpp>#include <boost/mem_fn.hpp>#include <boost/type.hpp>#include <boost/is_placeholder.hpp>#include <boost/bind/arg.hpp>#include "common.h"#include <ros/message_traits.h>#include <boost/type_traits/is_const.hpp>#include <boost/type_traits/remove_const.hpp>#include <boost/function.hpp>#include <boost/type_traits/type_with_alignment.hpp>#include <ros/static_assert.h>#include <boost/type_traits/add_const.hpp>#include "ros/builtin_message_traits.h"#include "ros/serialization.h"#include "ros/message_event.h"#include <boost/type_traits/is_base_of.hpp>#include <boost/make_shared.hpp>#include "forwards.h"#include "timer_options.h"#include "ros/rate.h"#include "wall_timer_options.h"#include "ros/message.h"#include "ros/service_traits.h"#include <istream>#include <boost/call_traits.hpp>#include <ios>#include <boost/integer_traits.hpp>#include <boost/type_traits/is_abstract.hpp>#include "subscription_callback_helper.h"#include "ros/spinner.h"#include <boost/bind.hpp>#include "ros/publisher.h"#include <boost/utility/addressof.hpp>#include <boost/utility/base_from_member.hpp>#include <boost/preprocessor/facilities/identity.hpp>#include <boost/preprocessor/control/if.hpp>#include <boost/preprocessor/seq/seq.hpp>#include <boost/preprocessor/seq/size.hpp>#include <boost/preprocessor/seq/fold_left.hpp>#include <boost/preprocessor/arithmetic/sub.hpp>#include <boost/preprocessor/logical/compl.hpp>#include "ros/service_server.h"#include "ros/subscriber.h"#include "ros/node_handle.h"#include "ros/init.h"#include "XmlRpcValue.h"#include "node_handle.h"#include "ros/names.h"#include "ros/message_operations.h"#include <bits/sigset.h>#include <bits/pthreadtypes.h>#include <sys/types.h>#include <sys/socket.h>#include <bits/byteswap.h>#include <netinet/in.h>#include <stdio.h>#include <string.h>#include <optoelectric/sensor_sharp_msg.h>#include "std_msgs/Header.h"#include "geometry_msgs/Vector3.h"#include "geometry_msgs/Quaternion.h"#include "geometry_msgs/Point.h"#include "btMatrix3x3.h"#include "tf/exceptions.h"#include "LinearMath/btTransform.h"#include <boost/thread/mutex.hpp>#include <boost/functional/hash/hash_fwd.hpp>#include <boost/functional/hash/detail/float_functions.hpp>#include <boost/integer/static_log2.hpp>#include <boost/functional/hash/detail/limits.hpp>#include <boost/functional/hash/hash.hpp>#include <boost/detail/iterator.hpp>#include <boost/utility/swap.hpp>#include <boost/preprocessor/repetition/enum_binary_params.hpp>#include <boost/preprocessor/repetition/repeat_from_to.hpp>#include <boost/unordered/detail/hash_table_impl.hpp>#include <boost/unordered/detail/config.hpp>#include <initializer_list>#include <boost/weak_ptr.hpp>#include <boost/smart_ptr/detail/sp_convertible.hpp>#include <boost/config/no_tr1/functional.hpp>#include <boost/smart_ptr/weak_ptr.hpp>#include <boost/iterator.hpp>#include <boost/utility.hpp>#include <boost/signals/detail/signals_common.hpp>#include <boost/signals/connection.hpp>#include "boost/type_traits/add_pointer.hpp"#include "boost/type_traits/add_volatile.hpp"#include "boost/type_traits/has_nothrow_copy.hpp"#include <boost/type_traits/has_trivial_destructor.hpp>#include "boost/type_traits/has_trivial_assign.hpp"#include "boost/type_traits/has_trivial_constructor.hpp"#include "boost/type_traits/is_signed.hpp"#include "boost/type_traits/is_unsigned.hpp"#include "boost/type_traits/is_base_and_derived.hpp"#include "boost/type_traits/is_float.hpp"#include "boost/type_traits/is_function.hpp"#include "boost/type_traits/is_fundamental.hpp"#include "boost/type_traits/is_scalar.hpp"#include <boost/type_traits/is_empty.hpp>#include <boost/type_traits/detail/size_t_trait_def.hpp>#include <boost/type_traits/detail/size_t_trait_undef.hpp>#include "boost/type_traits/function_traits.hpp"#include "boost/type_traits/aligned_storage.hpp"#include <boost/type_traits/integral_promotion.hpp>#include <boost/type_traits/floating_point_promotion.hpp>#include <boost/type_traits/make_unsigned.hpp>#include <boost/type_traits/remove_bounds.hpp>#include <boost/visit_each.hpp>#include <boost/signals/detail/config.hpp>#include <boost/function/detail/prologue.hpp>#include <boost/iterator/detail/config_def.hpp>#include <boost/iterator/detail/config_undef.hpp>#include <boost/iterator/iterator_categories.hpp>#include <boost/type_traits/remove_pointer.hpp>#include <boost/mpl/always.hpp>#include <boost/signals/trackable.hpp>#include <boost/signals/slot.hpp>#include <boost/smart_ptr.hpp>#include <boost/function/function2.hpp>#include <boost/iterator/iterator_facade.hpp>#include <boost/signals/signal_template.hpp>#include "geometry_msgs/TransformStamped.h"#include "ros/ros.h"#include <fstream>
Go to the source code of this file.
Defines | |
| #define | PFLN {printf("%s %d\n",__FILE__, __LINE__);} |
Functions | |
| float | GetMedian (float a[], int n) |
| GetMedian. | |
| float | Median_Filter (int countt, float dist, float array[]) |
| Median_Filter. | |
Median filter code implementation.
Definition in file median_filter.h.
| #define PFLN {printf("%s %d\n",__FILE__, __LINE__);} |
Definition at line 41 of file median_filter.h.
| float GetMedian | ( | float | a[], | |
| int | n | |||
| ) |
GetMedian.
Calculates the median value of an array, given an neighborhood size n
Definition at line 53 of file median_filter.h.
| float Median_Filter | ( | int | countt, | |
| float | dist, | |||
| float | array[] | |||
| ) |
Median_Filter.
Calculates Median distance, subscribes a distance.
Definition at line 82 of file median_filter.h.