Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependents: RobotFeedback mobileRobotITU
Fork of ros_lib_indigo by
beginner_tutorials/RobotFeedback.h@1:58e743c70bed, 2017-01-13 (annotated)
- Committer:
- randalthor
- Date:
- Fri Jan 13 07:31:17 2017 +0000
- Revision:
- 1:58e743c70bed
wrong checksum for topic id and msg error, but works fine for now
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| randalthor | 1:58e743c70bed | 1 | #ifndef _ROS_beginner_tutorials_RobotFeedback_h |
| randalthor | 1:58e743c70bed | 2 | #define _ROS_beginner_tutorials_RobotFeedback_h |
| randalthor | 1:58e743c70bed | 3 | |
| randalthor | 1:58e743c70bed | 4 | #include <stdint.h> |
| randalthor | 1:58e743c70bed | 5 | #include <string.h> |
| randalthor | 1:58e743c70bed | 6 | #include <stdlib.h> |
| randalthor | 1:58e743c70bed | 7 | #include "ros/msg.h" |
| randalthor | 1:58e743c70bed | 8 | |
| randalthor | 1:58e743c70bed | 9 | namespace beginner_tutorials |
| randalthor | 1:58e743c70bed | 10 | { |
| randalthor | 1:58e743c70bed | 11 | |
| randalthor | 1:58e743c70bed | 12 | class RobotFeedback : public ros::Msg |
| randalthor | 1:58e743c70bed | 13 | { |
| randalthor | 1:58e743c70bed | 14 | public: |
| randalthor | 1:58e743c70bed | 15 | typedef int32_t _encoder_1_type; |
| randalthor | 1:58e743c70bed | 16 | _encoder_1_type encoder_1; |
| randalthor | 1:58e743c70bed | 17 | typedef int32_t _encoder_2_type; |
| randalthor | 1:58e743c70bed | 18 | _encoder_2_type encoder_2; |
| randalthor | 1:58e743c70bed | 19 | typedef int32_t _encoder_3_type; |
| randalthor | 1:58e743c70bed | 20 | _encoder_3_type encoder_3; |
| randalthor | 1:58e743c70bed | 21 | typedef int32_t _encoder_4_type; |
| randalthor | 1:58e743c70bed | 22 | _encoder_4_type encoder_4; |
| randalthor | 1:58e743c70bed | 23 | typedef float _pwm_1_type; |
| randalthor | 1:58e743c70bed | 24 | _pwm_1_type pwm_1; |
| randalthor | 1:58e743c70bed | 25 | typedef float _pwm_2_type; |
| randalthor | 1:58e743c70bed | 26 | _pwm_2_type pwm_2; |
| randalthor | 1:58e743c70bed | 27 | typedef float _pwm_3_type; |
| randalthor | 1:58e743c70bed | 28 | _pwm_3_type pwm_3; |
| randalthor | 1:58e743c70bed | 29 | typedef float _pwm_4_type; |
| randalthor | 1:58e743c70bed | 30 | _pwm_4_type pwm_4; |
| randalthor | 1:58e743c70bed | 31 | typedef float _dc_current_1_type; |
| randalthor | 1:58e743c70bed | 32 | _dc_current_1_type dc_current_1; |
| randalthor | 1:58e743c70bed | 33 | typedef float _dc_current_2_type; |
| randalthor | 1:58e743c70bed | 34 | _dc_current_2_type dc_current_2; |
| randalthor | 1:58e743c70bed | 35 | typedef float _dc_current_3_type; |
| randalthor | 1:58e743c70bed | 36 | _dc_current_3_type dc_current_3; |
| randalthor | 1:58e743c70bed | 37 | typedef float _dc_current_4_type; |
| randalthor | 1:58e743c70bed | 38 | _dc_current_4_type dc_current_4; |
| randalthor | 1:58e743c70bed | 39 | typedef float _sensor_1_type; |
| randalthor | 1:58e743c70bed | 40 | _sensor_1_type sensor_1; |
| randalthor | 1:58e743c70bed | 41 | typedef float _sensor_2_type; |
| randalthor | 1:58e743c70bed | 42 | _sensor_2_type sensor_2; |
| randalthor | 1:58e743c70bed | 43 | typedef float _sensor_3_type; |
| randalthor | 1:58e743c70bed | 44 | _sensor_3_type sensor_3; |
| randalthor | 1:58e743c70bed | 45 | typedef float _sensor_4_type; |
| randalthor | 1:58e743c70bed | 46 | _sensor_4_type sensor_4; |
| randalthor | 1:58e743c70bed | 47 | |
| randalthor | 1:58e743c70bed | 48 | RobotFeedback(): |
| randalthor | 1:58e743c70bed | 49 | encoder_1(0), |
| randalthor | 1:58e743c70bed | 50 | encoder_2(0), |
| randalthor | 1:58e743c70bed | 51 | encoder_3(0), |
| randalthor | 1:58e743c70bed | 52 | encoder_4(0), |
| randalthor | 1:58e743c70bed | 53 | pwm_1(0), |
| randalthor | 1:58e743c70bed | 54 | pwm_2(0), |
| randalthor | 1:58e743c70bed | 55 | pwm_3(0), |
| randalthor | 1:58e743c70bed | 56 | pwm_4(0), |
| randalthor | 1:58e743c70bed | 57 | dc_current_1(0), |
| randalthor | 1:58e743c70bed | 58 | dc_current_2(0), |
| randalthor | 1:58e743c70bed | 59 | dc_current_3(0), |
| randalthor | 1:58e743c70bed | 60 | dc_current_4(0), |
| randalthor | 1:58e743c70bed | 61 | sensor_1(0), |
| randalthor | 1:58e743c70bed | 62 | sensor_2(0), |
| randalthor | 1:58e743c70bed | 63 | sensor_3(0), |
| randalthor | 1:58e743c70bed | 64 | sensor_4(0) |
| randalthor | 1:58e743c70bed | 65 | { |
| randalthor | 1:58e743c70bed | 66 | } |
| randalthor | 1:58e743c70bed | 67 | |
| randalthor | 1:58e743c70bed | 68 | virtual int serialize(unsigned char *outbuffer) const |
| randalthor | 1:58e743c70bed | 69 | { |
| randalthor | 1:58e743c70bed | 70 | int offset = 0; |
| randalthor | 1:58e743c70bed | 71 | union { |
| randalthor | 1:58e743c70bed | 72 | int32_t real; |
| randalthor | 1:58e743c70bed | 73 | uint32_t base; |
| randalthor | 1:58e743c70bed | 74 | } u_encoder_1; |
| randalthor | 1:58e743c70bed | 75 | u_encoder_1.real = this->encoder_1; |
| randalthor | 1:58e743c70bed | 76 | *(outbuffer + offset + 0) = (u_encoder_1.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 77 | *(outbuffer + offset + 1) = (u_encoder_1.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 78 | *(outbuffer + offset + 2) = (u_encoder_1.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 79 | *(outbuffer + offset + 3) = (u_encoder_1.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 80 | offset += sizeof(this->encoder_1); |
| randalthor | 1:58e743c70bed | 81 | union { |
| randalthor | 1:58e743c70bed | 82 | int32_t real; |
| randalthor | 1:58e743c70bed | 83 | uint32_t base; |
| randalthor | 1:58e743c70bed | 84 | } u_encoder_2; |
| randalthor | 1:58e743c70bed | 85 | u_encoder_2.real = this->encoder_2; |
| randalthor | 1:58e743c70bed | 86 | *(outbuffer + offset + 0) = (u_encoder_2.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 87 | *(outbuffer + offset + 1) = (u_encoder_2.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 88 | *(outbuffer + offset + 2) = (u_encoder_2.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 89 | *(outbuffer + offset + 3) = (u_encoder_2.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 90 | offset += sizeof(this->encoder_2); |
| randalthor | 1:58e743c70bed | 91 | union { |
| randalthor | 1:58e743c70bed | 92 | int32_t real; |
| randalthor | 1:58e743c70bed | 93 | uint32_t base; |
| randalthor | 1:58e743c70bed | 94 | } u_encoder_3; |
| randalthor | 1:58e743c70bed | 95 | u_encoder_3.real = this->encoder_3; |
| randalthor | 1:58e743c70bed | 96 | *(outbuffer + offset + 0) = (u_encoder_3.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 97 | *(outbuffer + offset + 1) = (u_encoder_3.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 98 | *(outbuffer + offset + 2) = (u_encoder_3.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 99 | *(outbuffer + offset + 3) = (u_encoder_3.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 100 | offset += sizeof(this->encoder_3); |
| randalthor | 1:58e743c70bed | 101 | union { |
| randalthor | 1:58e743c70bed | 102 | int32_t real; |
| randalthor | 1:58e743c70bed | 103 | uint32_t base; |
| randalthor | 1:58e743c70bed | 104 | } u_encoder_4; |
| randalthor | 1:58e743c70bed | 105 | u_encoder_4.real = this->encoder_4; |
| randalthor | 1:58e743c70bed | 106 | *(outbuffer + offset + 0) = (u_encoder_4.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 107 | *(outbuffer + offset + 1) = (u_encoder_4.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 108 | *(outbuffer + offset + 2) = (u_encoder_4.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 109 | *(outbuffer + offset + 3) = (u_encoder_4.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 110 | offset += sizeof(this->encoder_4); |
| randalthor | 1:58e743c70bed | 111 | union { |
| randalthor | 1:58e743c70bed | 112 | float real; |
| randalthor | 1:58e743c70bed | 113 | uint32_t base; |
| randalthor | 1:58e743c70bed | 114 | } u_pwm_1; |
| randalthor | 1:58e743c70bed | 115 | u_pwm_1.real = this->pwm_1; |
| randalthor | 1:58e743c70bed | 116 | *(outbuffer + offset + 0) = (u_pwm_1.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 117 | *(outbuffer + offset + 1) = (u_pwm_1.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 118 | *(outbuffer + offset + 2) = (u_pwm_1.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 119 | *(outbuffer + offset + 3) = (u_pwm_1.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 120 | offset += sizeof(this->pwm_1); |
| randalthor | 1:58e743c70bed | 121 | union { |
| randalthor | 1:58e743c70bed | 122 | float real; |
| randalthor | 1:58e743c70bed | 123 | uint32_t base; |
| randalthor | 1:58e743c70bed | 124 | } u_pwm_2; |
| randalthor | 1:58e743c70bed | 125 | u_pwm_2.real = this->pwm_2; |
| randalthor | 1:58e743c70bed | 126 | *(outbuffer + offset + 0) = (u_pwm_2.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 127 | *(outbuffer + offset + 1) = (u_pwm_2.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 128 | *(outbuffer + offset + 2) = (u_pwm_2.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 129 | *(outbuffer + offset + 3) = (u_pwm_2.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 130 | offset += sizeof(this->pwm_2); |
| randalthor | 1:58e743c70bed | 131 | union { |
| randalthor | 1:58e743c70bed | 132 | float real; |
| randalthor | 1:58e743c70bed | 133 | uint32_t base; |
| randalthor | 1:58e743c70bed | 134 | } u_pwm_3; |
| randalthor | 1:58e743c70bed | 135 | u_pwm_3.real = this->pwm_3; |
| randalthor | 1:58e743c70bed | 136 | *(outbuffer + offset + 0) = (u_pwm_3.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 137 | *(outbuffer + offset + 1) = (u_pwm_3.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 138 | *(outbuffer + offset + 2) = (u_pwm_3.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 139 | *(outbuffer + offset + 3) = (u_pwm_3.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 140 | offset += sizeof(this->pwm_3); |
| randalthor | 1:58e743c70bed | 141 | union { |
| randalthor | 1:58e743c70bed | 142 | float real; |
| randalthor | 1:58e743c70bed | 143 | uint32_t base; |
| randalthor | 1:58e743c70bed | 144 | } u_pwm_4; |
| randalthor | 1:58e743c70bed | 145 | u_pwm_4.real = this->pwm_4; |
| randalthor | 1:58e743c70bed | 146 | *(outbuffer + offset + 0) = (u_pwm_4.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 147 | *(outbuffer + offset + 1) = (u_pwm_4.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 148 | *(outbuffer + offset + 2) = (u_pwm_4.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 149 | *(outbuffer + offset + 3) = (u_pwm_4.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 150 | offset += sizeof(this->pwm_4); |
| randalthor | 1:58e743c70bed | 151 | union { |
| randalthor | 1:58e743c70bed | 152 | float real; |
| randalthor | 1:58e743c70bed | 153 | uint32_t base; |
| randalthor | 1:58e743c70bed | 154 | } u_dc_current_1; |
| randalthor | 1:58e743c70bed | 155 | u_dc_current_1.real = this->dc_current_1; |
| randalthor | 1:58e743c70bed | 156 | *(outbuffer + offset + 0) = (u_dc_current_1.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 157 | *(outbuffer + offset + 1) = (u_dc_current_1.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 158 | *(outbuffer + offset + 2) = (u_dc_current_1.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 159 | *(outbuffer + offset + 3) = (u_dc_current_1.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 160 | offset += sizeof(this->dc_current_1); |
| randalthor | 1:58e743c70bed | 161 | union { |
| randalthor | 1:58e743c70bed | 162 | float real; |
| randalthor | 1:58e743c70bed | 163 | uint32_t base; |
| randalthor | 1:58e743c70bed | 164 | } u_dc_current_2; |
| randalthor | 1:58e743c70bed | 165 | u_dc_current_2.real = this->dc_current_2; |
| randalthor | 1:58e743c70bed | 166 | *(outbuffer + offset + 0) = (u_dc_current_2.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 167 | *(outbuffer + offset + 1) = (u_dc_current_2.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 168 | *(outbuffer + offset + 2) = (u_dc_current_2.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 169 | *(outbuffer + offset + 3) = (u_dc_current_2.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 170 | offset += sizeof(this->dc_current_2); |
| randalthor | 1:58e743c70bed | 171 | union { |
| randalthor | 1:58e743c70bed | 172 | float real; |
| randalthor | 1:58e743c70bed | 173 | uint32_t base; |
| randalthor | 1:58e743c70bed | 174 | } u_dc_current_3; |
| randalthor | 1:58e743c70bed | 175 | u_dc_current_3.real = this->dc_current_3; |
| randalthor | 1:58e743c70bed | 176 | *(outbuffer + offset + 0) = (u_dc_current_3.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 177 | *(outbuffer + offset + 1) = (u_dc_current_3.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 178 | *(outbuffer + offset + 2) = (u_dc_current_3.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 179 | *(outbuffer + offset + 3) = (u_dc_current_3.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 180 | offset += sizeof(this->dc_current_3); |
| randalthor | 1:58e743c70bed | 181 | union { |
| randalthor | 1:58e743c70bed | 182 | float real; |
| randalthor | 1:58e743c70bed | 183 | uint32_t base; |
| randalthor | 1:58e743c70bed | 184 | } u_dc_current_4; |
| randalthor | 1:58e743c70bed | 185 | u_dc_current_4.real = this->dc_current_4; |
| randalthor | 1:58e743c70bed | 186 | *(outbuffer + offset + 0) = (u_dc_current_4.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 187 | *(outbuffer + offset + 1) = (u_dc_current_4.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 188 | *(outbuffer + offset + 2) = (u_dc_current_4.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 189 | *(outbuffer + offset + 3) = (u_dc_current_4.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 190 | offset += sizeof(this->dc_current_4); |
| randalthor | 1:58e743c70bed | 191 | union { |
| randalthor | 1:58e743c70bed | 192 | float real; |
| randalthor | 1:58e743c70bed | 193 | uint32_t base; |
| randalthor | 1:58e743c70bed | 194 | } u_sensor_1; |
| randalthor | 1:58e743c70bed | 195 | u_sensor_1.real = this->sensor_1; |
| randalthor | 1:58e743c70bed | 196 | *(outbuffer + offset + 0) = (u_sensor_1.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 197 | *(outbuffer + offset + 1) = (u_sensor_1.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 198 | *(outbuffer + offset + 2) = (u_sensor_1.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 199 | *(outbuffer + offset + 3) = (u_sensor_1.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 200 | offset += sizeof(this->sensor_1); |
| randalthor | 1:58e743c70bed | 201 | union { |
| randalthor | 1:58e743c70bed | 202 | float real; |
| randalthor | 1:58e743c70bed | 203 | uint32_t base; |
| randalthor | 1:58e743c70bed | 204 | } u_sensor_2; |
| randalthor | 1:58e743c70bed | 205 | u_sensor_2.real = this->sensor_2; |
| randalthor | 1:58e743c70bed | 206 | *(outbuffer + offset + 0) = (u_sensor_2.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 207 | *(outbuffer + offset + 1) = (u_sensor_2.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 208 | *(outbuffer + offset + 2) = (u_sensor_2.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 209 | *(outbuffer + offset + 3) = (u_sensor_2.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 210 | offset += sizeof(this->sensor_2); |
| randalthor | 1:58e743c70bed | 211 | union { |
| randalthor | 1:58e743c70bed | 212 | float real; |
| randalthor | 1:58e743c70bed | 213 | uint32_t base; |
| randalthor | 1:58e743c70bed | 214 | } u_sensor_3; |
| randalthor | 1:58e743c70bed | 215 | u_sensor_3.real = this->sensor_3; |
| randalthor | 1:58e743c70bed | 216 | *(outbuffer + offset + 0) = (u_sensor_3.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 217 | *(outbuffer + offset + 1) = (u_sensor_3.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 218 | *(outbuffer + offset + 2) = (u_sensor_3.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 219 | *(outbuffer + offset + 3) = (u_sensor_3.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 220 | offset += sizeof(this->sensor_3); |
| randalthor | 1:58e743c70bed | 221 | union { |
| randalthor | 1:58e743c70bed | 222 | float real; |
| randalthor | 1:58e743c70bed | 223 | uint32_t base; |
| randalthor | 1:58e743c70bed | 224 | } u_sensor_4; |
| randalthor | 1:58e743c70bed | 225 | u_sensor_4.real = this->sensor_4; |
| randalthor | 1:58e743c70bed | 226 | *(outbuffer + offset + 0) = (u_sensor_4.base >> (8 * 0)) & 0xFF; |
| randalthor | 1:58e743c70bed | 227 | *(outbuffer + offset + 1) = (u_sensor_4.base >> (8 * 1)) & 0xFF; |
| randalthor | 1:58e743c70bed | 228 | *(outbuffer + offset + 2) = (u_sensor_4.base >> (8 * 2)) & 0xFF; |
| randalthor | 1:58e743c70bed | 229 | *(outbuffer + offset + 3) = (u_sensor_4.base >> (8 * 3)) & 0xFF; |
| randalthor | 1:58e743c70bed | 230 | offset += sizeof(this->sensor_4); |
| randalthor | 1:58e743c70bed | 231 | return offset; |
| randalthor | 1:58e743c70bed | 232 | } |
| randalthor | 1:58e743c70bed | 233 | |
| randalthor | 1:58e743c70bed | 234 | virtual int deserialize(unsigned char *inbuffer) |
| randalthor | 1:58e743c70bed | 235 | { |
| randalthor | 1:58e743c70bed | 236 | int offset = 0; |
| randalthor | 1:58e743c70bed | 237 | union { |
| randalthor | 1:58e743c70bed | 238 | int32_t real; |
| randalthor | 1:58e743c70bed | 239 | uint32_t base; |
| randalthor | 1:58e743c70bed | 240 | } u_encoder_1; |
| randalthor | 1:58e743c70bed | 241 | u_encoder_1.base = 0; |
| randalthor | 1:58e743c70bed | 242 | u_encoder_1.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 243 | u_encoder_1.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 244 | u_encoder_1.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 245 | u_encoder_1.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 246 | this->encoder_1 = u_encoder_1.real; |
| randalthor | 1:58e743c70bed | 247 | offset += sizeof(this->encoder_1); |
| randalthor | 1:58e743c70bed | 248 | union { |
| randalthor | 1:58e743c70bed | 249 | int32_t real; |
| randalthor | 1:58e743c70bed | 250 | uint32_t base; |
| randalthor | 1:58e743c70bed | 251 | } u_encoder_2; |
| randalthor | 1:58e743c70bed | 252 | u_encoder_2.base = 0; |
| randalthor | 1:58e743c70bed | 253 | u_encoder_2.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 254 | u_encoder_2.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 255 | u_encoder_2.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 256 | u_encoder_2.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 257 | this->encoder_2 = u_encoder_2.real; |
| randalthor | 1:58e743c70bed | 258 | offset += sizeof(this->encoder_2); |
| randalthor | 1:58e743c70bed | 259 | union { |
| randalthor | 1:58e743c70bed | 260 | int32_t real; |
| randalthor | 1:58e743c70bed | 261 | uint32_t base; |
| randalthor | 1:58e743c70bed | 262 | } u_encoder_3; |
| randalthor | 1:58e743c70bed | 263 | u_encoder_3.base = 0; |
| randalthor | 1:58e743c70bed | 264 | u_encoder_3.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 265 | u_encoder_3.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 266 | u_encoder_3.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 267 | u_encoder_3.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 268 | this->encoder_3 = u_encoder_3.real; |
| randalthor | 1:58e743c70bed | 269 | offset += sizeof(this->encoder_3); |
| randalthor | 1:58e743c70bed | 270 | union { |
| randalthor | 1:58e743c70bed | 271 | int32_t real; |
| randalthor | 1:58e743c70bed | 272 | uint32_t base; |
| randalthor | 1:58e743c70bed | 273 | } u_encoder_4; |
| randalthor | 1:58e743c70bed | 274 | u_encoder_4.base = 0; |
| randalthor | 1:58e743c70bed | 275 | u_encoder_4.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 276 | u_encoder_4.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 277 | u_encoder_4.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 278 | u_encoder_4.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 279 | this->encoder_4 = u_encoder_4.real; |
| randalthor | 1:58e743c70bed | 280 | offset += sizeof(this->encoder_4); |
| randalthor | 1:58e743c70bed | 281 | union { |
| randalthor | 1:58e743c70bed | 282 | float real; |
| randalthor | 1:58e743c70bed | 283 | uint32_t base; |
| randalthor | 1:58e743c70bed | 284 | } u_pwm_1; |
| randalthor | 1:58e743c70bed | 285 | u_pwm_1.base = 0; |
| randalthor | 1:58e743c70bed | 286 | u_pwm_1.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 287 | u_pwm_1.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 288 | u_pwm_1.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 289 | u_pwm_1.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 290 | this->pwm_1 = u_pwm_1.real; |
| randalthor | 1:58e743c70bed | 291 | offset += sizeof(this->pwm_1); |
| randalthor | 1:58e743c70bed | 292 | union { |
| randalthor | 1:58e743c70bed | 293 | float real; |
| randalthor | 1:58e743c70bed | 294 | uint32_t base; |
| randalthor | 1:58e743c70bed | 295 | } u_pwm_2; |
| randalthor | 1:58e743c70bed | 296 | u_pwm_2.base = 0; |
| randalthor | 1:58e743c70bed | 297 | u_pwm_2.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 298 | u_pwm_2.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 299 | u_pwm_2.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 300 | u_pwm_2.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 301 | this->pwm_2 = u_pwm_2.real; |
| randalthor | 1:58e743c70bed | 302 | offset += sizeof(this->pwm_2); |
| randalthor | 1:58e743c70bed | 303 | union { |
| randalthor | 1:58e743c70bed | 304 | float real; |
| randalthor | 1:58e743c70bed | 305 | uint32_t base; |
| randalthor | 1:58e743c70bed | 306 | } u_pwm_3; |
| randalthor | 1:58e743c70bed | 307 | u_pwm_3.base = 0; |
| randalthor | 1:58e743c70bed | 308 | u_pwm_3.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 309 | u_pwm_3.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 310 | u_pwm_3.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 311 | u_pwm_3.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 312 | this->pwm_3 = u_pwm_3.real; |
| randalthor | 1:58e743c70bed | 313 | offset += sizeof(this->pwm_3); |
| randalthor | 1:58e743c70bed | 314 | union { |
| randalthor | 1:58e743c70bed | 315 | float real; |
| randalthor | 1:58e743c70bed | 316 | uint32_t base; |
| randalthor | 1:58e743c70bed | 317 | } u_pwm_4; |
| randalthor | 1:58e743c70bed | 318 | u_pwm_4.base = 0; |
| randalthor | 1:58e743c70bed | 319 | u_pwm_4.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 320 | u_pwm_4.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 321 | u_pwm_4.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 322 | u_pwm_4.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 323 | this->pwm_4 = u_pwm_4.real; |
| randalthor | 1:58e743c70bed | 324 | offset += sizeof(this->pwm_4); |
| randalthor | 1:58e743c70bed | 325 | union { |
| randalthor | 1:58e743c70bed | 326 | float real; |
| randalthor | 1:58e743c70bed | 327 | uint32_t base; |
| randalthor | 1:58e743c70bed | 328 | } u_dc_current_1; |
| randalthor | 1:58e743c70bed | 329 | u_dc_current_1.base = 0; |
| randalthor | 1:58e743c70bed | 330 | u_dc_current_1.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 331 | u_dc_current_1.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 332 | u_dc_current_1.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 333 | u_dc_current_1.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 334 | this->dc_current_1 = u_dc_current_1.real; |
| randalthor | 1:58e743c70bed | 335 | offset += sizeof(this->dc_current_1); |
| randalthor | 1:58e743c70bed | 336 | union { |
| randalthor | 1:58e743c70bed | 337 | float real; |
| randalthor | 1:58e743c70bed | 338 | uint32_t base; |
| randalthor | 1:58e743c70bed | 339 | } u_dc_current_2; |
| randalthor | 1:58e743c70bed | 340 | u_dc_current_2.base = 0; |
| randalthor | 1:58e743c70bed | 341 | u_dc_current_2.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 342 | u_dc_current_2.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 343 | u_dc_current_2.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 344 | u_dc_current_2.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 345 | this->dc_current_2 = u_dc_current_2.real; |
| randalthor | 1:58e743c70bed | 346 | offset += sizeof(this->dc_current_2); |
| randalthor | 1:58e743c70bed | 347 | union { |
| randalthor | 1:58e743c70bed | 348 | float real; |
| randalthor | 1:58e743c70bed | 349 | uint32_t base; |
| randalthor | 1:58e743c70bed | 350 | } u_dc_current_3; |
| randalthor | 1:58e743c70bed | 351 | u_dc_current_3.base = 0; |
| randalthor | 1:58e743c70bed | 352 | u_dc_current_3.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 353 | u_dc_current_3.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 354 | u_dc_current_3.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 355 | u_dc_current_3.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 356 | this->dc_current_3 = u_dc_current_3.real; |
| randalthor | 1:58e743c70bed | 357 | offset += sizeof(this->dc_current_3); |
| randalthor | 1:58e743c70bed | 358 | union { |
| randalthor | 1:58e743c70bed | 359 | float real; |
| randalthor | 1:58e743c70bed | 360 | uint32_t base; |
| randalthor | 1:58e743c70bed | 361 | } u_dc_current_4; |
| randalthor | 1:58e743c70bed | 362 | u_dc_current_4.base = 0; |
| randalthor | 1:58e743c70bed | 363 | u_dc_current_4.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 364 | u_dc_current_4.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 365 | u_dc_current_4.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 366 | u_dc_current_4.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 367 | this->dc_current_4 = u_dc_current_4.real; |
| randalthor | 1:58e743c70bed | 368 | offset += sizeof(this->dc_current_4); |
| randalthor | 1:58e743c70bed | 369 | union { |
| randalthor | 1:58e743c70bed | 370 | float real; |
| randalthor | 1:58e743c70bed | 371 | uint32_t base; |
| randalthor | 1:58e743c70bed | 372 | } u_sensor_1; |
| randalthor | 1:58e743c70bed | 373 | u_sensor_1.base = 0; |
| randalthor | 1:58e743c70bed | 374 | u_sensor_1.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 375 | u_sensor_1.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 376 | u_sensor_1.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 377 | u_sensor_1.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 378 | this->sensor_1 = u_sensor_1.real; |
| randalthor | 1:58e743c70bed | 379 | offset += sizeof(this->sensor_1); |
| randalthor | 1:58e743c70bed | 380 | union { |
| randalthor | 1:58e743c70bed | 381 | float real; |
| randalthor | 1:58e743c70bed | 382 | uint32_t base; |
| randalthor | 1:58e743c70bed | 383 | } u_sensor_2; |
| randalthor | 1:58e743c70bed | 384 | u_sensor_2.base = 0; |
| randalthor | 1:58e743c70bed | 385 | u_sensor_2.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 386 | u_sensor_2.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 387 | u_sensor_2.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 388 | u_sensor_2.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 389 | this->sensor_2 = u_sensor_2.real; |
| randalthor | 1:58e743c70bed | 390 | offset += sizeof(this->sensor_2); |
| randalthor | 1:58e743c70bed | 391 | union { |
| randalthor | 1:58e743c70bed | 392 | float real; |
| randalthor | 1:58e743c70bed | 393 | uint32_t base; |
| randalthor | 1:58e743c70bed | 394 | } u_sensor_3; |
| randalthor | 1:58e743c70bed | 395 | u_sensor_3.base = 0; |
| randalthor | 1:58e743c70bed | 396 | u_sensor_3.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 397 | u_sensor_3.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 398 | u_sensor_3.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 399 | u_sensor_3.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 400 | this->sensor_3 = u_sensor_3.real; |
| randalthor | 1:58e743c70bed | 401 | offset += sizeof(this->sensor_3); |
| randalthor | 1:58e743c70bed | 402 | union { |
| randalthor | 1:58e743c70bed | 403 | float real; |
| randalthor | 1:58e743c70bed | 404 | uint32_t base; |
| randalthor | 1:58e743c70bed | 405 | } u_sensor_4; |
| randalthor | 1:58e743c70bed | 406 | u_sensor_4.base = 0; |
| randalthor | 1:58e743c70bed | 407 | u_sensor_4.base |= ((uint32_t) (*(inbuffer + offset + 0))) << (8 * 0); |
| randalthor | 1:58e743c70bed | 408 | u_sensor_4.base |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
| randalthor | 1:58e743c70bed | 409 | u_sensor_4.base |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
| randalthor | 1:58e743c70bed | 410 | u_sensor_4.base |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
| randalthor | 1:58e743c70bed | 411 | this->sensor_4 = u_sensor_4.real; |
| randalthor | 1:58e743c70bed | 412 | offset += sizeof(this->sensor_4); |
| randalthor | 1:58e743c70bed | 413 | return offset; |
| randalthor | 1:58e743c70bed | 414 | } |
| randalthor | 1:58e743c70bed | 415 | |
| randalthor | 1:58e743c70bed | 416 | const char * getType(){ return "beginner_tutorials/RobotFeedback"; }; |
| randalthor | 1:58e743c70bed | 417 | const char * getMD5(){ return "f31bdce92ed3d88b204eacb08d719892"; }; |
| randalthor | 1:58e743c70bed | 418 | |
| randalthor | 1:58e743c70bed | 419 | }; |
| randalthor | 1:58e743c70bed | 420 | |
| randalthor | 1:58e743c70bed | 421 | } |
| randalthor | 1:58e743c70bed | 422 | #endif |
