SPI-FbDrvMonarco

<?xml version="1.0" encoding="utf-8"?>

<project xmlns="http://www.plcopen.org/xml/tc6_0200">

  <fileHeader companyName="" productName="CODESYS" productVersion="CODESYS V3.5 SP13" creationDateTime="2018-09-21T11:46:51.6132905" />

  <contentHeader name="Monarco HAT library for CODESYS" version="2.0.0.1" modificationDateTime="2018-07-29T18:12:20.818347" organization="Monarco.io" author="Aliazzzz">

    <Comment>.. _description: 

Library containing device support for Monarco HAT hardware developped by the guys from Monarco.io.

I decided to write this library because the hardware is very solid, but a CODESYS implementation was missing.

Writing this library was fun, but took a lot of sweat and time, please refer to this work when you use it =).

I am not affiliated with Monarco.io in any way, shape or form.

Released under Unlicense.

Enjoy!

**Getting started**

To use the HAT, RS-485 and the Realtime Clock under CODESYS, please follow these steps. RTC requires no Linux side config apart from the overlay;

1) On your Raspberry Pi, switch to root user: sudo -s

2) Disable Linux console on UART: **sed 's/ console=serial0,[0-9]\+//' -i /boot/cmdline.txt**

3) Run the following command to get device-tree overlay definition for the RS-485 on the Monarco HAT: **wget www.monarco.io/download/monarco-fix-4-9.dtbo**

4) Copy it to /boot/overlays: **sudo cp monarco-fix-4-9.dtbo /boot/overlays**

5) Afterwards add dtoverlay=monarco-fix-4-9 line to the /boot/config.txt file: **echo dtoverlay=monarco-fix-4-9 >> /boot/config.txt**

6) Reboot your Raspberry Pi: **reboot**

7) After reboot, check the output of the following command: **ls -l /dev/serial0**

8) The response should read **"/dev/serial0 -> ttyAMA0"**

