Statistics
| Branch: | Revision:

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

History | View | Annotate | Download (4.88 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 266ae7f2 Alex Zirbel
70 c492be62 Alex Zirbel
        ScoutApp()
71
        {
72
        }
73 266ae7f2 Alex Zirbel
74 c492be62 Alex Zirbel
        bool OnInit()
75
        {
76 2eaafff2 Alex
            std::cout << "Starting scout app." << std::endl;
77 266ae7f2 Alex Zirbel
#ifdef __WXMAC__
78 c492be62 Alex Zirbel
            ProcessSerialNumber PSN;
79
            GetCurrentProcess(&PSN);
80
            TransformProcessType(&PSN,kProcessTransformToForegroundApplication);
81
            SetFrontProcess(&PSN);
82 266ae7f2 Alex Zirbel
#endif
83 c492be62 Alex Zirbel
            // Create our own copy of argv, with regular char*s.
84
            local_argv = new char*[ argc ];
85
            for ( int i = 0; i < argc; ++i )
86
            {
87
                local_argv[ i ] = strdup( wxString( argv[ i ] ).mb_str() );
88
            }
89 266ae7f2 Alex Zirbel
90 2eaafff2 Alex
            // Check for incorrect usage
91 da08d580 Alex Zirbel
            if (argc < 2)
92 2eaafff2 Alex
            {
93
                cout << endl << "Error." << endl << endl;
94
                cout << "Usage: " << local_argv[0] << " <map name>" << endl;
95
                cout << "To use maps/example.bmp, use 'example'." << endl;
96
                exit(0);
97
            }
98
99
            std::cout << "About to init node" << std::endl;
100 c492be62 Alex Zirbel
            ros::init(argc, local_argv, "scoutsim");
101 2eaafff2 Alex
            std::cout << "About to reset." << std::endl;
102 266ae7f2 Alex Zirbel
103 2eaafff2 Alex
            std::cout << "About to init image handlers." << std::endl;
104 c492be62 Alex Zirbel
            wxInitAllImageHandlers();
105 266ae7f2 Alex Zirbel
106 2eaafff2 Alex
            std::cout << "About to make a sim frame." << std::endl;
107
            scoutsim::SimFrame* frame = new scoutsim::SimFrame(NULL, string(local_argv[1]));
108 266ae7f2 Alex Zirbel
109 c492be62 Alex Zirbel
            SetTopWindow(frame);
110
            frame->Show();
111 266ae7f2 Alex Zirbel
112 2eaafff2 Alex
            std::cout << "Constructor done!" << std::endl;
113 c492be62 Alex Zirbel
            return true;
114
        }
115 266ae7f2 Alex Zirbel
116 c492be62 Alex Zirbel
        int OnExit()
117
        {
118
            for ( int i = 0; i < argc; ++i )
119
            {
120
                free( local_argv[ i ] );
121
            }
122
            delete [] local_argv;
123 266ae7f2 Alex Zirbel
124 c492be62 Alex Zirbel
            return 0;
125
        }
126 266ae7f2 Alex Zirbel
};
127
128 2eaafff2 Alex
BEGIN_EVENT_TABLE(scoutsim::SimFrame, wxFrame)
129
    EVT_MENU(ID_QUIT,  scoutsim::SimFrame::onQuit)
130
    EVT_MENU(ID_ABOUT, scoutsim::SimFrame::onAbout)
131
    EVT_MENU(ID_CLEAR, scoutsim::SimFrame::onClear)
132
    EVT_MENU(ID_MAP, scoutsim::SimFrame::showMap)
133
    EVT_MENU(ID_LINES, scoutsim::SimFrame::showLines)
134 7ffad595 Alex
    EVT_MENU(ID_WALLS, scoutsim::SimFrame::showWalls)
135 0e77683c Alex
    EVT_MENU(ID_TELEOP_NONE, scoutsim::SimFrame::stopTeleop)
136
    EVT_MENU(ID_TELEOP_PRECISE, scoutsim::SimFrame::startTeleopPrecise)
137
    EVT_MENU(ID_TELEOP_FLUID, scoutsim::SimFrame::startTeleopFluid)
138 2eaafff2 Alex
END_EVENT_TABLE()
139
140 266ae7f2 Alex Zirbel
DECLARE_APP(ScoutApp);
141
IMPLEMENT_APP(ScoutApp);