61 for( uint i = 0; i < threeAccs.size(); i++ )
100 float b_bpfilt[] = {0.8305, 0, -0.8305};
101 float a_bpfilt[] = {1.0,-0.3329,-0.6610};
102 for(
int i=0; i < 3; i++)
107 float b_lpfilt[] = {0.634, 0.634};
108 float a_lpfilt[] = {1.0, 0.2679};
109 for(
int i=0; i < 3; i++)
digitalFilter * accLPFilt[3]
bool checkPlaceContact(double dAcc)
float getNextFilteredValue(float u_current)
digitalFilter * accBPFilt[3]
AccelerometerCommand command_
INLINE Rall1d< T, V, S > sqrt(const Rall1d< T, V, S > &arg)
AccelerometerState state_
pr2_hardware_interface::Accelerometer * accHandle
accelerationObserver(pr2_hardware_interface::Accelerometer *accelerometerHandle)
std::vector< geometry_msgs::Vector3 > samples_