S2LP_PktWMbus.c

Go to the documentation of this file.

/* Includes ------------------------------------------------------------------*/
#include "S2LP_PktWMbus.h"
#include "MCU_Interface.h"

#define PKT_FORMAT_WMBUS_CODE                   0x00

#define WMBUS_PREAMBLE_LEN_S1S2LONGHEADER           (uint16_t)279
#define WMBUS_PREAMBLE_LEN_S1MS2T2OTHERTOMETER      (uint16_t)15
#define WMBUS_PREAMBLE_LEN_T1T2METERTOOTHER         (uint16_t)19
#define WMBUS_PREAMBLE_LEN_R2                       (uint16_t)39
#define WMBUS_PREAMBLE_LEN_N1N2                     (uint16_t)8

#define WMBUS_SYNC_LEN_S1S2LONGHEADER               (uint8_t)18
#define WMBUS_SYNC_LEN_S1MS2T2OTHERTOMETER          (uint8_t)18
#define WMBUS_SYNC_LEN_T1T2METERTOOTHER             (uint8_t)10
#define WMBUS_SYNC_LEN_R2                           (uint8_t)18
#define WMBUS_SYNC_LEN_N1N2                         (uint16_t)16

#define WMBUS_SYNCWORD_S1S2LONGHEADER           (uint32_t)0xE25A4000
#define WMBUS_SYNCWORD_S1MS2T2OTHERTOMETER      (uint32_t)0xE25A4000
#define WMBUS_SYNCWORD_T1T2METERTOOTHER         (uint32_t)0x0F400000
#define WMBUS_SYNCWORD_R2                       (uint32_t)0xE25A4000
#define WMBUS_SYNCWORD_N1N2                     (uint32_t)0xf68d0000

#define IS_WMBUS_SUBMODE(MODE)   (((MODE) == WMBUS_SUBMODE_S1_S2_LONG_HEADER) || \
                                 ((MODE) == WMBUS_SUBMODE_NOT_CONFIGURED) || \
                                 ((MODE) == WMBUS_SUBMODE_S1_M_S2_T2_OTHER_TO_METER) || \
                                 ((MODE) == WMBUS_SUBMODE_T1_T2_METER_TO_OTHER) || \
                                 ((MODE) == WMBUS_SUBMODE_R2_SHORT_HEADER))

static WMbusSubmode s_cWMbusSubmode = WMBUS_SUBMODE_NOT_CONFIGURED;

void S2LPPktWMbusInit(PktWMbusInit* pxPktWMbusInit)
{
  uint8_t tmp;
  s_assert_param(IS_WMBUS_SUBMODE(pxPktWMbusInit->xWMbusSubmode));
  
  /* Packet format config */
  S2LPPktWMbusSetFormat();
  S2LPPktCommonFilterOnCrc(S_DISABLE);
  
  s_cWMbusSubmode = pxPktWMbusInit->xWMbusSubmode;
    
  if(s_cWMbusSubmode==WMBUS_SUBMODE_S1_S2_LONG_HEADER) {
    S2LPSetPreambleLength(((uint16_t)pxPktWMbusInit->cPreambleLength) + WMBUS_PREAMBLE_LEN_S1S2LONGHEADER);
    S2LPSetSyncLength(WMBUS_SYNC_LEN_S1S2LONGHEADER);
    S2LPSetSyncWords(WMBUS_SYNCWORD_S1S2LONGHEADER, WMBUS_SYNC_LEN_S1S2LONGHEADER);
    S2LPPacketHandlerManchester(S_ENABLE);
    
    /* Constellation map setting */
    S2LPSpiReadRegisters(MOD1_ADDR, 1, &tmp);
    tmp &= ~G4FSK_CONST_MAP_REGMASK;
    tmp |= (((uint8_t)2)<<4);
    S2LPSpiWriteRegisters(MOD1_ADDR, 1, &tmp); 
    
    S2LPSpiReadRegisters(0xF1, 1, &tmp);
    if((tmp&0xC0)==0xC0)
      S2LPPktWMbusSetPostamblePattern(0x01);
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_S1_M_S2_T2_OTHER_TO_METER) {
    S2LPSetPreambleLength(((uint16_t)pxPktWMbusInit->cPreambleLength) + WMBUS_PREAMBLE_LEN_S1MS2T2OTHERTOMETER);
    S2LPSetSyncLength(WMBUS_SYNC_LEN_S1MS2T2OTHERTOMETER);
    S2LPSetSyncWords(WMBUS_SYNCWORD_S1MS2T2OTHERTOMETER, WMBUS_SYNC_LEN_S1MS2T2OTHERTOMETER);
    S2LPPacketHandlerManchester(S_ENABLE);
    /* Constellation map setting */
    S2LPSpiReadRegisters(MOD1_ADDR, 1, &tmp);
    tmp &= ~G4FSK_CONST_MAP_REGMASK;
    tmp |= (((uint8_t)2)<<4);
    S2LPSpiWriteRegisters(MOD1_ADDR, 1, &tmp); 
    
    S2LPSpiReadRegisters(0xF1, 1, &tmp);
    if((tmp&0xC0)==0xC0)
      S2LPPktWMbusSetPostamblePattern(0x01);
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_T1_T2_METER_TO_OTHER) {
    S2LPSetPreambleLength(((uint16_t)pxPktWMbusInit->cPreambleLength) + WMBUS_PREAMBLE_LEN_T1T2METERTOOTHER);
    S2LPSetSyncLength(WMBUS_SYNC_LEN_T1T2METERTOOTHER);
    S2LPSetSyncWords(WMBUS_SYNCWORD_T1T2METERTOOTHER, WMBUS_SYNC_LEN_T1T2METERTOOTHER);
    S2LPPacketHandler3OutOf6(S_ENABLE);
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_R2_SHORT_HEADER) {
    S2LPSetPreambleLength(((uint16_t)pxPktWMbusInit->cPreambleLength) + WMBUS_PREAMBLE_LEN_R2);
    S2LPSetSyncLength(WMBUS_SYNC_LEN_R2);
    S2LPSetSyncWords(WMBUS_SYNCWORD_R2, WMBUS_SYNC_LEN_R2);
    S2LPPacketHandlerManchester(S_ENABLE);
    /* Constellation map setting */
    S2LPSpiReadRegisters(MOD1_ADDR, 1, &tmp);
    tmp &= ~G4FSK_CONST_MAP_REGMASK;
    tmp |= (((uint8_t)2)<<4);
    S2LPSpiWriteRegisters(MOD1_ADDR, 1, &tmp); 
  }
  
  
  S2LPPktWMbusSetPostamble(pxPktWMbusInit->cPostambleLength);  
}

