1 (*

     2  * (c) 2003 Mario de Sousa

     3  *

     4  * Offered to the public under the terms of the GNU General Public License

     5  * as published by the Free Software Foundation; either version 2 of the

     6  * License, or (at your option) any later version.

     7  *

     8  * This program is distributed in the hope that it will be useful, but

     9  * WITHOUT ANY WARRANTY; without even the implied warranty of

    10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General

    11  * Public License for more details.

    12  *

    13  * This code is made available on the understanding that it will not be

    14  * used in safety-critical situations without a full and competent review.

    15  *)

    16 

    17 (*

    18  * An IEC 61131-3 IL and ST compiler.

    19  *

    20  * Based on the

    21  * FINAL DRAFT - IEC 61131-3, 2nd Ed. (2001-12-10)

    22  *

    23  *)

    24 

    25 (*

    26  * This is part of the library conatining the functions

    27  * and function blocks defined in the standard.

    28  *

    29  * Conversion to BCD

    30  * -----------------

    31  *)

    32 

    33 

    34 

    35 

    36 FUNCTION USINT_TO_BCD_BYTE: BYTE

    37   VAR_INPUT

    38     VALUE : USINT;

    39   END_VAR

    40 

    41   USINT_TO_BCD_BYTE := VALUE MOD 10;

    42   VALUE := VALUE / 10;

    43   USINT_TO_BCD_BYTE := USINT_TO_BCD_BYTE + 16*VALUE;

    44   IF VALUE > 9

    45   THEN

    46     (* The standard is silent on how to handle overflows!! *)

    47     (* We simply set it to the highets value!              *)

    48     USINT_TO_BCD_BYTE := 16#99;

    49   END_IF;

    50 END_FUNCTION

    51 

    52 

    53 

    54 

    55 FUNCTION UINT_TO_BCD_WORD: WORD

    56   VAR_INPUT

    57     VALUE : UINT;

    58   END_VAR

    59 

    60   UINT_TO_BCD_WORD := VALUE MOD 10;

    61   VALUE := VALUE / 10;

    62   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*(VALUE MOD 10);

    63   VALUE := VALUE / 10;

    64   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*16*(VALUE MOD 10);

    65   VALUE := VALUE / 10;

    66   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*16*16*VALUE;

    67   IF VALUE > 9

    68   THEN

    69     (* The standard is silent on how to handle overflows!! *)

    70     (* We simply set it to the highets value!              *)

    71     UINT_TO_BCD_WORD := 16#9999;

    72   END_IF;

    73 END_FUNCTION

    74 

    75 

    76 

    77 

    78 FUNCTION UDINT_TO_BCD_DWORD: DWORD

    79   VAR_INPUT

    80     VALUE : UINT;

    81   END_VAR

    82 

    83   UDINT_TO_BCD_DWORD := VALUE MOD 16;

    84   VALUE := VALUE / 10;

    85   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*(VALUE MOD 10);

    86   VALUE := VALUE / 10;

    87   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*(VALUE MOD 10);

    88   VALUE := VALUE / 10;

    89   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*(VALUE MOD 10);

    90   VALUE := VALUE / 10;

    91   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*256*(VALUE MOD 10);

    92   VALUE := VALUE / 10;

    93   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*256*(VALUE MOD 10);

    94   VALUE := VALUE / 10;

    95   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*256*256*(VALUE MOD 10);

    96   VALUE := VALUE / 10;

    97   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*256*256*VALUE;

    98   IF VALUE > 9

    99   THEN

   100     (* The standard is silent on how to handle overflows!! *)

   101     (* We simply set it to the highest value!              *)

   102     UDINT_TO_BCD_DWORD := 16#9999_9999;

   103   END_IF;

   104 END_FUNCTION

   105 

   106 

   107 

   108 

   109 FUNCTION ULINT_TO_BCD_LWORD: LWORD

   110   VAR_INPUT

   111     VALUE : UINT;

   112   END_VAR

   113 

   114   ULINT_TO_BCD_LWORD := UDINT_TO_BCD_DWORD(VALUE MOD 1_0000_0000);

   115   VALUE := VALUE / 1_0000_0000;

   116   ULINT_TO_BCD_LWORD := ULINT_TO_BCD_LWORD + 256*256*256*256*UDINT_TO_BCD_DWORD(VALUE);

   117 END_FUNCTION