Exemple #1
0
void read_xy_calc_avg(double *x_avg, double *y_avg, double alpha) {
   int x_pos = read_x() - 150;
   if(x_pos < 0)
      x_pos = 0;
   *x_avg = (1 - alpha) * *x_avg + alpha * x_pos;

   int y_pos = read_y() - 150;
   if(y_pos < 0)
      y_pos = 0;
   *y_avg = (1 - alpha) * *y_avg + alpha * y_pos;
}
bool HomTransform::read(yarp::os::idl::WireReader& reader) {
  if (!read_x(reader)) return false;
  if (!read_y(reader)) return false;
  if (!read_z(reader)) return false;
  if (!read_xx(reader)) return false;
  if (!read_xy(reader)) return false;
  if (!read_xz(reader)) return false;
  if (!read_yx(reader)) return false;
  if (!read_yy(reader)) return false;
  if (!read_yz(reader)) return false;
  if (!read_zx(reader)) return false;
  if (!read_zy(reader)) return false;
  if (!read_zz(reader)) return false;
  return !reader.isError();
}
bool ContactPoint::read(yarp::os::idl::WireReader& reader) {
  if (!read_x(reader)) return false;
  if (!read_y(reader)) return false;
  if (!read_z(reader)) return false;
  return !reader.isError();
}
Exemple #4
0
bool Pixel::read(yarp::os::idl::WireReader& reader) {
  if (!read_x(reader)) return false;
  if (!read_y(reader)) return false;
  return !reader.isError();
}