void S2LPPktWMbusGetInfo(PktWMbusInit* pxPktWMbusInit)
{
  uint16_t tmp;
  
  tmp = S2LPGetPreambleLength();
  
  if(s_cWMbusSubmode==WMBUS_SUBMODE_S1_S2_LONG_HEADER) {
    if(tmp>=WMBUS_PREAMBLE_LEN_S1S2LONGHEADER)
      tmp -= WMBUS_PREAMBLE_LEN_S1S2LONGHEADER;
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_S1_M_S2_T2_OTHER_TO_METER) {
    if(tmp>=WMBUS_PREAMBLE_LEN_S1MS2T2OTHERTOMETER)
    tmp -= WMBUS_PREAMBLE_LEN_S1MS2T2OTHERTOMETER;
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_T1_T2_METER_TO_OTHER) {
    if(tmp>=WMBUS_PREAMBLE_LEN_T1T2METERTOOTHER)
    tmp -= WMBUS_PREAMBLE_LEN_T1T2METERTOOTHER;
  }
  else if(s_cWMbusSubmode==WMBUS_SUBMODE_R2_SHORT_HEADER) {
    if(tmp>=WMBUS_PREAMBLE_LEN_R2)
    tmp -= WMBUS_PREAMBLE_LEN_R2;
  }
  
  pxPktWMbusInit->cPreambleLength = (uint8_t)tmp;
  pxPktWMbusInit->cPostambleLength = S2LPPktWMbusGetPostamble();
  pxPktWMbusInit->xWMbusSubmode = s_cWMbusSubmode;

}


void S2LPPktWMbusSetFormat(void)
{
  uint8_t tmpBuffer[4] = {0,0,0,0};

  /* Configure the WMBUS mode packet format and reset all the other setting */
  tmpBuffer[1] |= PKT_FORMAT_WMBUS_CODE;
  g_xStatus = S2LPSpiWriteRegisters(PCKTCTRL4_ADDR, 4, tmpBuffer);

}



void S2LPPktWMbusSetPostamble(uint8_t cPostamble)
{
  uint8_t tmp;
  g_xStatus = S2LPSpiReadRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
  tmp  = (tmp & 0xC0) | cPostamble;
  g_xStatus = S2LPSpiWriteRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
}


void S2LPPktWMbusSetPostamblePattern(uint8_t cPostamble)
{
  uint8_t tmp;
  g_xStatus = S2LPSpiReadRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
  tmp  = (tmp & 0x3F) | (cPostamble<<6);
  g_xStatus = S2LPSpiWriteRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
}


uint8_t S2LPPktWMbusGetPostamble(void)
{
  uint8_t tmp;
  g_xStatus = S2LPSpiReadRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
  return (tmp & 0x3F);
}


uint8_t S2LPPktWMbusGetPostamblePattern(void)
{
  uint8_t tmp;
  g_xStatus = S2LPSpiReadRegisters(PCKT_PSTMBL_ADDR, 1, &tmp);
  return ((tmp & 0xC0)>>6);
}


void S2LPPktWMbusSetSubmode(WMbusSubmode xWMbusSubmode)
{
  s_cWMbusSubmode = xWMbusSubmode;
}


WMbusSubmode S2LPPktWMbusGetSubmode(void)
{
  return s_cWMbusSubmode;
}


void S2LPPktWMbusSetPayloadLength(uint16_t nPayloadLength)
{
  uint8_t tmpBuffer[2];

  tmpBuffer[0] = (uint8_t)(nPayloadLength>>8);
  tmpBuffer[1] = (uint8_t)nPayloadLength;
  g_xStatus = S2LPSpiWriteRegisters(PCKTLEN1_ADDR, 2, tmpBuffer);
}


uint16_t S2LPPktWMbusGetPayloadLength(void)
{
  uint8_t tmpBuffer[2];
  uint16_t nPayloadLength;

  g_xStatus = S2LPSpiReadRegisters(PCKTLEN1_ADDR, 2, tmpBuffer);
  nPayloadLength = (((uint16_t)tmpBuffer[0])<<8) | ((uint16_t)tmpBuffer[1]);
  
  return nPayloadLength;
}

/******************* (C) COPYRIGHT 2016 STMicroelectronics *****END OF FILE****/