rpp/blocks/tlc_c/sfunction_hydctr_init.tlc

   1 %% Copyright (C) 2013-2015 Czech Technical University in Prague
   2 %%
   3 %% Authors:
   4 %%     - Michal Horn <hornmich@fel.cvut.cz>
   5 %%
   6 %% Permission is hereby granted, free of charge, to any person
   7 %% obtaining a copy of this software and associated documentation
   8 %% files (the "Software"), to deal in the Software without
   9 %% restriction, including without limitation the rights to use,
  10 %% copy, modify, merge, publish, distribute, sublicense, and/or sell
  11 %% copies of the Software, and to permit persons to whom the
  12 %% Software is furnished to do so, subject to the following
  13 %% conditions:
  14
  15 %% The above copyright notice and this permission notice shall be
  16 %% included in all copies or substantial portions of the Software.
  17
  18 %% THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  19 %% EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  20 %% OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  21 %% NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
  22 %% HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  23 %% WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  24 %% FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  25 %% OTHER DEALINGS IN THE SOFTWARE.
  26 %%
  27 %% File : sfunction_hydctr_init.tlc
  28 %% Abstract:
  29 %%     TLC file for inlining RPP HYDCTR board init block.
  30 %%
  31 %% References:
  32 %%     BlockTypeSetup() : refs/rtw_tlc.pdf p. 277
  33 %%     Outputs()        : refs/rtw_tlc.pdf p. 281
  34
  35
  36 %implements sfunction_hydctr_init "C"
  37
  38 %include "common.tlc"
  39
  40
  41 %% Function: BlockInstanceSetup ================================================
  42 %function BlockInstanceSetup(block, system) void
  43     %if EXISTS("rpp_hydctrinit_in_model") == 0
  44         %assign ::rpp_hydctrinit_in_model = 1
  45         %<LibAddToCommonIncludes("rpp/spi.h")>
  46     %else
  47         %<LibBlockReportError(block, "Only one Board Init block is allowed in the model.")>
  48     %endif
  49 %endfunction
  50
  51 %% Function: BlockTypeSetup ====================================================
  52 %function BlockTypeSetup(block, system) void
  53
  54     %% Ensure required header files are included
  55     %<RppCommonBlockTypeSetup(block, system)>
  56     %<LibAddToCommonIncludes("rpp/rpp.h")>
  57     %<LibAddToCommonIncludes("drv/endian.h")>
  58 %endfunction
  59
  60
  61 %% Function: Start =============================================================
  62 %function Start(block, system) Output
  63
  64     %if !SLibCodeGenForSim()
  65
  66         %assign err_flag = LibBlockOutputSignal(0, "", "", 0)
  67
  68         rpp_spi_init();
  69         {
  70           boolean_t err = FALSE;
  71           uint16_t rx;
  72
  73           /% Single-value devices %/
  74            %assign dev_id   = ["SPIDEV_MCP6S93_TH1", "SPIDEV_MCP6S93_TH2", "SPIDEV_TPS65381_PWR", "SPIDEV_MCP6S93_SENSUP", "SPIDEV_MCP6S93_DAC"]
  75            %assign par_name = ["thermistor1",        "thermistor2",        "powersupply",         "sensorsupply",          "dacloopback"]
  76
  77            %foreach dev = SIZE(dev_id, 1)
  78              %assign count = LibBlockParameterWidth(%<par_name[dev]>)
  79              %foreach idx = count
  80                %assign val = LibBlockParameterValue(%<par_name[dev]>, idx)
  81                err |= (rpp_spi_transfer16(%<dev_id[dev]>, %<val>, &rx) != SUCCESS);
  82                %%rpp_sci_printf("%<dev_id[dev]> %<val> -> 0x%04x\n", rx);
  83              %endforeach
  84            %endforeach
  85
  86            /% Daisy chained device %/
  87             %assign size = LibBlockParameterDimensions(adcs)
  88             %foreach command = size[0]
  89               {
  90                 uint16_t data[%<size[1]>] = {
  91                   %foreach data = size[1]
  92                     cpu_to_be16(%<LibBlockParameterValue(adcs, size[0]*data + command)>),
  93                   %endforeach
  94                 };
  95                 err |= (rpp_spi_transfer(SPIDEV_MCP6S93_6ADC, sizeof(data), &data, NULL) != SUCCESS);
  96               }
  97         %endforeach
  98         %<err_flag> = err;
  99       }
 100     %endif
 101
 102 %endfunction
 103
 104
 105 %% [EOF]