GaitController(int controller_freq, double gait_period, std::function< Eigen::Vector3d(double)> fl_traj, std::function< Eigen::Vector3d(double)> fr_traj, std::function< Eigen::Vector3d(double)> rl_traj, std::function< Eigen::Vector3d(double)> rr_traj)