unparking_task_planner.H

Go to the documentation of this file.

// Copyright (C) 2006 University of Louisiana at Lafayette
// Authors: Suresh Golconda, Pablo Mejia
// lane_task_planner.H: Generates path to drive on the lane

#ifndef CAJUN_UNPARKING_TASK_PLANNER_H
#define CAJUN_UNPARKING_TASK_PLANNER_H


#include "task_planner.H"
#include "uc_planner_param.H"
#include "rndf_point.H"

namespace cajun
{


class unparking_task_planner_t : public task_planner_t
{
public:
        unparking_task_planner_t ();

        void set_plan (rndf_point_t *rp1_, rndf_point_t *rp2_);
        void get_plan (rndf_point_t* &rp1_,rndf_point_t* &rp2_);
        void modify_plan (rndf_point_t *end_wp_id_, rndf_point_t *rp2_);

        void set_active ();

        path_status_t generate_path (
                world_state_t *ws_, path_t &path_, double &p_len_left_,
                const path_t &base_path_);
        bool get_path_lane_lids (unsigned &sid_,
                                 std::vector<unsigned> &lids_);
        bool is_task_complete (world_state_t *ws_, double x_, double y_,
                               double heading_);
        bool is_path_tight () { return true; }
        void print_plan ();

protected:
        const uc_planner_param_t *m_uc_param;

        //fixme: change it to const
        rndf_point_t *m_parking_rp;
        rndf_point_t *m_post_parking_rp;
        double m_unpark_orient;

        path_t m_pk_path;

        bool m_first_iteration;

        void set_paramters (rndf_point_t *rp1_, rndf_point_t *rp2_);
        void compute_unparking_path (path_t const &base_path_, path_t &path_);

};


};


#endif

---