BHMotion() : mtsTaskPeriodic( "BHMotion", 0.001, true ){ q.SetSize(4); q.SetAll(0.0); mtsInterfaceRequired* input = AddInterfaceRequired( "Input" ); mtsInterfaceRequired* output = AddInterfaceRequired( "Output" ); input->AddFunction( "GetPositionJoint", GetPositions ); output->AddFunction( "SetPositionJoint", SetPositions ); }
WAMMotion( double period ) : mtsTaskPeriodic( "WAMMotion", period, true ){ q.SetSize(7); q.SetAll(0.0); mtsInterfaceRequired* input = AddInterfaceRequired( "Input" ); mtsInterfaceRequired* output = AddInterfaceRequired( "Output" ); input->AddFunction( "GetPositionJoint", GetPositions ); output->AddFunction( "SetPositionJoint", SetPositions ); }