Browse Source

Fix endian DGUS WriteVariable (#18703)

yufanyufan 3 years ago
parent
commit
1c94033f7c
No account linked to committer's email address

+ 21
- 0
Marlin/src/lcd/extui/lib/dgus/DGUSDisplay.cpp View File

@@ -94,9 +94,30 @@ void DGUSDisplay::WriteVariable(uint16_t adr, const void* values, uint8_t values
94 94
 }
95 95
 
96 96
 void DGUSDisplay::WriteVariable(uint16_t adr, uint16_t value) {
97
+  value = (value & 0xffU) << 8U | (value >> 8U);
97 98
   WriteVariable(adr, static_cast<const void*>(&value), sizeof(uint16_t));
98 99
 }
99 100
 
101
+void DGUSDisplay::WriteVariable(uint16_t adr, int16_t value) {
102
+  value = (value & 0xffU) << 8U | (value >> 8U);
103
+  WriteVariable(adr, static_cast<const void*>(&value), sizeof(uint16_t));
104
+}
105
+
106
+void DGUSDisplay::WriteVariable(uint16_t adr, uint8_t value) {
107
+  WriteVariable(adr, static_cast<const void*>(&value), sizeof(uint8_t));
108
+}
109
+
110
+void DGUSDisplay::WriteVariable(uint16_t adr, long value) {
111
+    union { long l; char lb[4]; } endian;
112
+    char tmp[4];
113
+    endian.l = value;
114
+    tmp[0] = endian.lb[3];
115
+    tmp[1] = endian.lb[2];
116
+    tmp[2] = endian.lb[1];
117
+    tmp[3] = endian.lb[0];
118
+    WriteVariable(adr, static_cast<const void*>(&tmp), sizeof(long));
119
+}
120
+
100 121
 void DGUSDisplay::WriteVariablePGM(uint16_t adr, const void* values, uint8_t valueslen, bool isstr) {
101 122
   const char* myvalues = static_cast<const char*>(values);
102 123
   bool strend = !myvalues;

+ 3
- 0
Marlin/src/lcd/extui/lib/dgus/DGUSDisplay.h View File

@@ -54,7 +54,10 @@ public:
54 54
   // Variable access.
55 55
   static void WriteVariable(uint16_t adr, const void* values, uint8_t valueslen, bool isstr=false);
56 56
   static void WriteVariablePGM(uint16_t adr, const void* values, uint8_t valueslen, bool isstr=false);
57
+  static void WriteVariable(uint16_t adr, int16_t value);
57 58
   static void WriteVariable(uint16_t adr, uint16_t value);
59
+  static void WriteVariable(uint16_t adr, uint8_t value);
60
+  static void WriteVariable(uint16_t adr, long value);
58 61
 
59 62
   // Until now I did not need to actively read from the display. That's why there is no ReadVariable
60 63
   // (I extensively use the auto upload of the display)

+ 7
- 11
Marlin/src/lcd/extui/lib/dgus/DGUSScreenHandler.cpp View File

@@ -118,10 +118,10 @@ void DGUSScreenHandler::DGUSLCD_SendWordValueToDisplay(DGUS_VP_Variable &var) {
118 118
   if (var.memadr) {
119 119
     //DEBUG_ECHOPAIR(" DGUS_LCD_SendWordValueToDisplay ", var.VP);
120 120
     //DEBUG_ECHOLNPAIR(" data ", *(uint16_t *)var.memadr);
121
-    uint8_t *tmp = (uint8_t *) var.memadr;
122
-    uint16_t data_to_send = (tmp[0] << 8);
123
-    if (var.size >= 1) data_to_send |= tmp[1];
124
-    dgusdisplay.WriteVariable(var.VP, data_to_send);
121
+    if (var.size > 1)
122
+      dgusdisplay.WriteVariable(var.VP, *(int16_t*)var.memadr);
123
+    else
124
+      dgusdisplay.WriteVariable(var.VP, *(int8_t*)var.memadr);
125 125
   }
126 126
 }
127 127
 
@@ -132,8 +132,7 @@ void DGUSScreenHandler::DGUSLCD_SendPercentageToDisplay(DGUS_VP_Variable &var) {
132 132
     //DEBUG_ECHOLNPAIR(" data ", *(uint16_t *)var.memadr);
133 133
     uint16_t tmp = *(uint8_t *) var.memadr +1 ; // +1 -> avoid rounding issues for the display.
134 134
     tmp = map(tmp, 0, 255, 0, 100);
135
-    uint16_t data_to_send = swap16(tmp);
136
-    dgusdisplay.WriteVariable(var.VP, data_to_send);
135
+    dgusdisplay.WriteVariable(var.VP, tmp);
137 136
   }
138 137
 }
139 138
 
@@ -142,8 +141,7 @@ void DGUSScreenHandler::DGUSLCD_SendPrintProgressToDisplay(DGUS_VP_Variable &var
142 141
   //DEBUG_ECHOPAIR(" DGUSLCD_SendPrintProgressToDisplay ", var.VP);
143 142
   uint16_t tmp = ExtUI::getProgress_percent();
144 143
   //DEBUG_ECHOLNPAIR(" data ", tmp);
145
-  uint16_t data_to_send = swap16(tmp);
146
-  dgusdisplay.WriteVariable(var.VP, data_to_send);
144
+  dgusdisplay.WriteVariable(var.VP, tmp);
147 145
 }
148 146
 
149 147
 // Send the current print time to the display.
@@ -242,7 +240,6 @@ void DGUSScreenHandler::DGUSLCD_SendStringToDisplayPGM(DGUS_VP_Variable &var) {
242 240
       DEBUG_ECHOLNPAIR(" data ", *(uint8_t *)var.memadr);
243 241
       uint16_t data_to_send = 0;
244 242
       if (*(uint8_t *) var.memadr) data_to_send = 1;
245
-      data_to_send = swap16(data_to_send);
246 243
       dgusdisplay.WriteVariable(var.VP, data_to_send);
247 244
     }
248 245
   }
