Ignore:
Timestamp:
Oct 11, 2016, 12:07:16 PM (5 years ago)
Author:
Sanahuja Guillaume
Message:

maj quaternion 3dmgx3

File:
1 edited

Legend:

Unmodified
Added
Removed
  • trunk/lib/FlairSensorActuator/src/Gx3_25_imu_impl.cpp

    r102 r103  
    118118  SetContinuousMode(command);
    119119
    120   //_printf("firmware version: %i\n",get_firmware_number());
    121 
    122120  while (!self->ToBeStopped()) {
    123121    if (command == Gx3_25_imu::EulerAnglesAndAngularRates) {
     
    352350  command[5] = rate & 0xff;        // data rate LSB
    353351  result = 0;
    354   if (disable_magn->IsChecked() == true)
    355     result |= 0x01;
    356   if (disable_north_comp->IsChecked() == true)
    357     result |= 0x04;
    358   if (disable_grav_comp->IsChecked() == true)
    359     result |= 0x08;
    360 
     352  if (disable_magn->IsChecked() == true) result |= 0x01;
     353  if (disable_north_comp->IsChecked() == true) result |= 0x04;
     354  if (disable_grav_comp->IsChecked() == true) result |= 0x08;
     355  if (this->command == Gx3_25_imu::Quaternion) result |= 0x10;//enable quaternion
    361356  command[6] = result;
     357
    362358  result = 0x01; // Calculate orientation
    363359  if (coning->IsChecked() == true)
Note: See TracChangeset for help on using the changeset viewer.