Statistics
| Branch: | Revision:

root / scout / scoutsim / src / scoutsim.cpp @ 43811241

History | View | Annotate | Download (4.95 KB)

1 c492be62 Alex Zirbel
/**
2
 * The code in this package was developed using the structure of Willow
3
 * Garage's turtlesim package.  It was modified by the CMU Robotics Club
4
 * to be used as a simulator for the Colony Scout robot.
5 266ae7f2 Alex Zirbel
 *
6 c492be62 Alex Zirbel
 * All redistribution of this code is limited to the terms of Willow Garage's
7
 * licensing terms, as well as under permission from the CMU Robotics Club.
8
 * 
9
 * Copyright (c) 2011 Colony Project
10
 * 
11
 * Permission is hereby granted, free of charge, to any person
12
 * obtaining a copy of this software and associated documentation
13
 * files (the "Software"), to deal in the Software without
14
 * restriction, including without limitation the rights to use,
15
 * copy, modify, merge, publish, distribute, sublicense, and/or sell
16
 * copies of the Software, and to permit persons to whom the
17
 * Software is furnished to do so, subject to the following
18
 * conditions:
19
 * 
20
 * The above copyright notice and this permission notice shall be
21
 * included in all copies or substantial portions of the Software.
22
 * 
23
 * Copyright (c) 2009, Willow Garage, Inc.
24 266ae7f2 Alex Zirbel
 * All rights reserved.
25 c492be62 Alex Zirbel
 * 
26
 * Redistribution and use in source and binary forms, with or without
27
 * modification, are permitted provided that the following conditions are met:
28
 * 
29
 *    Redistributions of source code must retain the above copyright
30
 *       notice, this list of conditions and the following disclaimer.
31
 *    Redistributions in binary form must reproduce the above copyright
32
 *       notice, this list of conditions and the following disclaimer in the
33
 *       documentation and/or other materials provided with the distribution.
34
 *    Neither the name of the Willow Garage, Inc. nor the names of its
35
 *       contributors may be used to endorse or promote products derived from
36
 *       this software without specific prior written permission.
37
 * 
38
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
39
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
40
 * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
41
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
42
 * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
43
 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
44
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
45
 * OTHER DEALINGS IN THE SOFTWARE.
46 266ae7f2 Alex Zirbel
 */
47
48
#include <wx/app.h>
49
#include <wx/timer.h>
50
51
#include <ros/ros.h>
52
53
#include <boost/thread.hpp>
54
55 2eaafff2 Alex
#include <stdio.h>
56
57 a8480867 Alex Zirbel
#include "sim_frame.h"
58 266ae7f2 Alex Zirbel
59
#ifdef __WXMAC__
60
#include <ApplicationServices/ApplicationServices.h>
61
#endif
62
63 2eaafff2 Alex
using namespace std;
64
65 266ae7f2 Alex Zirbel
class ScoutApp : public wxApp
66
{
67 c492be62 Alex Zirbel
    public:
68
        char** local_argv;
69
        ros::NodeHandlePtr nh;
70 266ae7f2 Alex Zirbel
71 c492be62 Alex Zirbel
        ScoutApp()
72
        {
73
        }
74 266ae7f2 Alex Zirbel
75 c492be62 Alex Zirbel
        bool OnInit()
76
        {
77 2eaafff2 Alex
            std::cout << "Starting scout app." << std::endl;
78 266ae7f2 Alex Zirbel
#ifdef __WXMAC__
79 c492be62 Alex Zirbel
            ProcessSerialNumber PSN;
80
            GetCurrentProcess(&PSN);
81
            TransformProcessType(&PSN,kProcessTransformToForegroundApplication);
82
            SetFrontProcess(&PSN);
83 266ae7f2 Alex Zirbel
#endif
84 c492be62 Alex Zirbel
            // Create our own copy of argv, with regular char*s.
85
            local_argv = new char*[ argc ];
86
            for ( int i = 0; i < argc; ++i )
87
            {
88
                local_argv[ i ] = strdup( wxString( argv[ i ] ).mb_str() );
89
            }
90 266ae7f2 Alex Zirbel
91 2eaafff2 Alex
            // Check for incorrect usage
92 da08d580 Alex Zirbel
            if (argc < 2)
93 2eaafff2 Alex
            {
94
                cout << endl << "Error." << endl << endl;
95
                cout << "Usage: " << local_argv[0] << " <map name>" << endl;
96
                cout << "To use maps/example.bmp, use 'example'." << endl;
97
                exit(0);
98
            }
99
100
            std::cout << "About to init node" << std::endl;
101 c492be62 Alex Zirbel
            ros::init(argc, local_argv, "scoutsim");
102 2eaafff2 Alex
            std::cout << "About to reset." << std::endl;
103 c492be62 Alex Zirbel
            nh.reset(new ros::NodeHandle);
104 266ae7f2 Alex Zirbel
105 2eaafff2 Alex
            std::cout << "About to init image handlers." << std::endl;
106 c492be62 Alex Zirbel
            wxInitAllImageHandlers();
107 266ae7f2 Alex Zirbel
108 2eaafff2 Alex
            std::cout << "About to make a sim frame." << std::endl;
109
            scoutsim::SimFrame* frame = new scoutsim::SimFrame(NULL, string(local_argv[1]));
110 266ae7f2 Alex Zirbel
111 c492be62 Alex Zirbel
            SetTopWindow(frame);
112
            frame->Show();
113 266ae7f2 Alex Zirbel
114 2eaafff2 Alex
            std::cout << "Constructor done!" << std::endl;
115 c492be62 Alex Zirbel
            return true;
116
        }
117 266ae7f2 Alex Zirbel
118 c492be62 Alex Zirbel
        int OnExit()
119
        {
120
            for ( int i = 0; i < argc; ++i )
121
            {
122
                free( local_argv[ i ] );
123
            }
124
            delete [] local_argv;
125 266ae7f2 Alex Zirbel
126 c492be62 Alex Zirbel
            return 0;
127
        }
128 266ae7f2 Alex Zirbel
};
129
130 2eaafff2 Alex
BEGIN_EVENT_TABLE(scoutsim::SimFrame, wxFrame)
131
    EVT_MENU(ID_QUIT,  scoutsim::SimFrame::onQuit)
132
    EVT_MENU(ID_ABOUT, scoutsim::SimFrame::onAbout)
133
    EVT_MENU(ID_CLEAR, scoutsim::SimFrame::onClear)
134
    EVT_MENU(ID_MAP, scoutsim::SimFrame::showMap)
135
    EVT_MENU(ID_LINES, scoutsim::SimFrame::showLines)
136 7ffad595 Alex
    EVT_MENU(ID_WALLS, scoutsim::SimFrame::showWalls)
137 0e77683c Alex
    EVT_MENU(ID_TELEOP_NONE, scoutsim::SimFrame::stopTeleop)
138
    EVT_MENU(ID_TELEOP_PRECISE, scoutsim::SimFrame::startTeleopPrecise)
139
    EVT_MENU(ID_TELEOP_FLUID, scoutsim::SimFrame::startTeleopFluid)
140 2eaafff2 Alex
END_EVENT_TABLE()
141
142 266ae7f2 Alex Zirbel
DECLARE_APP(ScoutApp);
143
IMPLEMENT_APP(ScoutApp);