etisserant@0: (*
etisserant@0:  * (c) 2003 Mario de Sousa
etisserant@0:  *
etisserant@0:  * Offered to the public under the terms of the GNU General Public License
etisserant@0:  * as published by the Free Software Foundation; either version 2 of the
etisserant@0:  * License, or (at your option) any later version.
etisserant@0:  *
etisserant@0:  * This program is distributed in the hope that it will be useful, but
etisserant@0:  * WITHOUT ANY WARRANTY; without even the implied warranty of
etisserant@0:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General
etisserant@0:  * Public License for more details.
etisserant@0:  *
etisserant@0:  * This code is made available on the understanding that it will not be
etisserant@0:  * used in safety-critical situations without a full and competent review.
etisserant@0:  *)
etisserant@0: 
etisserant@0: (*
etisserant@0:  * An IEC 61131-3 IL and ST compiler.
etisserant@0:  *
etisserant@0:  * Based on the
etisserant@0:  * FINAL DRAFT - IEC 61131-3, 2nd Ed. (2001-12-10)
etisserant@0:  *
etisserant@0:  *)
etisserant@0: 
etisserant@0: (*
etisserant@0:  * This is part of the library conatining the functions
etisserant@0:  * and function blocks defined in the standard.
etisserant@0:  *
etisserant@0:  * Conversion to BCD
etisserant@0:  * -----------------
etisserant@0:  *)
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: FUNCTION USINT_TO_BCD_BYTE: BYTE
etisserant@0:   VAR_INPUT
etisserant@0:     VALUE : USINT;
etisserant@0:   END_VAR
etisserant@0: 
etisserant@0:   USINT_TO_BCD_BYTE := VALUE MOD 10;
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   USINT_TO_BCD_BYTE := USINT_TO_BCD_BYTE + 16*VALUE;
etisserant@0:   IF VALUE > 9
etisserant@0:   THEN
etisserant@0:     (* The standard is silent on how to handle overflows!! *)
etisserant@0:     (* We simply set it to the highets value!              *)
etisserant@0:     USINT_TO_BCD_BYTE := 16#99;
etisserant@0:   END_IF;
etisserant@0: END_FUNCTION
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: FUNCTION UINT_TO_BCD_WORD: WORD
etisserant@0:   VAR_INPUT
etisserant@0:     VALUE : UINT;
etisserant@0:   END_VAR
etisserant@0: 
etisserant@0:   UINT_TO_BCD_WORD := VALUE MOD 10;
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*16*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UINT_TO_BCD_WORD := UINT_TO_BCD_WORD + 16*16*16*VALUE;
etisserant@0:   IF VALUE > 9
etisserant@0:   THEN
etisserant@0:     (* The standard is silent on how to handle overflows!! *)
etisserant@0:     (* We simply set it to the highets value!              *)
etisserant@0:     UINT_TO_BCD_WORD := 16#9999;
etisserant@0:   END_IF;
etisserant@0: END_FUNCTION
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: FUNCTION UDINT_TO_BCD_DWORD: DWORD
etisserant@0:   VAR_INPUT
etisserant@0:     VALUE : UINT;
etisserant@0:   END_VAR
etisserant@0: 
etisserant@0:   UDINT_TO_BCD_DWORD := VALUE MOD 16;
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*256*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*256*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 256*256*256*(VALUE MOD 10);
etisserant@0:   VALUE := VALUE / 10;
etisserant@0:   UDINT_TO_BCD_DWORD := UDINT_TO_BCD_DWORD + 16*256*256*256*VALUE;
etisserant@0:   IF VALUE > 9
etisserant@0:   THEN
etisserant@0:     (* The standard is silent on how to handle overflows!! *)
etisserant@0:     (* We simply set it to the highest value!              *)
etisserant@0:     UDINT_TO_BCD_DWORD := 16#9999_9999;
etisserant@0:   END_IF;
etisserant@0: END_FUNCTION
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: 
etisserant@0: FUNCTION ULINT_TO_BCD_LWORD: LWORD
etisserant@0:   VAR_INPUT
etisserant@0:     VALUE : UINT;
etisserant@0:   END_VAR
etisserant@0: 
etisserant@0:   ULINT_TO_BCD_LWORD := UDINT_TO_BCD_DWORD(VALUE MOD 1_0000_0000);
etisserant@0:   VALUE := VALUE / 1_0000_0000;
etisserant@0:   ULINT_TO_BCD_LWORD := ULINT_TO_BCD_LWORD + 256*256*256*256*UDINT_TO_BCD_DWORD(VALUE);
etisserant@0: END_FUNCTION