void CiCreateDef::UpdateGyroscope() {
unsigned char *dataR;
int pocet;
dataR = (unsigned char*) malloc(500);
SendToGyro(0x6F);
SendToGyro(0x03);
pocet = ReadNBytes(dataR, 9);
std::cout << "ma byt" << "9" << " prislo" << pocet << "\n";
union pomoc_t {
WORD data;
unsigned char datab[2];
} pomoc1;
pomoc1.datab[1] = *(dataR + 1);
pomoc1.datab[0] = *(dataR + 2);
std::cout << pomoc1.data << " ";
pomoc1.datab[1] = *(dataR + 3);
pomoc1.datab[0] = *(dataR + 4);
std::cout << pomoc1.data << " ";
pomoc1.datab[1] = *(dataR + 5);
pomoc1.datab[1] = *(dataR + 6);
std::cout << pomoc1.data << " ";
pomoc1.datab[1] = *(dataR + 7);
pomoc1.datab[0] = *(dataR + 8);
std::cout << pomoc1.data << "\n";
if (pocet == 9 && static_cast<int>(*(dataR))==112) {
std::cout << "prvy" << static_cast<int>(*(dataR)) << "\n";
return;
} else {
std::cout << "došiel chybný packet\n";
pocet = ReadNBytes(dataR, 20);
}
return;
}
//
// ReadJfif()
//
void JLSInputStream::ReadJfif()
{
for(int i = 0; i < (int)sizeof(jfifID); i++)
{
if(jfifID[i] != ReadByte())
return;
}
_info.jfif.Ver = ReadWord();
// DPI or DPcm
_info.jfif.units = ReadByte();
_info.jfif.XDensity = ReadWord();
_info.jfif.YDensity = ReadWord();
// thumbnail
_info.jfif.Xthumb = ReadByte();
_info.jfif.Ythumb = ReadByte();
if(_info.jfif.Xthumb > 0 && _info.jfif.pdataThumbnail)
{
std::vector<char> tempbuff((char*)_info.jfif.pdataThumbnail, (char*)_info.jfif.pdataThumbnail+3*_info.jfif.Xthumb*_info.jfif.Ythumb);
ReadNBytes(tempbuff, 3*_info.jfif.Xthumb*_info.jfif.Ythumb);
}
}
//
// ReadColorXForm()
//
void JLSInputStream::ReadColorXForm()
{
std::vector<char> sourceTag;
ReadNBytes(sourceTag, 4);
if(strncmp(&sourceTag[0],"mrfx", 4) != 0)
return;
int xform = ReadByte();
switch(xform)
{
case COLORXFORM_NONE:
case COLORXFORM_HP1:
case COLORXFORM_HP2:
case COLORXFORM_HP3:
_info.colorTransform = xform;
return;
case COLORXFORM_RGB_AS_YUV_LOSSY:
case COLORXFORM_MATRIX:
throw JlsException(ImageTypeNotSupported);
default:
throw JlsException(InvalidCompressedData);
}
}
