Fixed issue on Add operation when handling FLOAT32 type

Author: paulorb

src/main/kotlin/ConfigurationParser.kt

@@ -89,7 +89,7 @@ data class Linear(
 data class Sub(
     @field:XmlAttribute(required = true)
     val symbol: String,
-    @field:XmlAttribute(required = true)
+    @field:XmlValue
     val value: String,
 ){
     constructor(): this("", "")
@@ -101,10 +101,10 @@ data class Sub(
 data class Add(
     @field:XmlAttribute(required = true)
     val symbol: String,
-    @field:XmlAttribute(required = true)
+    @field:XmlValue
     val value: String,
 ){
-    constructor(): this("", "")
+    constructor(): this("", "0")
 }
 
 //<delay>100</delay>

src/main/kotlin/PlcSimulation.kt

@@ -35,7 +35,7 @@ class PlcSimulation(
                             }
 
                             is Add -> {
-                                //TODO
+                                addOperation(element, configuration, memory)
                             }
 
                             is Sub -> {
@@ -61,6 +61,62 @@ class PlcSimulation(
 
     }
 
+    private fun addOperation(element: Add, configuration: Configuration, memory: PlcMemory){
+        println("Add symbol ${element.symbol} value ${element.value}")
+        var variable = configuration.registers.getVarConfiguration(element.symbol)
+        if (variable == null) {
+            println("ERROR: Symbol ${element.symbol} not found during Set execution")
+            throw CancellationException("Error - Add")
+        } else {
+            if(variable.addressType == AddressType.COIL || variable.addressType == AddressType.DISCRETE_INPUT){
+                println("ERROR: Symbol ${element.symbol} is of type COIL or DISCRETE_INPUT which is not support by Add operation")
+                throw CancellationException("Error - Add")
+            }
+
+            when (variable.addressType) {
+
+                AddressType.HOLDING_REGISTER -> {
+                    //get the current value
+                    //add
+                    //set back the new value
+
+                    if (variable.datatype == "FLOAT32") {
+                        var currentValue = memory.readHoldingRegister(variable.address.toInt(), 2)
+                        if(currentValue.isEmpty()){
+                            println("ERROR: Add Operation - Unable to get value of ${element.symbol} address ${variable.address} ")
+                            throw CancellationException("Error - Add")
+                        }
+                        val intValue = (( currentValue[1].toInt() shl 16) or (currentValue[0].toInt() and 0xFFFF))
+                        val currentFloatValue = java.lang.Float.intBitsToFloat(intValue)
+                        var floatValue = element.value.toFloat()
+                        floatValue += currentFloatValue
+                        setHoldingRegisterFloat32(floatValue, memory, variable)
+                    } else {
+                        var currentValue = memory.readHoldingRegister(variable.address.toInt(), 1)
+                        if(currentValue.isEmpty()){
+                            println("ERROR: Add Operation - Unable to get value of ${element.symbol} address ${variable.address} ")
+                            throw CancellationException("Error - Add")
+                        }
+                        //Int16   VALIDATED!
+                        var intValue =  element.value.toInt()
+                        intValue += currentValue.first().toInt()
+                        setHoldingRegisterInt16(memory, variable, intValue.toShort())
+                    }
+                }
+                AddressType.INPUT_REGISTER -> {
+                    //TODO NOT TESTED, NOT VALIDATED!!
+                    val currentValue = memory.readInputRegister(variable.address.toInt(), 1)
+                    val newValue = currentValue.first() + element.value.toShort()
+                    memory.setInputRegister(variable.address.toInt(),newValue.toShort())
+                }
+
+                else -> {
+                    throw CancellationException("Error - Add")
+                }
+            }
+        }
+    }
+
     private fun setOperation(element: Set, configuration: Configuration, memory: PlcMemory) {
         println("Set symbol ${element.symbol} value ${element.value}")
         var variable = configuration.registers.getVarConfiguration(element.symbol)