00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038 #include "Transport/World2DInput.H"
00039 #include "Component/OptionManager.H"
00040 #include "Image/DrawOps.H"
00041 #include "Image/ColorOps.H"
00042 #include "Raster/GenericFrame.H"
00043
00044
00045 World2DInput::World2DInput(OptionManager& mgr) :
00046 FrameIstream(mgr, "World2DInput Input", "World2DInputInput"),
00047 itsImageDims(320,240)
00048 {
00049 initRandomNumbers();
00050
00051 itsCurrentPos.i = 0;
00052 itsCurrentPos.j = 128;
00053 itsFrame = 0;
00054
00055 }
00056
00057 World2DInput::~World2DInput()
00058 {
00059 }
00060
00061
00062 void World2DInput::setConfigInfo(const std::string& dimsstring)
00063 {
00064
00065
00066
00067
00068 if (dimsstring.size() == 0)
00069 return;
00070
00071 Dims d; convertFromString(dimsstring, d);
00072 this->setImageDims(d);
00073 }
00074
00075
00076 GenericFrameSpec World2DInput::peekFrameSpec()
00077 {
00078 GenericFrameSpec result;
00079
00080 result.nativeType = GenericFrame::RGB_U8;
00081 result.videoFormat = VIDFMT_AUTO;
00082 result.videoByteSwap = false;
00083 result.dims = itsImageDims;
00084 result.floatFlags = 0;
00085
00086 return result;
00087 }
00088
00089
00090 GenericFrame World2DInput::readFrame()
00091 {
00092 generateWorld();
00093
00094 Image<PixRGB<byte> > result = getImage();
00095 usleep(10000);
00096 return GenericFrame(result);
00097 }
00098
00099
00100 void World2DInput::setImageDims(const Dims& s)
00101 {
00102 itsImageDims = s;
00103 }
00104
00105
00106
00107 void World2DInput::generateWorld()
00108 {
00109
00110 itsWorldImg = Image<PixRGB<byte> >(itsImageDims,ZEROS);
00111 itsWorldImg.clear(PixRGB<byte>(128,128,128));
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134 Dims size(100,100);
00135 drawFilledRect(itsWorldImg,
00136 Rectangle(Point2D<int>((320/2)-(size.w()/2),
00137 (240/2)-(size.h()/2)), size),
00138 PixRGB<byte>(0,0,0));
00139
00140 drawFilledRect(itsWorldImg,
00141 Rectangle(Point2D<int>((320/2)-(size.w()/2)-50,(240/2)-(size.h()/2)-50),
00142 size),
00143 PixRGB<byte>(255,255,255));
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153 itsFrame++;
00154 }
00155
00156 double World2DInput::getLineOri()
00157 {
00158
00159 double ori;
00160 double horizStd = 15;
00161 double vertStd = 15;
00162
00163 double u = randomDouble();
00164
00165 int idum = getIdum();
00166 if (u > 0.5)
00167 ori = 0 + horizStd*gasdev(idum);
00168 else
00169 ori = 90 + vertStd*gasdev(idum);
00170
00171 if (ori < 0)
00172 ori += 180;
00173
00174 return ori;
00175 }
00176
00177 double World2DInput::getLineLength()
00178 {
00179
00180 double length = 10 + randomUpToNotIncluding(itsImageDims.w()/10);
00181
00182 return length;
00183 }
00184
00185 PixRGB<byte> World2DInput::getLineColor()
00186 {
00187 return PixRGB<byte>(255,0,0);
00188 }
00189
00190
00191 void World2DInput::placeLine(Image<PixRGB<byte> > &img)
00192 {
00193
00194
00195 double ori = 45;
00196 double length = 50;
00197 PixRGB<byte> col = getLineColor();
00198 int rad = 1;
00199
00200
00201 Point2D<int> pos(150,100);
00202
00203 LINFO("Line param ori=%f, length=%f, pos=%i,%i",
00204 ori, length, pos.i, pos.j);
00205
00206
00207 int x1 = int(cos(ori*M_PI/180)*length);
00208 int y1 = int(sin(ori*M_PI/180)*length);
00209
00210 Point2D<int> p1 = pos;
00211 Point2D<int> p2(pos.i+x1, pos.j-y1);
00212
00213 drawLine(img, p1, p2, col, rad);
00214
00215 }
00216
00217 void World2DInput::placeSquare(Image<PixRGB<byte> > &img)
00218 {
00219
00220
00221 double ori = getLineOri();
00222 double size = getLineLength();
00223 PixRGB<byte> col = getLineColor();
00224 int rad = 1;
00225 Point2D<int> pos(randomUpToNotIncluding(itsImageDims.w()),
00226 randomUpToNotIncluding(itsImageDims.h()));
00227
00228
00229 LINFO("Square param ori=%f, size=%f, pos=%i,%i",
00230 ori, size, pos.i, pos.j);
00231
00232
00233 drawRectOR(img, Rectangle(pos, Dims((int)size,(int)size)), col, rad, ori);
00234
00235 }
00236
00237 Image<PixRGB<byte> > World2DInput::getImage()
00238 {
00239
00240 return itsWorldImg;
00241
00242 }
00243
00244
00245
00246
00247
00248