ros melodic library with custom message
Dependents: Robot_team1_QEI_Douglas Robot_team1
ros_lib/gazebo_msgs/ODEJointProperties.h@0:020db18a476d, 2019-10-30 (annotated)
- Committer:
- scarter1
- Date:
- Wed Oct 30 14:59:49 2019 +0000
- Revision:
- 0:020db18a476d
melodic library;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
scarter1 | 0:020db18a476d | 1 | #ifndef _ROS_gazebo_msgs_ODEJointProperties_h |
scarter1 | 0:020db18a476d | 2 | #define _ROS_gazebo_msgs_ODEJointProperties_h |
scarter1 | 0:020db18a476d | 3 | |
scarter1 | 0:020db18a476d | 4 | #include <stdint.h> |
scarter1 | 0:020db18a476d | 5 | #include <string.h> |
scarter1 | 0:020db18a476d | 6 | #include <stdlib.h> |
scarter1 | 0:020db18a476d | 7 | #include "ros/msg.h" |
scarter1 | 0:020db18a476d | 8 | |
scarter1 | 0:020db18a476d | 9 | namespace gazebo_msgs |
scarter1 | 0:020db18a476d | 10 | { |
scarter1 | 0:020db18a476d | 11 | |
scarter1 | 0:020db18a476d | 12 | class ODEJointProperties : public ros::Msg |
scarter1 | 0:020db18a476d | 13 | { |
scarter1 | 0:020db18a476d | 14 | public: |
scarter1 | 0:020db18a476d | 15 | uint32_t damping_length; |
scarter1 | 0:020db18a476d | 16 | typedef double _damping_type; |
scarter1 | 0:020db18a476d | 17 | _damping_type st_damping; |
scarter1 | 0:020db18a476d | 18 | _damping_type * damping; |
scarter1 | 0:020db18a476d | 19 | uint32_t hiStop_length; |
scarter1 | 0:020db18a476d | 20 | typedef double _hiStop_type; |
scarter1 | 0:020db18a476d | 21 | _hiStop_type st_hiStop; |
scarter1 | 0:020db18a476d | 22 | _hiStop_type * hiStop; |
scarter1 | 0:020db18a476d | 23 | uint32_t loStop_length; |
scarter1 | 0:020db18a476d | 24 | typedef double _loStop_type; |
scarter1 | 0:020db18a476d | 25 | _loStop_type st_loStop; |
scarter1 | 0:020db18a476d | 26 | _loStop_type * loStop; |
scarter1 | 0:020db18a476d | 27 | uint32_t erp_length; |
scarter1 | 0:020db18a476d | 28 | typedef double _erp_type; |
scarter1 | 0:020db18a476d | 29 | _erp_type st_erp; |
scarter1 | 0:020db18a476d | 30 | _erp_type * erp; |
scarter1 | 0:020db18a476d | 31 | uint32_t cfm_length; |
scarter1 | 0:020db18a476d | 32 | typedef double _cfm_type; |
scarter1 | 0:020db18a476d | 33 | _cfm_type st_cfm; |
scarter1 | 0:020db18a476d | 34 | _cfm_type * cfm; |
scarter1 | 0:020db18a476d | 35 | uint32_t stop_erp_length; |
scarter1 | 0:020db18a476d | 36 | typedef double _stop_erp_type; |
scarter1 | 0:020db18a476d | 37 | _stop_erp_type st_stop_erp; |
scarter1 | 0:020db18a476d | 38 | _stop_erp_type * stop_erp; |
scarter1 | 0:020db18a476d | 39 | uint32_t stop_cfm_length; |
scarter1 | 0:020db18a476d | 40 | typedef double _stop_cfm_type; |
scarter1 | 0:020db18a476d | 41 | _stop_cfm_type st_stop_cfm; |
scarter1 | 0:020db18a476d | 42 | _stop_cfm_type * stop_cfm; |
scarter1 | 0:020db18a476d | 43 | uint32_t fudge_factor_length; |
scarter1 | 0:020db18a476d | 44 | typedef double _fudge_factor_type; |
scarter1 | 0:020db18a476d | 45 | _fudge_factor_type st_fudge_factor; |
scarter1 | 0:020db18a476d | 46 | _fudge_factor_type * fudge_factor; |
scarter1 | 0:020db18a476d | 47 | uint32_t fmax_length; |
scarter1 | 0:020db18a476d | 48 | typedef double _fmax_type; |
scarter1 | 0:020db18a476d | 49 | _fmax_type st_fmax; |
scarter1 | 0:020db18a476d | 50 | _fmax_type * fmax; |
scarter1 | 0:020db18a476d | 51 | uint32_t vel_length; |
scarter1 | 0:020db18a476d | 52 | typedef double _vel_type; |
scarter1 | 0:020db18a476d | 53 | _vel_type st_vel; |
scarter1 | 0:020db18a476d | 54 | _vel_type * vel; |
scarter1 | 0:020db18a476d | 55 | |
scarter1 | 0:020db18a476d | 56 | ODEJointProperties(): |
scarter1 | 0:020db18a476d | 57 | damping_length(0), damping(NULL), |
scarter1 | 0:020db18a476d | 58 | hiStop_length(0), hiStop(NULL), |
scarter1 | 0:020db18a476d | 59 | loStop_length(0), loStop(NULL), |
scarter1 | 0:020db18a476d | 60 | erp_length(0), erp(NULL), |
scarter1 | 0:020db18a476d | 61 | cfm_length(0), cfm(NULL), |
scarter1 | 0:020db18a476d | 62 | stop_erp_length(0), stop_erp(NULL), |
scarter1 | 0:020db18a476d | 63 | stop_cfm_length(0), stop_cfm(NULL), |
scarter1 | 0:020db18a476d | 64 | fudge_factor_length(0), fudge_factor(NULL), |
scarter1 | 0:020db18a476d | 65 | fmax_length(0), fmax(NULL), |
scarter1 | 0:020db18a476d | 66 | vel_length(0), vel(NULL) |
scarter1 | 0:020db18a476d | 67 | { |
scarter1 | 0:020db18a476d | 68 | } |
scarter1 | 0:020db18a476d | 69 | |
scarter1 | 0:020db18a476d | 70 | virtual int serialize(unsigned char *outbuffer) const |
scarter1 | 0:020db18a476d | 71 | { |
scarter1 | 0:020db18a476d | 72 | int offset = 0; |
scarter1 | 0:020db18a476d | 73 | *(outbuffer + offset + 0) = (this->damping_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 74 | *(outbuffer + offset + 1) = (this->damping_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 75 | *(outbuffer + offset + 2) = (this->damping_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 76 | *(outbuffer + offset + 3) = (this->damping_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 77 | offset += sizeof(this->damping_length); |
scarter1 | 0:020db18a476d | 78 | for( uint32_t i = 0; i < damping_length; i++){ |
scarter1 | 0:020db18a476d | 79 | union { |
scarter1 | 0:020db18a476d | 80 | double real; |
scarter1 | 0:020db18a476d | 81 | uint64_t base; |
scarter1 | 0:020db18a476d | 82 | } u_dampingi; |
scarter1 | 0:020db18a476d | 83 | u_dampingi.real = this->damping[i]; |
scarter1 | 0:020db18a476d | 84 | *(outbuffer + offset + 0) = (u_dampingi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 85 | *(outbuffer + offset + 1) = (u_dampingi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 86 | *(outbuffer + offset + 2) = (u_dampingi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 87 | *(outbuffer + offset + 3) = (u_dampingi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 88 | *(outbuffer + offset + 4) = (u_dampingi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 89 | *(outbuffer + offset + 5) = (u_dampingi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 90 | *(outbuffer + offset + 6) = (u_dampingi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 91 | *(outbuffer + offset + 7) = (u_dampingi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 92 | offset += sizeof(this->damping[i]); |
scarter1 | 0:020db18a476d | 93 | } |
scarter1 | 0:020db18a476d | 94 | *(outbuffer + offset + 0) = (this->hiStop_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 95 | *(outbuffer + offset + 1) = (this->hiStop_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 96 | *(outbuffer + offset + 2) = (this->hiStop_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 97 | *(outbuffer + offset + 3) = (this->hiStop_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 98 | offset += sizeof(this->hiStop_length); |
scarter1 | 0:020db18a476d | 99 | for( uint32_t i = 0; i < hiStop_length; i++){ |
scarter1 | 0:020db18a476d | 100 | union { |
scarter1 | 0:020db18a476d | 101 | double real; |
scarter1 | 0:020db18a476d | 102 | uint64_t base; |
scarter1 | 0:020db18a476d | 103 | } u_hiStopi; |
scarter1 | 0:020db18a476d | 104 | u_hiStopi.real = this->hiStop[i]; |
scarter1 | 0:020db18a476d | 105 | *(outbuffer + offset + 0) = (u_hiStopi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 106 | *(outbuffer + offset + 1) = (u_hiStopi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 107 | *(outbuffer + offset + 2) = (u_hiStopi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 108 | *(outbuffer + offset + 3) = (u_hiStopi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 109 | *(outbuffer + offset + 4) = (u_hiStopi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 110 | *(outbuffer + offset + 5) = (u_hiStopi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 111 | *(outbuffer + offset + 6) = (u_hiStopi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 112 | *(outbuffer + offset + 7) = (u_hiStopi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 113 | offset += sizeof(this->hiStop[i]); |
scarter1 | 0:020db18a476d | 114 | } |
scarter1 | 0:020db18a476d | 115 | *(outbuffer + offset + 0) = (this->loStop_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 116 | *(outbuffer + offset + 1) = (this->loStop_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 117 | *(outbuffer + offset + 2) = (this->loStop_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 118 | *(outbuffer + offset + 3) = (this->loStop_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 119 | offset += sizeof(this->loStop_length); |
scarter1 | 0:020db18a476d | 120 | for( uint32_t i = 0; i < loStop_length; i++){ |
scarter1 | 0:020db18a476d | 121 | union { |
scarter1 | 0:020db18a476d | 122 | double real; |
scarter1 | 0:020db18a476d | 123 | uint64_t base; |
scarter1 | 0:020db18a476d | 124 | } u_loStopi; |
scarter1 | 0:020db18a476d | 125 | u_loStopi.real = this->loStop[i]; |
scarter1 | 0:020db18a476d | 126 | *(outbuffer + offset + 0) = (u_loStopi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 127 | *(outbuffer + offset + 1) = (u_loStopi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 128 | *(outbuffer + offset + 2) = (u_loStopi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 129 | *(outbuffer + offset + 3) = (u_loStopi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 130 | *(outbuffer + offset + 4) = (u_loStopi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 131 | *(outbuffer + offset + 5) = (u_loStopi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 132 | *(outbuffer + offset + 6) = (u_loStopi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 133 | *(outbuffer + offset + 7) = (u_loStopi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 134 | offset += sizeof(this->loStop[i]); |
scarter1 | 0:020db18a476d | 135 | } |
scarter1 | 0:020db18a476d | 136 | *(outbuffer + offset + 0) = (this->erp_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 137 | *(outbuffer + offset + 1) = (this->erp_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 138 | *(outbuffer + offset + 2) = (this->erp_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 139 | *(outbuffer + offset + 3) = (this->erp_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 140 | offset += sizeof(this->erp_length); |
scarter1 | 0:020db18a476d | 141 | for( uint32_t i = 0; i < erp_length; i++){ |
scarter1 | 0:020db18a476d | 142 | union { |
scarter1 | 0:020db18a476d | 143 | double real; |
scarter1 | 0:020db18a476d | 144 | uint64_t base; |
scarter1 | 0:020db18a476d | 145 | } u_erpi; |
scarter1 | 0:020db18a476d | 146 | u_erpi.real = this->erp[i]; |
scarter1 | 0:020db18a476d | 147 | *(outbuffer + offset + 0) = (u_erpi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 148 | *(outbuffer + offset + 1) = (u_erpi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 149 | *(outbuffer + offset + 2) = (u_erpi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 150 | *(outbuffer + offset + 3) = (u_erpi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 151 | *(outbuffer + offset + 4) = (u_erpi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 152 | *(outbuffer + offset + 5) = (u_erpi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 153 | *(outbuffer + offset + 6) = (u_erpi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 154 | *(outbuffer + offset + 7) = (u_erpi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 155 | offset += sizeof(this->erp[i]); |
scarter1 | 0:020db18a476d | 156 | } |
scarter1 | 0:020db18a476d | 157 | *(outbuffer + offset + 0) = (this->cfm_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 158 | *(outbuffer + offset + 1) = (this->cfm_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 159 | *(outbuffer + offset + 2) = (this->cfm_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 160 | *(outbuffer + offset + 3) = (this->cfm_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 161 | offset += sizeof(this->cfm_length); |
scarter1 | 0:020db18a476d | 162 | for( uint32_t i = 0; i < cfm_length; i++){ |
scarter1 | 0:020db18a476d | 163 | union { |
scarter1 | 0:020db18a476d | 164 | double real; |
scarter1 | 0:020db18a476d | 165 | uint64_t base; |
scarter1 | 0:020db18a476d | 166 | } u_cfmi; |
scarter1 | 0:020db18a476d | 167 | u_cfmi.real = this->cfm[i]; |
scarter1 | 0:020db18a476d | 168 | *(outbuffer + offset + 0) = (u_cfmi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 169 | *(outbuffer + offset + 1) = (u_cfmi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 170 | *(outbuffer + offset + 2) = (u_cfmi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 171 | *(outbuffer + offset + 3) = (u_cfmi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 172 | *(outbuffer + offset + 4) = (u_cfmi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 173 | *(outbuffer + offset + 5) = (u_cfmi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 174 | *(outbuffer + offset + 6) = (u_cfmi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 175 | *(outbuffer + offset + 7) = (u_cfmi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 176 | offset += sizeof(this->cfm[i]); |
scarter1 | 0:020db18a476d | 177 | } |
scarter1 | 0:020db18a476d | 178 | *(outbuffer + offset + 0) = (this->stop_erp_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 179 | *(outbuffer + offset + 1) = (this->stop_erp_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 180 | *(outbuffer + offset + 2) = (this->stop_erp_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 181 | *(outbuffer + offset + 3) = (this->stop_erp_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 182 | offset += sizeof(this->stop_erp_length); |
scarter1 | 0:020db18a476d | 183 | for( uint32_t i = 0; i < stop_erp_length; i++){ |
scarter1 | 0:020db18a476d | 184 | union { |
scarter1 | 0:020db18a476d | 185 | double real; |
scarter1 | 0:020db18a476d | 186 | uint64_t base; |
scarter1 | 0:020db18a476d | 187 | } u_stop_erpi; |
scarter1 | 0:020db18a476d | 188 | u_stop_erpi.real = this->stop_erp[i]; |
scarter1 | 0:020db18a476d | 189 | *(outbuffer + offset + 0) = (u_stop_erpi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 190 | *(outbuffer + offset + 1) = (u_stop_erpi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 191 | *(outbuffer + offset + 2) = (u_stop_erpi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 192 | *(outbuffer + offset + 3) = (u_stop_erpi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 193 | *(outbuffer + offset + 4) = (u_stop_erpi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 194 | *(outbuffer + offset + 5) = (u_stop_erpi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 195 | *(outbuffer + offset + 6) = (u_stop_erpi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 196 | *(outbuffer + offset + 7) = (u_stop_erpi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 197 | offset += sizeof(this->stop_erp[i]); |
scarter1 | 0:020db18a476d | 198 | } |
scarter1 | 0:020db18a476d | 199 | *(outbuffer + offset + 0) = (this->stop_cfm_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 200 | *(outbuffer + offset + 1) = (this->stop_cfm_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 201 | *(outbuffer + offset + 2) = (this->stop_cfm_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 202 | *(outbuffer + offset + 3) = (this->stop_cfm_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 203 | offset += sizeof(this->stop_cfm_length); |
scarter1 | 0:020db18a476d | 204 | for( uint32_t i = 0; i < stop_cfm_length; i++){ |
scarter1 | 0:020db18a476d | 205 | union { |
scarter1 | 0:020db18a476d | 206 | double real; |
scarter1 | 0:020db18a476d | 207 | uint64_t base; |
scarter1 | 0:020db18a476d | 208 | } u_stop_cfmi; |
scarter1 | 0:020db18a476d | 209 | u_stop_cfmi.real = this->stop_cfm[i]; |
scarter1 | 0:020db18a476d | 210 | *(outbuffer + offset + 0) = (u_stop_cfmi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 211 | *(outbuffer + offset + 1) = (u_stop_cfmi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 212 | *(outbuffer + offset + 2) = (u_stop_cfmi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 213 | *(outbuffer + offset + 3) = (u_stop_cfmi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 214 | *(outbuffer + offset + 4) = (u_stop_cfmi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 215 | *(outbuffer + offset + 5) = (u_stop_cfmi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 216 | *(outbuffer + offset + 6) = (u_stop_cfmi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 217 | *(outbuffer + offset + 7) = (u_stop_cfmi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 218 | offset += sizeof(this->stop_cfm[i]); |
scarter1 | 0:020db18a476d | 219 | } |
scarter1 | 0:020db18a476d | 220 | *(outbuffer + offset + 0) = (this->fudge_factor_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 221 | *(outbuffer + offset + 1) = (this->fudge_factor_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 222 | *(outbuffer + offset + 2) = (this->fudge_factor_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 223 | *(outbuffer + offset + 3) = (this->fudge_factor_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 224 | offset += sizeof(this->fudge_factor_length); |
scarter1 | 0:020db18a476d | 225 | for( uint32_t i = 0; i < fudge_factor_length; i++){ |
scarter1 | 0:020db18a476d | 226 | union { |
scarter1 | 0:020db18a476d | 227 | double real; |
scarter1 | 0:020db18a476d | 228 | uint64_t base; |
scarter1 | 0:020db18a476d | 229 | } u_fudge_factori; |
scarter1 | 0:020db18a476d | 230 | u_fudge_factori.real = this->fudge_factor[i]; |
scarter1 | 0:020db18a476d | 231 | *(outbuffer + offset + 0) = (u_fudge_factori.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 232 | *(outbuffer + offset + 1) = (u_fudge_factori.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 233 | *(outbuffer + offset + 2) = (u_fudge_factori.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 234 | *(outbuffer + offset + 3) = (u_fudge_factori.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 235 | *(outbuffer + offset + 4) = (u_fudge_factori.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 236 | *(outbuffer + offset + 5) = (u_fudge_factori.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 237 | *(outbuffer + offset + 6) = (u_fudge_factori.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 238 | *(outbuffer + offset + 7) = (u_fudge_factori.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 239 | offset += sizeof(this->fudge_factor[i]); |
scarter1 | 0:020db18a476d | 240 | } |
scarter1 | 0:020db18a476d | 241 | *(outbuffer + offset + 0) = (this->fmax_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 242 | *(outbuffer + offset + 1) = (this->fmax_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 243 | *(outbuffer + offset + 2) = (this->fmax_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 244 | *(outbuffer + offset + 3) = (this->fmax_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 245 | offset += sizeof(this->fmax_length); |
scarter1 | 0:020db18a476d | 246 | for( uint32_t i = 0; i < fmax_length; i++){ |
scarter1 | 0:020db18a476d | 247 | union { |
scarter1 | 0:020db18a476d | 248 | double real; |
scarter1 | 0:020db18a476d | 249 | uint64_t base; |
scarter1 | 0:020db18a476d | 250 | } u_fmaxi; |
scarter1 | 0:020db18a476d | 251 | u_fmaxi.real = this->fmax[i]; |
scarter1 | 0:020db18a476d | 252 | *(outbuffer + offset + 0) = (u_fmaxi.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 253 | *(outbuffer + offset + 1) = (u_fmaxi.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 254 | *(outbuffer + offset + 2) = (u_fmaxi.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 255 | *(outbuffer + offset + 3) = (u_fmaxi.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 256 | *(outbuffer + offset + 4) = (u_fmaxi.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 257 | *(outbuffer + offset + 5) = (u_fmaxi.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 258 | *(outbuffer + offset + 6) = (u_fmaxi.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 259 | *(outbuffer + offset + 7) = (u_fmaxi.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 260 | offset += sizeof(this->fmax[i]); |
scarter1 | 0:020db18a476d | 261 | } |
scarter1 | 0:020db18a476d | 262 | *(outbuffer + offset + 0) = (this->vel_length >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 263 | *(outbuffer + offset + 1) = (this->vel_length >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 264 | *(outbuffer + offset + 2) = (this->vel_length >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 265 | *(outbuffer + offset + 3) = (this->vel_length >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 266 | offset += sizeof(this->vel_length); |
scarter1 | 0:020db18a476d | 267 | for( uint32_t i = 0; i < vel_length; i++){ |
scarter1 | 0:020db18a476d | 268 | union { |
scarter1 | 0:020db18a476d | 269 | double real; |
scarter1 | 0:020db18a476d | 270 | uint64_t base; |
scarter1 | 0:020db18a476d | 271 | } u_veli; |
scarter1 | 0:020db18a476d | 272 | u_veli.real = this->vel[i]; |
scarter1 | 0:020db18a476d | 273 | *(outbuffer + offset + 0) = (u_veli.base >> (8 * 0)) & 0xFF; |
scarter1 | 0:020db18a476d | 274 | *(outbuffer + offset + 1) = (u_veli.base >> (8 * 1)) & 0xFF; |
scarter1 | 0:020db18a476d | 275 | *(outbuffer + offset + 2) = (u_veli.base >> (8 * 2)) & 0xFF; |
scarter1 | 0:020db18a476d | 276 | *(outbuffer + offset + 3) = (u_veli.base >> (8 * 3)) & 0xFF; |
scarter1 | 0:020db18a476d | 277 | *(outbuffer + offset + 4) = (u_veli.base >> (8 * 4)) & 0xFF; |
scarter1 | 0:020db18a476d | 278 | *(outbuffer + offset + 5) = (u_veli.base >> (8 * 5)) & 0xFF; |
scarter1 | 0:020db18a476d | 279 | *(outbuffer + offset + 6) = (u_veli.base >> (8 * 6)) & 0xFF; |
scarter1 | 0:020db18a476d | 280 | *(outbuffer + offset + 7) = (u_veli.base >> (8 * 7)) & 0xFF; |
scarter1 | 0:020db18a476d | 281 | offset += sizeof(this->vel[i]); |
scarter1 | 0:020db18a476d | 282 | } |
scarter1 | 0:020db18a476d | 283 | return offset; |
scarter1 | 0:020db18a476d | 284 | } |
scarter1 | 0:020db18a476d | 285 | |
scarter1 | 0:020db18a476d | 286 | virtual int deserialize(unsigned char *inbuffer) |
scarter1 | 0:020db18a476d | 287 | { |
scarter1 | 0:020db18a476d | 288 | int offset = 0; |
scarter1 | 0:020db18a476d | 289 | uint32_t damping_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 290 | damping_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 291 | damping_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 292 | damping_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 293 | offset += sizeof(this->damping_length); |
scarter1 | 0:020db18a476d | 294 | if(damping_lengthT > damping_length) |
scarter1 | 0:020db18a476d | 295 | this->damping = (double*)realloc(this->damping, damping_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 296 | damping_length = damping_lengthT; |
scarter1 | 0:020db18a476d | 297 | for( uint32_t i = 0; i < damping_length; i++){ |
scarter1 | 0:020db18a476d | 298 | union { |
scarter1 | 0:020db18a476d | 299 | double real; |
scarter1 | 0:020db18a476d | 300 | uint64_t base; |
scarter1 | 0:020db18a476d | 301 | } u_st_damping; |
scarter1 | 0:020db18a476d | 302 | u_st_damping.base = 0; |
scarter1 | 0:020db18a476d | 303 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 304 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 305 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 306 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 307 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 308 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 309 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 310 | u_st_damping.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 311 | this->st_damping = u_st_damping.real; |
scarter1 | 0:020db18a476d | 312 | offset += sizeof(this->st_damping); |
scarter1 | 0:020db18a476d | 313 | memcpy( &(this->damping[i]), &(this->st_damping), sizeof(double)); |
scarter1 | 0:020db18a476d | 314 | } |
scarter1 | 0:020db18a476d | 315 | uint32_t hiStop_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 316 | hiStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 317 | hiStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 318 | hiStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 319 | offset += sizeof(this->hiStop_length); |
scarter1 | 0:020db18a476d | 320 | if(hiStop_lengthT > hiStop_length) |
scarter1 | 0:020db18a476d | 321 | this->hiStop = (double*)realloc(this->hiStop, hiStop_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 322 | hiStop_length = hiStop_lengthT; |
scarter1 | 0:020db18a476d | 323 | for( uint32_t i = 0; i < hiStop_length; i++){ |
scarter1 | 0:020db18a476d | 324 | union { |
scarter1 | 0:020db18a476d | 325 | double real; |
scarter1 | 0:020db18a476d | 326 | uint64_t base; |
scarter1 | 0:020db18a476d | 327 | } u_st_hiStop; |
scarter1 | 0:020db18a476d | 328 | u_st_hiStop.base = 0; |
scarter1 | 0:020db18a476d | 329 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 330 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 331 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 332 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 333 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 334 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 335 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 336 | u_st_hiStop.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 337 | this->st_hiStop = u_st_hiStop.real; |
scarter1 | 0:020db18a476d | 338 | offset += sizeof(this->st_hiStop); |
scarter1 | 0:020db18a476d | 339 | memcpy( &(this->hiStop[i]), &(this->st_hiStop), sizeof(double)); |
scarter1 | 0:020db18a476d | 340 | } |
scarter1 | 0:020db18a476d | 341 | uint32_t loStop_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 342 | loStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 343 | loStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 344 | loStop_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 345 | offset += sizeof(this->loStop_length); |
scarter1 | 0:020db18a476d | 346 | if(loStop_lengthT > loStop_length) |
scarter1 | 0:020db18a476d | 347 | this->loStop = (double*)realloc(this->loStop, loStop_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 348 | loStop_length = loStop_lengthT; |
scarter1 | 0:020db18a476d | 349 | for( uint32_t i = 0; i < loStop_length; i++){ |
scarter1 | 0:020db18a476d | 350 | union { |
scarter1 | 0:020db18a476d | 351 | double real; |
scarter1 | 0:020db18a476d | 352 | uint64_t base; |
scarter1 | 0:020db18a476d | 353 | } u_st_loStop; |
scarter1 | 0:020db18a476d | 354 | u_st_loStop.base = 0; |
scarter1 | 0:020db18a476d | 355 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 356 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 357 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 358 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 359 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 360 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 361 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 362 | u_st_loStop.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 363 | this->st_loStop = u_st_loStop.real; |
scarter1 | 0:020db18a476d | 364 | offset += sizeof(this->st_loStop); |
scarter1 | 0:020db18a476d | 365 | memcpy( &(this->loStop[i]), &(this->st_loStop), sizeof(double)); |
scarter1 | 0:020db18a476d | 366 | } |
scarter1 | 0:020db18a476d | 367 | uint32_t erp_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 368 | erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 369 | erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 370 | erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 371 | offset += sizeof(this->erp_length); |
scarter1 | 0:020db18a476d | 372 | if(erp_lengthT > erp_length) |
scarter1 | 0:020db18a476d | 373 | this->erp = (double*)realloc(this->erp, erp_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 374 | erp_length = erp_lengthT; |
scarter1 | 0:020db18a476d | 375 | for( uint32_t i = 0; i < erp_length; i++){ |
scarter1 | 0:020db18a476d | 376 | union { |
scarter1 | 0:020db18a476d | 377 | double real; |
scarter1 | 0:020db18a476d | 378 | uint64_t base; |
scarter1 | 0:020db18a476d | 379 | } u_st_erp; |
scarter1 | 0:020db18a476d | 380 | u_st_erp.base = 0; |
scarter1 | 0:020db18a476d | 381 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 382 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 383 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 384 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 385 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 386 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 387 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 388 | u_st_erp.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 389 | this->st_erp = u_st_erp.real; |
scarter1 | 0:020db18a476d | 390 | offset += sizeof(this->st_erp); |
scarter1 | 0:020db18a476d | 391 | memcpy( &(this->erp[i]), &(this->st_erp), sizeof(double)); |
scarter1 | 0:020db18a476d | 392 | } |
scarter1 | 0:020db18a476d | 393 | uint32_t cfm_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 394 | cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 395 | cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 396 | cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 397 | offset += sizeof(this->cfm_length); |
scarter1 | 0:020db18a476d | 398 | if(cfm_lengthT > cfm_length) |
scarter1 | 0:020db18a476d | 399 | this->cfm = (double*)realloc(this->cfm, cfm_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 400 | cfm_length = cfm_lengthT; |
scarter1 | 0:020db18a476d | 401 | for( uint32_t i = 0; i < cfm_length; i++){ |
scarter1 | 0:020db18a476d | 402 | union { |
scarter1 | 0:020db18a476d | 403 | double real; |
scarter1 | 0:020db18a476d | 404 | uint64_t base; |
scarter1 | 0:020db18a476d | 405 | } u_st_cfm; |
scarter1 | 0:020db18a476d | 406 | u_st_cfm.base = 0; |
scarter1 | 0:020db18a476d | 407 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 408 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 409 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 410 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 411 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 412 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 413 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 414 | u_st_cfm.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 415 | this->st_cfm = u_st_cfm.real; |
scarter1 | 0:020db18a476d | 416 | offset += sizeof(this->st_cfm); |
scarter1 | 0:020db18a476d | 417 | memcpy( &(this->cfm[i]), &(this->st_cfm), sizeof(double)); |
scarter1 | 0:020db18a476d | 418 | } |
scarter1 | 0:020db18a476d | 419 | uint32_t stop_erp_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 420 | stop_erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 421 | stop_erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 422 | stop_erp_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 423 | offset += sizeof(this->stop_erp_length); |
scarter1 | 0:020db18a476d | 424 | if(stop_erp_lengthT > stop_erp_length) |
scarter1 | 0:020db18a476d | 425 | this->stop_erp = (double*)realloc(this->stop_erp, stop_erp_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 426 | stop_erp_length = stop_erp_lengthT; |
scarter1 | 0:020db18a476d | 427 | for( uint32_t i = 0; i < stop_erp_length; i++){ |
scarter1 | 0:020db18a476d | 428 | union { |
scarter1 | 0:020db18a476d | 429 | double real; |
scarter1 | 0:020db18a476d | 430 | uint64_t base; |
scarter1 | 0:020db18a476d | 431 | } u_st_stop_erp; |
scarter1 | 0:020db18a476d | 432 | u_st_stop_erp.base = 0; |
scarter1 | 0:020db18a476d | 433 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 434 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 435 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 436 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 437 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 438 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 439 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 440 | u_st_stop_erp.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 441 | this->st_stop_erp = u_st_stop_erp.real; |
scarter1 | 0:020db18a476d | 442 | offset += sizeof(this->st_stop_erp); |
scarter1 | 0:020db18a476d | 443 | memcpy( &(this->stop_erp[i]), &(this->st_stop_erp), sizeof(double)); |
scarter1 | 0:020db18a476d | 444 | } |
scarter1 | 0:020db18a476d | 445 | uint32_t stop_cfm_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 446 | stop_cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 447 | stop_cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 448 | stop_cfm_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 449 | offset += sizeof(this->stop_cfm_length); |
scarter1 | 0:020db18a476d | 450 | if(stop_cfm_lengthT > stop_cfm_length) |
scarter1 | 0:020db18a476d | 451 | this->stop_cfm = (double*)realloc(this->stop_cfm, stop_cfm_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 452 | stop_cfm_length = stop_cfm_lengthT; |
scarter1 | 0:020db18a476d | 453 | for( uint32_t i = 0; i < stop_cfm_length; i++){ |
scarter1 | 0:020db18a476d | 454 | union { |
scarter1 | 0:020db18a476d | 455 | double real; |
scarter1 | 0:020db18a476d | 456 | uint64_t base; |
scarter1 | 0:020db18a476d | 457 | } u_st_stop_cfm; |
scarter1 | 0:020db18a476d | 458 | u_st_stop_cfm.base = 0; |
scarter1 | 0:020db18a476d | 459 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 460 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 461 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 462 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 463 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 464 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 465 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 466 | u_st_stop_cfm.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 467 | this->st_stop_cfm = u_st_stop_cfm.real; |
scarter1 | 0:020db18a476d | 468 | offset += sizeof(this->st_stop_cfm); |
scarter1 | 0:020db18a476d | 469 | memcpy( &(this->stop_cfm[i]), &(this->st_stop_cfm), sizeof(double)); |
scarter1 | 0:020db18a476d | 470 | } |
scarter1 | 0:020db18a476d | 471 | uint32_t fudge_factor_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 472 | fudge_factor_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 473 | fudge_factor_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 474 | fudge_factor_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 475 | offset += sizeof(this->fudge_factor_length); |
scarter1 | 0:020db18a476d | 476 | if(fudge_factor_lengthT > fudge_factor_length) |
scarter1 | 0:020db18a476d | 477 | this->fudge_factor = (double*)realloc(this->fudge_factor, fudge_factor_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 478 | fudge_factor_length = fudge_factor_lengthT; |
scarter1 | 0:020db18a476d | 479 | for( uint32_t i = 0; i < fudge_factor_length; i++){ |
scarter1 | 0:020db18a476d | 480 | union { |
scarter1 | 0:020db18a476d | 481 | double real; |
scarter1 | 0:020db18a476d | 482 | uint64_t base; |
scarter1 | 0:020db18a476d | 483 | } u_st_fudge_factor; |
scarter1 | 0:020db18a476d | 484 | u_st_fudge_factor.base = 0; |
scarter1 | 0:020db18a476d | 485 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 486 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 487 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 488 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 489 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 490 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 491 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 492 | u_st_fudge_factor.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 493 | this->st_fudge_factor = u_st_fudge_factor.real; |
scarter1 | 0:020db18a476d | 494 | offset += sizeof(this->st_fudge_factor); |
scarter1 | 0:020db18a476d | 495 | memcpy( &(this->fudge_factor[i]), &(this->st_fudge_factor), sizeof(double)); |
scarter1 | 0:020db18a476d | 496 | } |
scarter1 | 0:020db18a476d | 497 | uint32_t fmax_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 498 | fmax_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 499 | fmax_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 500 | fmax_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 501 | offset += sizeof(this->fmax_length); |
scarter1 | 0:020db18a476d | 502 | if(fmax_lengthT > fmax_length) |
scarter1 | 0:020db18a476d | 503 | this->fmax = (double*)realloc(this->fmax, fmax_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 504 | fmax_length = fmax_lengthT; |
scarter1 | 0:020db18a476d | 505 | for( uint32_t i = 0; i < fmax_length; i++){ |
scarter1 | 0:020db18a476d | 506 | union { |
scarter1 | 0:020db18a476d | 507 | double real; |
scarter1 | 0:020db18a476d | 508 | uint64_t base; |
scarter1 | 0:020db18a476d | 509 | } u_st_fmax; |
scarter1 | 0:020db18a476d | 510 | u_st_fmax.base = 0; |
scarter1 | 0:020db18a476d | 511 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 512 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 513 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 514 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 515 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 516 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 517 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 518 | u_st_fmax.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 519 | this->st_fmax = u_st_fmax.real; |
scarter1 | 0:020db18a476d | 520 | offset += sizeof(this->st_fmax); |
scarter1 | 0:020db18a476d | 521 | memcpy( &(this->fmax[i]), &(this->st_fmax), sizeof(double)); |
scarter1 | 0:020db18a476d | 522 | } |
scarter1 | 0:020db18a476d | 523 | uint32_t vel_lengthT = ((uint32_t) (*(inbuffer + offset))); |
scarter1 | 0:020db18a476d | 524 | vel_lengthT |= ((uint32_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 525 | vel_lengthT |= ((uint32_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 526 | vel_lengthT |= ((uint32_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 527 | offset += sizeof(this->vel_length); |
scarter1 | 0:020db18a476d | 528 | if(vel_lengthT > vel_length) |
scarter1 | 0:020db18a476d | 529 | this->vel = (double*)realloc(this->vel, vel_lengthT * sizeof(double)); |
scarter1 | 0:020db18a476d | 530 | vel_length = vel_lengthT; |
scarter1 | 0:020db18a476d | 531 | for( uint32_t i = 0; i < vel_length; i++){ |
scarter1 | 0:020db18a476d | 532 | union { |
scarter1 | 0:020db18a476d | 533 | double real; |
scarter1 | 0:020db18a476d | 534 | uint64_t base; |
scarter1 | 0:020db18a476d | 535 | } u_st_vel; |
scarter1 | 0:020db18a476d | 536 | u_st_vel.base = 0; |
scarter1 | 0:020db18a476d | 537 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 0))) << (8 * 0); |
scarter1 | 0:020db18a476d | 538 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 1))) << (8 * 1); |
scarter1 | 0:020db18a476d | 539 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 2))) << (8 * 2); |
scarter1 | 0:020db18a476d | 540 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 3))) << (8 * 3); |
scarter1 | 0:020db18a476d | 541 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 4))) << (8 * 4); |
scarter1 | 0:020db18a476d | 542 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 5))) << (8 * 5); |
scarter1 | 0:020db18a476d | 543 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 6))) << (8 * 6); |
scarter1 | 0:020db18a476d | 544 | u_st_vel.base |= ((uint64_t) (*(inbuffer + offset + 7))) << (8 * 7); |
scarter1 | 0:020db18a476d | 545 | this->st_vel = u_st_vel.real; |
scarter1 | 0:020db18a476d | 546 | offset += sizeof(this->st_vel); |
scarter1 | 0:020db18a476d | 547 | memcpy( &(this->vel[i]), &(this->st_vel), sizeof(double)); |
scarter1 | 0:020db18a476d | 548 | } |
scarter1 | 0:020db18a476d | 549 | return offset; |
scarter1 | 0:020db18a476d | 550 | } |
scarter1 | 0:020db18a476d | 551 | |
scarter1 | 0:020db18a476d | 552 | const char * getType(){ return "gazebo_msgs/ODEJointProperties"; }; |
scarter1 | 0:020db18a476d | 553 | const char * getMD5(){ return "1b744c32a920af979f53afe2f9c3511f"; }; |
scarter1 | 0:020db18a476d | 554 | |
scarter1 | 0:020db18a476d | 555 | }; |
scarter1 | 0:020db18a476d | 556 | |
scarter1 | 0:020db18a476d | 557 | } |
scarter1 | 0:020db18a476d | 558 | #endif |