9) Again, switch to root user: **sudo -s  cd etc/**

10) Then: **nano CODESYSControl.cfg**

11) Add the following lines: **[SysCom] Linux.Devicefile=/dev/ttyAMA**

12) Then reboot your Raspberry Pi again: **reboot**

13) After reboot: **Now you can use the HAT, RS-485 and the Real-Time Clock in CODESYS!** from within an IEC application via a comlib of you own flavour (like CAA SerialCOM library).

.. image:: ../Images/MonarcoHAT.png

* Real Time Clock (RTC)

* RS-485 Interface

* 1-Wire Interface (1w)

* 4 Digital Inputs

* 4 Digital Outputs

* 2 Analog Inputs 12 bits without sign: (0 - 4095) 0..10V / 0..25mA

* 2 Analog Outputs 12 bit without sign: (0 - 4095) 0..10V

* LEDs: 1 × orange, 8 × green LEDs

* Power supply: 10-30 VDC, powers also the Raspberry Pi

This library is based on Hardware version 0106, Firmware version 2006.

.. image:: ../Images/schematics.png</Comment>

    <coordinateInfo>

      <fbd>

        <scaling x="1" y="1" />

      </fbd>

      <ld>

        <scaling x="1" y="1" />

      </ld>

      <sfc>

        <scaling x="1" y="1" />

      </sfc>

    </coordinateInfo>

    <addData>

      <data name="http://www.3s-software.com/plcopenxml/projectinformation" handleUnknown="implementation">

        <ProjectInformation>

          <property name="Author" type="string">Aliazzzz</property>

          <property name="Company" type="string">Monarco.io</property>

          <property name="DefaultNamespace" type="string">MNR</property>

          <property name="Description" type="string">.. _description: 

Library containing device support for Monarco HAT hardware developped by the guys from Monarco.io.

I decided to write this library because the hardware is very solid, but a CODESYS implementation was missing.

Writing this library was fun, but took a lot of sweat and time, please refer to this work when you use it =).

I am not affiliated with Monarco.io in any way, shape or form.

Released under Unlicense.

Enjoy!

**Getting started**

To use the HAT, RS-485 and the Realtime Clock under CODESYS, please follow these steps. RTC requires no Linux side config apart from the overlay;

1) On your Raspberry Pi, switch to root user: sudo -s

2) Disable Linux console on UART: **sed 's/ console=serial0,[0-9]\+//' -i /boot/cmdline.txt**

3) Run the following command to get device-tree overlay definition for the RS-485 on the Monarco HAT: **wget www.monarco.io/download/monarco-fix-4-9.dtbo**

4) Copy it to /boot/overlays: **sudo cp monarco-fix-4-9.dtbo /boot/overlays**

5) Afterwards add dtoverlay=monarco-fix-4-9 line to the /boot/config.txt file: **echo dtoverlay=monarco-fix-4-9 >> /boot/config.txt**

6) Reboot your Raspberry Pi: **reboot**

7) After reboot, check the output of the following command: **ls -l /dev/serial0**

8) The response should read **"/dev/serial0 -> ttyAMA0"**

9) Again, switch to root user: **sudo -s  cd etc/**

10) Then: **nano CODESYSControl.cfg**

11) Add the following lines: **[SysCom] Linux.Devicefile=/dev/ttyAMA**

12) Then reboot your Raspberry Pi again: **reboot**

13) After reboot: **Now you can use the HAT, RS-485 and the Real-Time Clock in CODESYS!** from within an IEC application via a comlib of you own flavour (like CAA SerialCOM library).

.. image:: ../Images/MonarcoHAT.png

* Real Time Clock (RTC)

* RS-485 Interface

* 1-Wire Interface (1w)

* 4 Digital Inputs

* 4 Digital Outputs

* 2 Analog Inputs 12 bits without sign: (0 - 4095) 0..10V / 0..25mA

* 2 Analog Outputs 12 bit without sign: (0 - 4095) 0..10V

* LEDs: 1 × orange, 8 × green LEDs

* Power supply: 10-30 VDC, powers also the Raspberry Pi

This library is based on Hardware version 0106, Firmware version 2006.

.. image:: ../Images/schematics.png</property>

          <property name="DocFormat" type="string">reStructuredText</property>

          <property name="LibDocContent" type="string">CommentsAndDocs</property>

          <property name="Project" type="string">Monarco HAT library for codesys 2.0.0.1</property>

          <property name="Title" type="string">Monarco HAT library for CODESYS</property>

          <property name="Version" type="version">2.0.0.1</property>

        </ProjectInformation>

      </data>

      <data name="http://www.3s-software.com/plcopenxml/autogeneratedobjects" handleUnknown="implementation">

        <AutogeneratedObjects>

          <libraryInfoFunctions>true</libraryInfoFunctions>

          <projectInfoFunctions>false</projectInfoFunctions>

          <propertyAccessorFunctions>false</propertyAccessorFunctions>

        </AutogeneratedObjects>

      </data>

    </addData>

  </contentHeader>

  <types>

    <dataTypes />

    <pous>

      <pou name="IoDrvMonarco" pouType="functionBlock">

        <interface>

          <localVars>

            <variable name="_IIoDrv">

              <type>

                <derived name="ICmpIoDrv" />

              </type>

            </variable>

            <variable name="_IIoDrvParameter">

              <type>

                <derived name="ICmpIoDrvParameter" />

              </type>

            </variable>

            <variable name="Monarco">

              <type>

                <derived name="MonarcoItf" />

              </type>

            </variable>

            <variable name="_dwInUse">

              <type>

                <DWORD />

              </type>

            </variable>

            <variable name="_xBackGroundDiagStarted">

              <type>

                <BOOL />

              </type>

            </variable>

            <variable name="_bDeactivated">

              <type>

                <BOOL />

              </type>

            </variable>

          </localVars>

          <addData>

            <data name="http://www.3s-software.com/plcopenxml/pouinheritance" handleUnknown="implementation">

              <Inheritance>

                <Extends>IoDrvBase</Extends>

                <Implements>ICmpIoDrvParameter</Implements>

              </Inheritance>

            </data>

            <data name="http://www.3s-software.com/plcopenxml/attributes" handleUnknown="implementation">

              <Attributes>

                <Attribute Name="symbol" Value="readwrite" />

              </Attributes>

            </data>

          </addData>

        </interface>

        <body>

          <ST>

            <xhtml xmlns="http://www.w3.org/1999/xhtml" />

          </ST>

        </body>

        <addData>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="FB_Init">

              <interface>

                <returnType>

                  <BOOL />

                </returnType>

                <inputVars>

                  <variable name="bInitRetains">

                    <type>

                      <BOOL />

                    </type>

                  </variable>

                  <variable name="bInCopyCode">

                    <type>

                      <BOOL />

                    </type>

                  </variable>

                </inputVars>

                <localVars>

                  <variable name="Result">

                    <type>

                      <UDINT />

                    </type>

                  </variable>

                  <variable name="CLASSID_CCmpIoDrvTemplate">

                    <type>

                      <DWORD />

                    </type>

                  </variable>

                </localVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">FB_Init_Count := FB_Init_Count + 1;

m_Info.szDriverName := 'IoDrvMonarco';

m_Info.szVendorName := 'Monarcio.IO';

m_Info.szDeviceName := 'Monarco HAT';

m_Info.wModuleType := 501;

_IIoDrv := THIS^;

_IIoDrvParameter := THIS^;

m_IBaseItf := THIS^;

m_hInterface := IoMgrRegisterInstance2(dwClassId:=CLASSID_CCmpIoDrvTemplate, pItf:=m_IBaseItf, pResult:=ADR(Result));

FB_Init := TRUE;</xhtml>

                </ST>

              </body>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="FB_Exit">

              <interface>

                <returnType>

                  <BOOL />

                </returnType>

                <inputVars>

                  <variable name="bInCopyCode">

                    <type>

                      <BOOL />

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">FB_Exit_Count := FB_Exit_Count + 1;

FB_Exit := TRUE;

</xhtml>

                </ST>

              </body>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="FB_Reinit">

              <interface>

                <returnType>

                  <BOOL />

                </returnType>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">FB_Reinit_Count := FB_Reinit_Count + 1;

FB_Reinit := TRUE;</xhtml>

                </ST>

              </body>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="QueryInterface">

              <interface>

                <returnType>

                  <pointer>

                    <baseType>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </baseType>

                  </pointer>

                </returnType>

                <inputVars>

                  <variable name="iid">

                    <type>

                      <DWORD />

                    </type>

                    <documentation>

                      <xhtml xmlns="http://www.w3.org/1999/xhtml"> InterfaceID </xhtml>

                    </documentation>

                  </variable>

                  <variable name="pResult">

                    <type>

                      <pointer>

                        <baseType>

                          <UDINT />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">QueryInterface_Count := QueryInterface_Count + 1;

IF iid = ITFID_ICmpIoDrv THEN

    QueryInterface := ADR(_IIoDrv);

    AddRef();

    IF (pResult <> 0) THEN

        pResult^ := Errors.ERR_OK;

    END_IF

    RETURN; 

ELSIF iid = ITFID_ICmpIoDrvParameter THEN

    QueryInterface := ADR(_IIoDrvParameter);

    AddRef();

    IF (pResult <> 0) THEN

        pResult^ := Errors.ERR_OK;

    END_IF  

    RETURN; 

ELSE

    QueryInterface := SUPER^.QueryInterface(iid, pResult);

END_IF

</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="Initialize">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="wModuleType">

                    <type>

                      <UINT />

                    </type>

                  </variable>

                  <variable name="dwInstance">

                    <type>

                      <UDINT />

                    </type>

                  </variable>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">Initialize_Count := Initialize_Count + 1;

m_wModuleType := wModuleType;

m_dwInstance := dwInstance;

m_Info.wModuleType := wModuleType;

Monarco.Initialize(wModuleType, dwInstance, pConnector);

Initialize := Errors.ERR_OK;</xhtml>

                </ST>

              </body>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvReadParameter">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pParameter">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigParameter" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pData">

                    <type>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="dwBitSize">

                    <type>

                      <DWORD />

                    </type>

                  </variable>

                  <variable name="dwBitOffset">

                    <type>

                      <DWORD />

                    </type>

                  </variable>

                </inputVars>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IF    pConnector = 0 OR pParameter = 0 OR pData = 0 THEN

    IoDrvReadParameter := Errors.ERR_PARAMETER;

    RETURN; 

END_IF

// All standard parameters of our device are handled by the IO-manager!

IoDrvReadParameter := Errors.ERR_FAILED;

</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvWriteParameter">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pParameter">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigParameter" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pData">

                    <type>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="dwBitSize">

                    <type>

                      <DWORD />

                    </type>

                  </variable>

                  <variable name="dwBitOffset">

                    <type>

                      <DWORD />

                    </type>

                  </variable>

                </inputVars>

                <localVars>

                  <variable name="pParam">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigParameter" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pstDiagString">

                    <type>

                      <pointer>

                        <baseType>

                          <string />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </localVars>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IF pConnector = 0 OR pParameter = 0 OR pData = 0 THEN

    IoDrvWriteParameter := Errors.ERR_PARAMETER;

    RETURN; 

END_IF

IoDrvWriteParameter := Errors.ERR_FAILED;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvGetConnector">

              <interface>

                <returnType>

                  <pointer>

                    <baseType>

                      <derived name="IoConfigConnector" />

                    </baseType>

                  </pointer>

                </returnType>

                <inputVars>

                  <variable name="pResult">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="RTS_IEC_RESULT" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IF m_pConnector = 0 THEN

    IF pResult <> 0 THEN

        pResult^ := Errors.ERR_FAILED;

    END_IF

    IoDrvGetConnector := 0; 

    RETURN;

END_IF

IF pResult <> 0 THEN

    pResult^ := Errors.ERR_OK;

END_IF

IoDrvGetConnector := m_pConnector;

</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvIdentify">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvIdentify_Count := IoDrvIdentify_Count + 1;

IoDrvIdentify := Errors.ERR_NOTIMPLEMENTED;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvWatchdogTrigger">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvWatchdogTrigger_Count := IoDrvWatchdogTrigger_Count + 1;

IoDrvWatchdogTrigger := Errors.ERR_OK;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvGetModuleDiagnosis">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IF pConnector = 0 THEN

    //we are called from the background task

    _xBackGroundDiagStarted := TRUE;

END_IF

//Todo: update connectorflags if something changed

IoDrvGetModuleDiagnosis_Count := IoDrvGetModuleDiagnosis_Count + 1;

IoDrvGetModuleDiagnosis := Errors.ERR_NOTIMPLEMENTED;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvWriteOutputs">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnectorMapList">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnectorMap" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="nCount">

                    <type>

                      <DINT />

                    </type>

                  </variable>

                </inputVars>

                <localVars>

                  <variable name="i">

                    <type>

                      <DINT />

                    </type>

                  </variable>

                  <variable name="j">

                    <type>

                      <DINT />

                    </type>

                  </variable>

                  <variable name="wSize">

                    <type>

                      <WORD />

                    </type>

                  </variable>

                  <variable name="pbyIecAddress">

                    <type>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="bySrcValue">

                    <type>

                      <BYTE />

                    </type>

                  </variable>

                  <variable name="wSrcIndex">

                    <type>

                      <WORD />

                    </type>

                  </variable>

                  <variable name="bySrcMask">

                    <type>

                      <BYTE />

                    </type>

                  </variable>

                  <variable name="wDestIndex">

                    <type>

                      <WORD />

                    </type>

                  </variable>

                  <variable name="ptr">

                    <type>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="ptrW">

                    <type>

                      <pointer>

                        <baseType>

                          <WORD />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="ptrB">

                    <type>

                      <pointer>

                        <baseType>

                          <BYTE />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </localVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvWriteOutputs_Count := IoDrvWriteOutputs_Count + 1;

IF pConnectorMapList = 0 OR nCount = 0 THEN

    IoDrvWriteOutputs := Errors.ERR_PARAMETER;

    RETURN;

END_IF

FOR i:=0 TO nCount - 1 DO

    IF (pConnectorMapList[i].dwNumOfChannels = 0) THEN

        CONTINUE;

    END_IF

    FOR j:= 0 TO UDINT_TO_UINT(pConnectorMapList[i].dwNumOfChannels) - 1 DO

        wSrcIndex := pConnectorMapList[i].pChannelMapList[j].wIecAddressBitOffset / 8; 

        pbyIecAddress := pConnectorMapList[i].pChannelMapList[j].pbyIecAddress;         

        IF (pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId >= 2000 AND pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId<=2002)

            OR (pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId >= 9010 AND pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId<=9016)

            OR (pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId >= 9030 AND pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId<=9031) THEN

            IF pConnectorMapList[i].pChannelMapList[j].wSize = 1 THEN

                bySrcValue := pbyIecAddress[wSrcIndex];

                IF (pbyIecAddress[wSrcIndex] AND SHL(BYTE#1, pConnectorMapList[i].pChannelMapList[j].wIecAddressBitOffset MOD 8)) <> 0 THEN

                {IF defined (pou:SysCpuSetBit2)}

                    SysCpuSetBit2(pConnectorMapList[i].pChannelMapList[j].pParameter^.dwDriverSpecific, pConnectorMapList[i].pChannelMapList[j].wParameterBitOffset MOD 8);         

                {ELSE}    

                    SysCpuSetBit(pConnectorMapList[i].pChannelMapList[j].pParameter^.dwDriverSpecific, pConnectorMapList[i].pChannelMapList[j].wParameterBitOffset MOD 8);          

                {END_IF}    

                ELSE

                {IF defined (pou:SysCpuResetBit2)}

                    SysCpuResetBit2(pConnectorMapList[i].pChannelMapList[j].pParameter^.dwDriverSpecific, pConnectorMapList[i].pChannelMapList[j].wParameterBitOffset MOD 8);               

                {ELSE}    

                    SysCpuResetBit(pConnectorMapList[i].pChannelMapList[j].pParameter^.dwDriverSpecific, pConnectorMapList[i].pChannelMapList[j].wParameterBitOffset MOD 8);                

                {END_IF}    

                END_IF          

            ELSIF pConnectorMapList[i].pChannelMapList[j].wSize = 8 THEN

                ptr:= pConnectorMapList[i].pChannelMapList[j].pParameter^.dwDriverSpecific;

                ptr^ := pbyIecAddress[wSrcIndex];

            END_IF

        ELSIF pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId = 2100 THEN

            IF pConnectorMapList[i].pChannelMapList[j].wSize = 16 THEN

                ptrW:= pbyIecAddress;   

                Monarco.wAOut1 := ptrW^;

            END_IF

        ELSIF pConnectorMapList[i].pChannelMapList[j].pParameter^.dwParameterId = 2101 THEN

            IF pConnectorMapList[i].pChannelMapList[j].wSize = 16 THEN

                ptrW:= pbyIecAddress;   

                Monarco.wAOut2 := ptrW^;

            END_IF

        END_IF

    END_FOR

END_FOR

IoDrvWriteOutputs := Errors.ERR_OK;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvUpdateMapping">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pTaskMapList">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigTaskMap" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="nCount">

                    <type>

                      <DINT />

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvUpdateMapping_Count := IoDrvUpdateMapping_Count + 1;

IF (pTaskMapList = 0) THEN

    IoDrvUpdateMapping := Errors.ERR_PARAMETER;

    RETURN;

END_IF

IoDrvUpdateMapping := Errors.ERR_OK;</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvUpdateConfiguration">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnectorList">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="nCount">

                    <type>

                      <DINT />

                    </type>

                  </variable>

                </inputVars>

                <localVars>

                  <variable name="pParameter">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigParameter" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pChild">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pstConnectorVendorName">

                    <type>

                      <pointer>

                        <baseType>

                          <string />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="pstConnectorDeviceName">

                    <type>

                      <pointer>

                        <baseType>

                          <string />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="dwTest">

                    <type>

                      <pointer>

                        <baseType>

                          <DWORD />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                  <variable name="Result">

                    <type>

                      <derived name="RTS_IEC_RESULT" />

                    </type>

                  </variable>

                </localVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvUpdateConfiguration_Count := IoDrvUpdateConfiguration_Count + 1;

IoDrvUpdateConfiguration := Errors.ERR_OK;

IF (pConnectorList = 0) THEN

    // Reset application

    // TODO: Free resources

    RETURN;

END_IF

m_pConnector := IoMgrConfigGetConnector(pConnectorList, ADR(nCount), m_wModuleType, m_dwInstance);

IF m_pConnector = 0 THEN

    IoDrvUpdateConfiguration := ERRORS.ERR_PARAMETER;

    RETURN;

END_IF

//check if device is enabled in the device tree

IF (m_pConnector^.dwFlags AND ConnectorFlags.CF_ENABLE) = 0 THEN

    _bDeactivated := TRUE;

    IoDrvUpdateConfiguration := Errors.ERR_OK;

    RETURN;

END_IF

IF m_pConnector^.hIoDrv = 0 THEN

    m_pConnector^.hIoDrv := m_hInterface;

    m_pConnector^.pFather^.hIoDrv := m_hInterface;

    {IF defined (pou:IoMgrConfigSetDiagnosis)}

    IoMgrConfigSetDiagnosis(m_pConnector,

                            ConnectorFlags.CF_DRIVER_AVAILABLE OR

                            ConnectorFlags.CF_CONNECTOR_FOUND OR

                            ConnectorFlags.CF_CONNECTOR_CONFIGURED OR

                            ConnectorFlags.CF_CONNECTOR_ACTIVE);

    {END_IF}

    {IF defined (pou:IoMgrConfigSetDiagnosis)}

    IoMgrConfigSetDiagnosis(m_pConnector^.pFather,

                            ConnectorFlags.CF_DRIVER_AVAILABLE OR

                            ConnectorFlags.CF_CONNECTOR_FOUND OR

                            ConnectorFlags.CF_CONNECTOR_CONFIGURED OR

                            ConnectorFlags.CF_CONNECTOR_ACTIVE);

    {END_IF}

    {IF defined (pou:IoMgrSetDriverProperties)}         

        IoMgrSetDriverProperties(m_hInterface, DRVPROP_CONSISTENCY OR DRVPROP_BACKGROUND_GETDIAG);

        //Note: background diagnosis property flag is optional (supported with 3.5.1.0 runtime)

    {END_IF}                        

    //Setup I/O area

    pParameter := IoMgrConfigGetParameter(m_pConnector, 2000);      (* outputs *)

    IF (pParameter <> 0) THEN

        pParameter^.dwDriverSpecific := ADR(Monarco.byDOut);                    

    END_IF

    //Go through all childs of the device

    pChild := IoMgrConfigGetFirstChild(m_pConnector, ADR(nCount), m_pConnector);

    WHILE (pChild <> 0) DO

        IF (pChild^.dwFlags AND ConnectorFlags.CF_ENABLE) <> 0 THEN

            pChild^.hIoDrv := m_hInterface; 

            {IF defined (pou:IoMgrConfigSetDiagnosis)}

            IoMgrConfigSetDiagnosis(pChild,

                                    ConnectorFlags.CF_DRIVER_AVAILABLE OR

                                    ConnectorFlags.CF_CONNECTOR_FOUND OR

                                    ConnectorFlags.CF_CONNECTOR_CONFIGURED OR

                                    ConnectorFlags.CF_CONNECTOR_ACTIVE);

            {END_IF}

        END_IF

        pChild := IoMgrConfigGetNextChild(pChild, ADR(nCount), m_pConnector);

    END_WHILE

END_IF</xhtml>

                </ST>

              </body>

              <BuildProperties>

                <EnableSystemCall>true</EnableSystemCall>

              </BuildProperties>

              <addData />

            </Method>

          </data>

          <data name="http://www.3s-software.com/plcopenxml/method" handleUnknown="implementation">

            <Method name="IoDrvStartBusCycle">

              <interface>

                <returnType>

                  <UDINT />

                </returnType>

                <inputVars>

                  <variable name="pConnector">

                    <type>

                      <pointer>

                        <baseType>

                          <derived name="IoConfigConnector" />

                        </baseType>

                      </pointer>

                    </type>

                  </variable>

                </inputVars>

                <documentation>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">{attribute 'conditionalshow' := 'IoDrvDebug'}</xhtml>

                </documentation>

              </interface>

              <body>

                <ST>

                  <xhtml xmlns="http://www.w3.org/1999/xhtml">IoDrvStartBusCycle_Count := IoDrvStartBusCycle_Count + 1;

//if background diagnosis is not active call IoDrvGetModuleDiagnosis; normally it will be called by the runtime if DRVPROP_BACKGROUND_GETDIAG is set

IF NOT _xBackGroundDiagStarted THEN

    IoDrvGetModuleDiagnosis(m_pConnector); //DRVPROP_BACKGROUND_GETDIAG not set or runtime version < V3.5.1.0

END_IF

//optional: call IoDrvWatchdogTrigger or set driver property DRVPROP_WATCHDOG in UpdateConfiguration

IoDrvWatchdogTrigger(pConnector);

IF NOT _bDeactivated THEN

    Monarco.AfterReadInputs();

    Monarco.BeforeWriteOutputs();

END_IF

IoDrvStartBusCycle := Errors.ERR_OK;</xhtml>

                </ST>