@@ -595,18 +595,18 @@ double DynupEngine::calcWalkreadySplines(double time, double travel_time) {
595595 r_foot_spline_.pitch ()->addPoint (time, -params_.end_pose .trunk_pitch * M_PI / 180 );
596596 r_foot_spline_.yaw ()->addPoint (time, 0 );
597597
598- l_hand_spline_.x ()->addPoint (time, 0 );
599- l_hand_spline_.y ()->addPoint (time, 0 );
600- l_hand_spline_.z ()->addPoint (time, params_.end_pose .hand_walkready_height );
601- l_hand_spline_.roll ()->addPoint (time, 0 );
602- l_hand_spline_.pitch ()->addPoint (time, params_.end_pose .hand_walkready_pitch * M_PI / 180 );
603- l_hand_spline_.yaw ()->addPoint (time, 0 );
604- r_hand_spline_.x ()->addPoint (time, 0 );
605- r_hand_spline_.y ()->addPoint (time, 0 );
606- r_hand_spline_.z ()->addPoint (time, params_.end_pose .hand_walkready_height );
607- r_hand_spline_.roll ()->addPoint (time, 0 );
608- r_hand_spline_.pitch ()->addPoint (time, params_.end_pose .hand_walkready_pitch * M_PI / 180 );
609- r_hand_spline_.yaw ()->addPoint (time, 0 );
598+ // l_hand_spline_.x()->addPoint(time, 0);
599+ // l_hand_spline_.y()->addPoint(time, 0);
600+ // l_hand_spline_.z()->addPoint(time, params_.end_pose.hand_walkready_height);
601+ // l_hand_spline_.roll()->addPoint(time, 0);
602+ // l_hand_spline_.pitch()->addPoint(time, params_.end_pose.hand_walkready_pitch * M_PI / 180);
603+ // l_hand_spline_.yaw()->addPoint(time, 0);
604+ // r_hand_spline_.x()->addPoint(time, 0);
605+ // r_hand_spline_.y()->addPoint(time, 0);
606+ // r_hand_spline_.z()->addPoint(time, params_.end_pose.hand_walkready_height);
607+ // r_hand_spline_.roll()->addPoint(time, 0);
608+ // r_hand_spline_.pitch()->addPoint(time, params_.end_pose.hand_walkready_pitch * M_PI / 180);
609+ // r_hand_spline_.yaw()->addPoint(time, 0);
610610
611611 return time;
612612}
0 commit comments