@@ -64,15 +64,10 @@ void Avtp_Can_Init(Avtp_Can_t* pdu)
64
64
{
65
65
if (pdu != NULL ) {
66
66
memset (pdu , 0 , sizeof (Avtp_Can_t ));
67
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_ACF_MSG_TYPE , AVTP_ACF_TYPE_CAN );
67
+ Avtp_Can_SetAcfMsgType (pdu , AVTP_ACF_TYPE_CAN );
68
68
}
69
69
}
70
70
71
- uint64_t Avtp_Can_GetField (Avtp_Can_t * pdu , Avtp_CanFields_t field )
72
- {
73
- return GET_FIELD (field );
74
- }
75
-
76
71
uint8_t Avtp_Can_GetAcfMsgType (Avtp_Can_t * pdu )
77
72
{
78
73
return GET_FIELD (AVTP_CAN_FIELD_ACF_MSG_TYPE );
@@ -133,10 +128,11 @@ uint32_t Avtp_Can_GetCanIdentifier(Avtp_Can_t* pdu)
133
128
return GET_FIELD (AVTP_CAN_FIELD_CAN_IDENTIFIER );
134
129
}
135
130
131
+ /*
136
132
void Avtp_Can_SetField(Avtp_Can_t* pdu, Avtp_CanFields_t field, uint64_t value)
137
133
{
138
134
SET_FIELD(field, value);
139
- }
135
+ }*/
140
136
141
137
void Avtp_Can_SetAcfMsgType (Avtp_Can_t * pdu , uint8_t value )
142
138
{
@@ -153,58 +149,64 @@ void Avtp_Can_SetPad(Avtp_Can_t* pdu, uint8_t value)
153
149
SET_FIELD (AVTP_CAN_FIELD_PAD , value );
154
150
}
155
151
156
- void Avtp_Can_SetMtv (Avtp_Can_t * pdu , uint64_t value )
152
+ void Avtp_Can_EnableMtv (Avtp_Can_t * pdu )
157
153
{
158
- if (value ) {
159
- SET_FIELD (AVTP_CAN_FIELD_MTV , 1 );
160
- } else {
161
- SET_FIELD (AVTP_CAN_FIELD_MTV , 0 );
162
- }
154
+ SET_FIELD (AVTP_CAN_FIELD_MTV , 1 );
163
155
}
164
156
165
- void Avtp_Can_SetRtr (Avtp_Can_t * pdu , uint32_t value )
157
+ void Avtp_Can_DisableMtv (Avtp_Can_t * pdu )
166
158
{
167
- if (value ) {
168
- SET_FIELD (AVTP_CAN_FIELD_RTR , 1 );
169
- } else {
170
- SET_FIELD (AVTP_CAN_FIELD_RTR , 0 );
171
- }
159
+ SET_FIELD (AVTP_CAN_FIELD_MTV , 0 );
172
160
}
173
161
174
- void Avtp_Can_SetEff (Avtp_Can_t * pdu , uint32_t value )
162
+ void Avtp_Can_EnableRtr (Avtp_Can_t * pdu )
175
163
{
176
- if (value ) {
177
- SET_FIELD (AVTP_CAN_FIELD_EFF , 1 );
178
- } else {
179
- SET_FIELD (AVTP_CAN_FIELD_EFF , 0 );
180
- }
164
+ SET_FIELD (AVTP_CAN_FIELD_RTR , 1 );
181
165
}
182
166
183
- void Avtp_Can_SetBrs (Avtp_Can_t * pdu , uint8_t value )
167
+ void Avtp_Can_DisableRtr (Avtp_Can_t * pdu )
184
168
{
185
- if (value ) {
186
- SET_FIELD (AVTP_CAN_FIELD_BRS , 1 );
187
- } else {
188
- SET_FIELD (AVTP_CAN_FIELD_BRS , 0 );
189
- }
169
+ SET_FIELD (AVTP_CAN_FIELD_RTR , 0 );
190
170
}
191
171
192
- void Avtp_Can_SetFdf (Avtp_Can_t * pdu , uint8_t value )
172
+ void Avtp_Can_EnableEff (Avtp_Can_t * pdu )
193
173
{
194
- if (value ) {
195
- SET_FIELD (AVTP_CAN_FIELD_FDF , 1 );
196
- } else {
197
- SET_FIELD (AVTP_CAN_FIELD_FDF , 0 );
198
- }
174
+ SET_FIELD (AVTP_CAN_FIELD_EFF , 1 );
199
175
}
200
176
201
- void Avtp_Can_SetEsi (Avtp_Can_t * pdu , uint8_t value )
177
+ void Avtp_Can_DisableEff (Avtp_Can_t * pdu )
202
178
{
203
- if (value ) {
204
- SET_FIELD (AVTP_CAN_FIELD_ESI , 1 );
205
- } else {
206
- SET_FIELD (AVTP_CAN_FIELD_ESI , 0 );
207
- }
179
+ SET_FIELD (AVTP_CAN_FIELD_EFF , 0 );
180
+ }
181
+
182
+ void Avtp_Can_EnableBrs (Avtp_Can_t * pdu )
183
+ {
184
+ SET_FIELD (AVTP_CAN_FIELD_BRS , 1 );
185
+ }
186
+
187
+ void Avtp_Can_DisableBrs (Avtp_Can_t * pdu )
188
+ {
189
+ SET_FIELD (AVTP_CAN_FIELD_BRS , 0 );
190
+ }
191
+
192
+ void Avtp_Can_EnableFdf (Avtp_Can_t * pdu )
193
+ {
194
+ SET_FIELD (AVTP_CAN_FIELD_FDF , 1 );
195
+ }
196
+
197
+ void Avtp_Can_DisableFdf (Avtp_Can_t * pdu )
198
+ {
199
+ SET_FIELD (AVTP_CAN_FIELD_FDF , 0 );
200
+ }
201
+
202
+ void Avtp_Can_EnableEsi (Avtp_Can_t * pdu )
203
+ {
204
+ SET_FIELD (AVTP_CAN_FIELD_ESI , 1 );
205
+ }
206
+
207
+ void Avtp_Can_DisableEsi (Avtp_Can_t * pdu )
208
+ {
209
+ SET_FIELD (AVTP_CAN_FIELD_ESI , 0 );
208
210
}
209
211
210
212
void Avtp_Can_SetCanBusId (Avtp_Can_t * pdu , uint8_t value )
@@ -229,10 +231,14 @@ void Avtp_Can_CreateAcfMessage(Avtp_Can_t* pdu, uint32_t frame_id, uint8_t* payl
229
231
Avtp_Can_SetPayload (pdu , payload , payload_length );
230
232
231
233
// Set the Frame ID and CAN variant
232
- int eff = frame_id > 0x7ff ? 1 : 0 ;
233
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_EFF , eff );
234
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_CAN_IDENTIFIER , frame_id );
235
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_FDF , (uint8_t ) can_variant );
234
+ if (frame_id > 0x7ff ) {
235
+ Avtp_Can_EnableEff (pdu );
236
+ }
237
+
238
+ Avtp_Can_SetCanIdentifier (pdu , frame_id );
239
+ if (can_variant == AVTP_CAN_FD ) {
240
+ Avtp_Can_EnableFdf (pdu );
241
+ }
236
242
237
243
// Finalize the AVTP CAN Frame
238
244
Avtp_Can_Finalize (pdu , payload_length );
@@ -251,8 +257,8 @@ void Avtp_Can_Finalize(Avtp_Can_t* pdu, uint16_t payload_length)
251
257
}
252
258
253
259
// Set the length and padding fields
254
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_ACF_MSG_LENGTH , ( uint64_t ) avtpCanLength /AVTP_QUADLET_SIZE );
255
- Avtp_Can_SetField (pdu , AVTP_CAN_FIELD_PAD , padSize );
260
+ Avtp_Can_SetAcfMsgLength (pdu , ( uint16_t ) avtpCanLength /AVTP_QUADLET_SIZE );
261
+ Avtp_Can_SetPad (pdu , padSize );
256
262
}
257
263
258
264
void Avtp_Can_SetPayload (Avtp_Can_t * pdu , uint8_t * payload ,
0 commit comments