@@ -255,7 +252,6 @@ void DGUSScreenHandler::DGUSLCD_SendHeaterStatusToDisplay(DGUS_VP_Variable &var)
255 252
     DEBUG_ECHOLNPAIR(" data ", *(int16_t *)var.memadr);
256 253
     uint16_t data_to_send = 0;
257 254
     if (*(int16_t *) var.memadr) data_to_send = 1;
258
-    data_to_send = swap16(data_to_send);
259 255
     dgusdisplay.WriteVariable(var.VP, data_to_send);
260 256
   }
261 257
 }
@@ -268,7 +264,7 @@ void DGUSScreenHandler::DGUSLCD_SendHeaterStatusToDisplay(DGUS_VP_Variable &var)
268 264
     //DEBUG_ECHOPAIR(" DGUSLCD_SendWaitingStatusToDisplay ", var.VP);
269 265
     //DEBUG_ECHOLNPAIR(" data ", swap16(index));
270 266
     if (period++ > DGUS_UI_WAITING_STATUS_PERIOD) {
271
-      dgusdisplay.WriteVariable(var.VP, swap16(index));
267
+      dgusdisplay.WriteVariable(var.VP, index);
272 268
       //DEBUG_ECHOLNPAIR(" data ", swap16(index));
273 269
       if (++index >= DGUS_UI_WAITING_STATUS) index = 0;
274 270
       period = 0;

+ 2
- 16
Marlin/src/lcd/extui/lib/dgus/DGUSScreenHandler.h View File

@@ -184,15 +184,7 @@ public:
184 184
     if (var.memadr) {
185 185
       float f = *(float *)var.memadr;
186 186
       f *= cpow(10, decimals);
187
-      union { long l; char lb[4]; } endian;
188
-
189
-      char tmp[4];
190
-      endian.l = f;
191
-      tmp[0] = endian.lb[3];
192
-      tmp[1] = endian.lb[2];
193
-      tmp[2] = endian.lb[1];
194
-      tmp[3] = endian.lb[0];
195
-      dgusdisplay.WriteVariable(var.VP, tmp, 4);
187
+      dgusdisplay.WriteVariable(var.VP, (long)f);
196 188
     }
197 189
   }
198 190
 
@@ -205,13 +197,7 @@ public:
205 197
       float f = *(float *)var.memadr;
206 198
       DEBUG_ECHOLNPAIR_F(" >> ", f, 6);
207 199
       f *= cpow(10, decimals);
208
-      union { int16_t i; char lb[2]; } endian;
209
-
210
-      char tmp[2];
211
-      endian.i = f;
212
-      tmp[0] = endian.lb[1];
213
-      tmp[1] = endian.lb[0];
214
-      dgusdisplay.WriteVariable(var.VP, tmp, 2);
200
+      dgusdisplay.WriteVariable(var.VP, (int16_t)f);
215 201
     }
216 202
   }
217 203
 

Loading…
Cancel
Save