Skip to content

Commit

Permalink
fix imu data (#266)
Browse files Browse the repository at this point in the history
* fix imu data

* Update license year

---------

Co-authored-by: carebare47 <tom@shadowrobot.com>
Co-authored-by: rnzenha-s <107403736+rnzenha-s@users.noreply.github.com>
  • Loading branch information
3 people authored Mar 20, 2024
1 parent 5cd6388 commit ba06210
Showing 1 changed file with 7 additions and 7 deletions.
14 changes: 7 additions & 7 deletions sr_edc_ethercat_drivers/src/sr09.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -4,7 +4,7 @@
* Ugo Cupcic <ugo@shadowrobot.com>, Toni Oliver <toni@shadowrobot.com>,
* Dan Greenwald <dg@shadowrobot.com>, contact <software@shadowrobot.com>
*
/* Copyright 2017 Shadow Robot Company Ltd.
/* Copyright 2017, 2024 Shadow Robot Company Ltd.
*
* This program is free software: you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the Free
Expand Down Expand Up @@ -477,15 +477,15 @@ bool SR09::unpackState(unsigned char *this_buffer, unsigned char *prev_buffer)

extra_analog_msg.layout.dim[0].label = "accelerometer";
extra_analog_msg.layout.dim[0].size = 3;
extra_analog_msg.data[0] = status_data->sensors[ACCX];
extra_analog_msg.data[1] = status_data->sensors[ACCY];
extra_analog_msg.data[2] = status_data->sensors[ACCZ];
extra_analog_msg.data[0] = (int16_t)status_data->sensors[ACCX];
extra_analog_msg.data[1] = (int16_t)status_data->sensors[ACCY];
extra_analog_msg.data[2] = (int16_t)status_data->sensors[ACCZ];

extra_analog_msg.layout.dim[1].label = "gyrometer";
extra_analog_msg.layout.dim[1].size = 3;
extra_analog_msg.data[3] = status_data->sensors[GYRX];
extra_analog_msg.data[4] = status_data->sensors[GYRY];
extra_analog_msg.data[5] = status_data->sensors[GYRZ];
extra_analog_msg.data[3] = (int16_t)status_data->sensors[GYRX];
extra_analog_msg.data[4] = (int16_t)status_data->sensors[GYRY];
extra_analog_msg.data[5] = (int16_t)status_data->sensors[GYRZ];

extra_analog_msg.layout.dim[2].label = "analog_inputs";
extra_analog_msg.layout.dim[2].size = 4;
Expand Down

0 comments on commit ba06210

Please sign in to comment.