/* ----------------------------------------------------------------------------
 * Copyright (c) Huawei Technologies Co., Ltd. 2013-2020. All rights reserved.
 * Description: Liblwm2m
 * Author: Huawei LiteOS Team
 * Create: 2013-01-01
 * Redistribution and use in source and binary forms, with or without modification,
 * are permitted provided that the following conditions are met:
 * 1. Redistributions of source code must retain the above copyright notice, this list of
 * conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright notice, this list
 * of conditions and the following disclaimer in the documentation and/or other materials
 * provided with the distribution.
 * 3. Neither the name of the copyright holder nor the names of its contributors may be used
 * to endorse or promote products derived from this software without specific prior written
 * permission.
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 * --------------------------------------------------------------------------- */

/*******************************************************************************
 *
 * Copyright (c) 2013, 2014 Intel Corporation and others.
 * All rights reserved. This program and the accompanying materials
 * are made available under the terms of the Eclipse Public License v1.0
 * and Eclipse Distribution License v1.0 which accompany this distribution.
 *
 * The Eclipse Public License is available at
 *    http://www.eclipse.org/legal/epl-v10.html
 * The Eclipse Distribution License is available at
 *    http://www.eclipse.org/org/documents/edl-v10.php.
 *
 * Contributors:
 *    David Navarro, Intel Corporation - initial API and implementation
 *    Fabien Fleutot - Please refer to git log
 *    Simon Bernard - Please refer to git log
 *    Toby Jaffey - Please refer to git log
 *    Pascal Rieux - Please refer to git log
 *
 *******************************************************************************/

/*
 Copyright (c) 2013, 2014 Intel Corporation

 Redistribution and use in source and binary forms, with or without modification,
 are permitted provided that the following conditions are met:

     * Redistributions of source code must retain the above copyright notice,
       this list of conditions and the following disclaimer.
     * Redistributions in binary form must reproduce the above copyright notice,
       this list of conditions and the following disclaimer in the documentation
       and/or other materials provided with the distribution.
     * Neither the name of Intel Corporation nor the names of its contributors
       may be used to endorse or promote products derived from this software
       without specific prior written permission.

 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
 ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
 INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
 BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
 LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
 OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
 THE POSSIBILITY OF SUCH DAMAGE.

 David Navarro <david.navarro@intel.com>

*/

#include "internals.h"
#include "osdepends/atiny_osdep.h"
#include <stdlib.h>
#include <string.h>

#include <stdio.h>


lwm2m_context_t *lwm2m_init(void *userData)
{
    lwm2m_context_t *contextP;

    LOG("Entering");
    contextP = (lwm2m_context_t *)lwm2m_malloc(sizeof(lwm2m_context_t));
    if (NULL != contextP)
    {
        memset(contextP, 0, sizeof(lwm2m_context_t));
        contextP->userData = userData;
        lwm2m_rand((void *)&contextP->nextMID, sizeof(contextP->nextMID));
    }

    return contextP;
}

#ifdef LWM2M_CLIENT_MODE


static lwm2m_event_handler_t event_handler = NULL;
void lwm2m_register_event_handler(lwm2m_event_handler_t callback)
{
    event_handler = callback;
}

void lwm2m_notify_even(module_type_t type, int code, const char *arg, int arg_len)
{
    if(event_handler != NULL)
    {
        event_handler(type, code, arg, arg_len);
    }
}

void lwm2m_deregister(lwm2m_context_t *context)
{
    lwm2m_server_t *server = context->serverList;

    LOG("Entering");
    while (NULL != server)
    {
        registration_deregister(context, server);
        server = server->next;
    }
}

static void prv_deleteServer(lwm2m_server_t *serverP, void *userData)
{
    // TODO parse transaction and observation to remove the ones related to this server
    if (serverP->sessionH != NULL)
    {
        lwm2m_close_connection(serverP->sessionH, userData);
    }
    if (NULL != serverP->location)
    {
        lwm2m_free(serverP->location);
    }
    free_block1_buffer(serverP->block1Data);
    lwm2m_free(serverP);
}

static void prv_deleteServerList(lwm2m_context_t *context)
{
    while (NULL != context->serverList)
    {
        lwm2m_server_t *server;
        server = context->serverList;
        context->serverList = server->next;
        prv_deleteServer(server, context->userData);
    }
}

#ifdef LWM2M_BOOTSTRAP
static void prv_deleteBootstrapServer(lwm2m_server_t *serverP, void *userData)
{
    // TODO should we free location as in prv_deleteServer ?
    // TODO should we parse transaction and observation to remove the ones related to this server ?
    if (serverP->sessionH != NULL)
    {
        lwm2m_close_connection(serverP->sessionH, userData);
    }
    free_block1_buffer(serverP->block1Data);
    lwm2m_free(serverP);
}

static void prv_deleteBootstrapServerList(lwm2m_context_t *context)
{
    while (NULL != context->bootstrapServerList)
    {
        lwm2m_server_t *server;
        server = context->bootstrapServerList;
        context->bootstrapServerList = server->next;
        lwm2m_stop_striger_server_initiated_bs(server->sessionH);
        prv_deleteBootstrapServer(server, context->userData);
    }
}
#endif

static void prv_deleteObservedList(lwm2m_context_t *contextP)
{
    atiny_mutex_lock(contextP->observe_mutex);
    while (NULL != contextP->observedList)
    {
        lwm2m_observed_t *targetP;
        lwm2m_watcher_t *watcherP;

        targetP = contextP->observedList;
        contextP->observedList = contextP->observedList->next;

        lwm2m_notify_even(MODULE_URI, OBSERVE_UNSUBSCRIBE, (char *) & (targetP->uri), sizeof(targetP->uri));

        for (watcherP = targetP->watcherList ; watcherP != NULL ; watcherP = watcherP->next)
        {
            if (watcherP->parameters != NULL) lwm2m_free(watcherP->parameters);
        }
        LWM2M_LIST_FREE(targetP->watcherList);

        lwm2m_free(targetP);
    }
    atiny_mutex_unlock(contextP->observe_mutex);
}
#endif

void prv_deleteTransactionList(lwm2m_context_t *context)
{
    while (NULL != context->transactionList)
    {
        lwm2m_transaction_t *transaction;

        transaction = context->transactionList;
        context->transactionList = context->transactionList->next;
        if (transaction->callback != NULL)
        {
            transaction->callback(transaction, NULL);
        }
        transaction_free(transaction);
    }
}

void lwm2m_close(lwm2m_context_t *contextP)
{
#ifdef LWM2M_CLIENT_MODE

    LOG("Entering");
    lwm2m_deregister(contextP);
    prv_deleteServerList(contextP);
#ifdef LWM2M_BOOTSTRAP
    prv_deleteBootstrapServerList(contextP);
#endif
    prv_deleteObservedList(contextP);
    lwm2m_free(contextP->endpointName);
    //lwm2m_free(contextP->bs_server_uri);
    if (contextP->msisdn != NULL)
    {
        lwm2m_free(contextP->msisdn);
    }
    if (contextP->altPath != NULL)
    {
        lwm2m_free(contextP->altPath);
    }

#endif

#ifdef LWM2M_SERVER_MODE
    while (NULL != contextP->clientList)
    {
        lwm2m_client_t *clientP;

        clientP = contextP->clientList;
        contextP->clientList = contextP->clientList->next;

        registration_freeClient(clientP);
    }
#endif

    prv_deleteTransactionList(contextP);
    lwm2m_free(contextP);
}


static bool prv_isBoostrpEnable(const lwm2m_context_t *contextP)
{
#ifdef LWM2M_BOOTSTRAP
    return contextP->bsCtrl.bsType != BOOTSTRAP_FACTORY;
#else
    return false;
#endif
}

/* BsCtrl bootstrap control is used to control the register(factory bootstrap(FBS)), client initiated bootstrap(CIBS),
and server initiated bootstrap(CIBS).it try max time to register and the change to bootstrap(CIBS and SIBS) as the bs type.
the state is STATE_REGISTER_REQUIRED, STATE_BOOTSTRAP_REQUIRED and STATE_NON. CIBS is only state is STATE_BOOTSTRAP_REQUIRED,
,cnt is 0 and bs type is BOOTSTRAP_SEQUENCE. cnt is used to calculte the delay for the next retry.
Delay(cnt) = Base + Interval * cnt; Base and Interval are configured by different macros.
*/
bool lwm2m_isBsCtrlInServerInitiatedBs(const lwm2m_context_t *contextP)
{
    return (contextP->bsCtrl.bsType == BOOTSTRAP_SEQUENCE) && (contextP->bsCtrl.cnt == 0);
}

void lwm2m_initBsCtrlStat(lwm2m_context_t *contextP, lwm2m_bootstrap_type_e bs_type)
{
    memset(&contextP->bsCtrl, 0, sizeof(contextP->bsCtrl));
    contextP->bsCtrl.bsType = bs_type;
    contextP->bsCtrl.state = STATE_INITIAL;
}

static void lwm2m_setBsCtrlStatWithoutCheck(lwm2m_context_t *contextP, lwm2m_client_state_t state)
{
    if (contextP->bsCtrl.state != state)
    {
        contextP->bsCtrl.state = state;
        contextP->bsCtrl.cnt = 0;
        return;
    }
    {
        uint32_t maxValue = ((STATE_REGISTER_REQUIRED == state)
                            ? MAX_FACTORY_BS_RETRY_CNT : MAX_CLIENT_INITIATED_BS_RETRY_CNT);

        if ((STATE_BOOTSTRAP_REQUIRED == state) && (BOOTSTRAP_SEQUENCE == contextP->bsCtrl.bsType))
        {
            maxValue++;
        }
        if(++(contextP->bsCtrl.cnt) >= maxValue)
        {
            contextP->bsCtrl.state = ((STATE_REGISTER_REQUIRED == contextP->bsCtrl.state)
                                     ? STATE_BOOTSTRAP_REQUIRED :STATE_REGISTER_REQUIRED);
            contextP->bsCtrl.cnt = 0;
        }
    }

}

void lwm2m_setBsCtrlStat(lwm2m_context_t *contextP, lwm2m_client_state_t state)
{
    lwm2m_client_state_t oldState = contextP->bsCtrl.state;
    uint32_t oldCnt = contextP->bsCtrl.cnt;

    lwm2m_setBsCtrlStatWithoutCheck(contextP, state);

    if (STATE_REGISTER_REQUIRED == contextP->bsCtrl.state)
    {
        if (contextP->serverList == NULL)
        {
            contextP->bsCtrl.state = STATE_BOOTSTRAP_REQUIRED;
            contextP->bsCtrl.cnt = 0;
        }
    }

    if (STATE_BOOTSTRAP_REQUIRED == contextP->bsCtrl.state)
    {
        if ((!prv_isBoostrpEnable(contextP))
            || (contextP->bootstrapServerList == NULL))
        {
            contextP->bsCtrl.state = STATE_REGISTER_REQUIRED;
            contextP->bsCtrl.cnt = 0;
            goto END;
        }

        // bootstrapServerList not empty, int CIBS but bs ip not valid.
        if((!lwm2m_isBsCtrlInServerInitiatedBs(contextP))
            #if defined(LWM2M_BOOTSTRAP)
               && (!bootstrap_isBsServerIpValid(contextP))
            #endif
            )
        {
            //FBS
            if (contextP->serverList)
            {
                contextP->bsCtrl.state = STATE_REGISTER_REQUIRED;
                contextP->bsCtrl.cnt = 0;
            }
            // only in SIBS
            else if ((contextP->serverList == NULL) && (contextP->bsCtrl.bsType == BOOTSTRAP_SEQUENCE))
            {
                contextP->bsCtrl.cnt = 0;
            }
            else
            {
            }
        }
    }
END:
    if ((oldState != contextP->bsCtrl.state)
        || (oldCnt != contextP->bsCtrl.cnt))
    {
        LOG_ARG("bsctrlstat (%d,%d) to (%d,%d)", oldState, oldCnt,
                    contextP->bsCtrl.state, contextP->bsCtrl.cnt);
    }

}

static void lwm2m_delayBsRetry(lwm2m_context_t *contextP)
{
    uint32_t delayBase;
    uint32_t delayInterval;
    uint32_t cnt = contextP->bsCtrl.cnt;
    uint32_t expireTime;

    if (contextP->bsCtrl.state == STATE_REGISTER_REQUIRED)
    {
        delayBase = FACTORY_BS_DELAY_BASE;
        delayInterval = FACTORY_BS_DELAY_INTERVAL;
    }
    else
    {
        delayBase = CLIENT_INITIATED_BS_DELAY_BASE;
        delayInterval = CLIENT_INITIATED_BS_DELAY_INTERVAL;
        if ((contextP->bsCtrl.bsType == BOOTSTRAP_SEQUENCE) && (cnt > 0))
        {
            cnt--;
        }
    }

    expireTime = delayBase + delayInterval * cnt;
    if (expireTime > 0)
    {
        lwm2m_delay(expireTime);
    }
}

lwm2m_client_state_t lwm2m_getBsCtrlStat(const lwm2m_context_t *contextP)
{
    return contextP->bsCtrl.state;
}


#ifdef LWM2M_CLIENT_MODE
static int prv_refreshServerList(lwm2m_context_t *contextP)
{
    lwm2m_server_t *targetP;
    lwm2m_server_t *nextP;

    // Remove all servers marked as dirty
    targetP = contextP->bootstrapServerList;
    contextP->bootstrapServerList = NULL;
    while (targetP != NULL)
    {
        nextP = targetP->next;
        targetP->next = NULL;
        if (!targetP->dirty)
        {
            targetP->status = STATE_DEREGISTERED;
            contextP->bootstrapServerList = (lwm2m_server_t *)LWM2M_LIST_ADD(contextP->bootstrapServerList, targetP);
        }
        else
        {
            prv_deleteServer(targetP, contextP->userData);
        }
        targetP = nextP;
    }
    targetP = contextP->serverList;
    contextP->serverList = NULL;
    while (targetP != NULL)
    {
        nextP = targetP->next;
        targetP->next = NULL;
        if (!targetP->dirty)
        {
            // TODO: Should we revert the status to STATE_DEREGISTERED ?
            contextP->serverList = (lwm2m_server_t *)LWM2M_LIST_ADD(contextP->serverList, targetP);
        }
        else
        {
            prv_deleteServer(targetP, contextP->userData);
        }
        targetP = nextP;
    }

    return object_getServers(contextP, false);
}
//result = lwm2m_configure(lwm2mH, name, NULL, NULL, OBJ_COUNT, objArray)
int lwm2m_configure(lwm2m_context_t *contextP,
                    const char *endpointName,
                    const char *msisdn,
                    const char *altPath,
                    uint16_t numObject,
                    lwm2m_object_t *objectList[])
{
    int i;
    uint8_t found;

    //LOG_ARG("endpointName: \"%s\", msisdn: \"%s\", altPath: \"%s\", numObject: %d", endpointName, msisdn, altPath, numObject);
    // This API can be called only once for now
    if (contextP->endpointName != NULL || contextP->objectList != NULL) return COAP_400_BAD_REQUEST;

    if (endpointName == NULL) return COAP_400_BAD_REQUEST;
    if (numObject < 3) return COAP_400_BAD_REQUEST;
    // Check that mandatory objects are present
    found = 0;
    for (i = 0 ; i < numObject ; i++)
    {
        if(objectList[i] == NULL) // happens when undef CONFIG_FEATURE_FOTA
            continue;
        if (objectList[i]->objID == LWM2M_SECURITY_OBJECT_ID) found |= 0x01;
        if (objectList[i]->objID == LWM2M_SERVER_OBJECT_ID) found |= 0x02;
        if (objectList[i]->objID == LWM2M_DEVICE_OBJECT_ID) found |= 0x04;
    }
    if (found != 0x07) return COAP_400_BAD_REQUEST;
    if (altPath != NULL)
    {
        if (0 == utils_isAltPathValid(altPath))
        {
            return COAP_400_BAD_REQUEST;
        }
        if (altPath[1] == 0)
        {
            altPath = NULL;
        }
    }
    contextP->endpointName = lwm2m_strdup(endpointName);
    if (contextP->endpointName == NULL)
    {
        return COAP_500_INTERNAL_SERVER_ERROR;
    }

    if (msisdn != NULL)
    {
        contextP->msisdn = lwm2m_strdup(msisdn);
        if (contextP->msisdn == NULL)
        {
            return COAP_500_INTERNAL_SERVER_ERROR;
        }
    }

    if (altPath != NULL)
    {
        contextP->altPath = lwm2m_strdup(altPath);
        if (contextP->altPath == NULL)
        {
            return COAP_500_INTERNAL_SERVER_ERROR;
        }
    }

    for (i = 0; i < numObject; i++)
    {
        if(objectList[i] == NULL) // happens when undef CONFIG_FEATURE_FOTA
            continue;
        objectList[i]->next = NULL;
        contextP->objectList = (lwm2m_object_t *)LWM2M_LIST_ADD(contextP->objectList, objectList[i]);
    }

    return COAP_NO_ERROR;
}

int lwm2m_add_object(lwm2m_context_t *contextP,
                     lwm2m_object_t *objectP)
{
    lwm2m_object_t *targetP;

    LOG_ARG("ID: %d", objectP->objID);
    targetP = (lwm2m_object_t *)LWM2M_LIST_FIND(contextP->objectList, objectP->objID);
    if (targetP != NULL) return COAP_406_NOT_ACCEPTABLE;
    objectP->next = NULL;

    contextP->objectList = (lwm2m_object_t *)LWM2M_LIST_ADD(contextP->objectList, objectP);

    if (contextP->state == STATE_READY)
    {
        return lwm2m_update_registration(contextP, 0, true);
    }

    return COAP_NO_ERROR;
}

int lwm2m_remove_object(lwm2m_context_t *contextP,
                        uint16_t id)
{
    lwm2m_object_t *targetP;

    LOG_ARG("ID: %d", id);
    contextP->objectList = (lwm2m_object_t *)LWM2M_LIST_RM(contextP->objectList, id, &targetP);

    if (targetP == NULL) return COAP_404_NOT_FOUND;

    if (contextP->state == STATE_READY)
    {
        return lwm2m_update_registration(contextP, 0, true);
    }

    return 0;
}


static void lwm2m_reset_register(lwm2m_context_t *context)
{
    lwm2m_server_t *server = context->serverList;

    LOG("Entering");
    while (NULL != server)
    {
        registration_reset(context, server);
        server = server->next;
    }
}

int lwm2m_reconnect(lwm2m_context_t *context)
{
    if(NULL == context)
    {
        LOG("context null point");
        return COAP_405_METHOD_NOT_ALLOWED;
    }

    lwm2m_reset_register(context);
    prv_deleteObservedList(context);
    prv_deleteTransactionList(context);
    lwm2m_setBsCtrlStat(context, STATE_REGISTER_REQUIRED);
    context->state = lwm2m_getBsCtrlStat(context);
    lwm2m_notify_even(MODULE_LWM2M, STATE_REG_FAILED, NULL, 0);
    return COAP_NO_ERROR;
}

int lwm2m_initBootStrap(lwm2m_context_t *contextP, lwm2m_bootstrap_type_e bsType)
{
    if (NULL == contextP)
    {
        LOG("context null point");
        return COAP_500_INTERNAL_SERVER_ERROR;
    }

    contextP->regist_first_flag = ((bsType == BOOTSTRAP_CLIENT_INITIATED) ? false : true);
    lwm2m_initBsCtrlStat(contextP, bsType);
    return COAP_NO_ERROR;
}

#endif



#define SET_BS_LATER(contextP, newState) \
do{\
    lwm2m_setBsCtrlStat(contextP, newState);\
    contextP->state = lwm2m_getBsCtrlStat(contextP);\
    lwm2m_delayBsRetry(contextP);\
}while(0)

int lwm2m_step(lwm2m_context_t *contextP,
               time_t *timeoutP)
{
    time_t tv_sec;
    int result;
    lwm2m_client_state_t state;
    int ret = 0;

    LOG_ARG("timeoutP: %" PRId64, *timeoutP);
    tv_sec = lwm2m_gettime();
    //if (tv_sec < 0) return COAP_500_INTERNAL_SERVER_ERROR;

#ifdef LWM2M_CLIENT_MODE
    LOG_ARG("State: %s", STR_STATE(contextP->state));
    // state can also be modified in bootstrap_handleCommand().

next_step:
    switch (contextP->state)
    {
    case STATE_INITIAL:
        if (0 != prv_refreshServerList(contextP))
        {
            LOG("prv_refreshServerList fail");
            return COAP_503_SERVICE_UNAVAILABLE;
        }

        state = ((!prv_isBoostrpEnable(contextP))
                 || ((contextP->serverList != NULL) && contextP->regist_first_flag)
                 ?  STATE_REGISTER_REQUIRED : STATE_BOOTSTRAP_REQUIRED);

        contextP->regist_first_flag = true;

        SET_BS_LATER(contextP, state);
        goto next_step;
    //break;

    case STATE_BOOTSTRAP_REQUIRED:
#ifdef LWM2M_BOOTSTRAP
        if (contextP->bootstrapServerList != NULL)
        {
            bootstrap_start(contextP);
            contextP->state = STATE_BOOTSTRAPPING;
            bootstrap_step(contextP, tv_sec, timeoutP);
            break;
        }
        else
#endif
        {
            SET_BS_LATER(contextP, STATE_BOOTSTRAP_REQUIRED);
            ret = COAP_503_SERVICE_UNAVAILABLE;
            break;
        }

#ifdef LWM2M_BOOTSTRAP
    case STATE_BOOTSTRAPPING:
        switch (bootstrap_getStatus(contextP))
        {
        case STATE_BS_FINISHED:
            contextP->state = STATE_INITIAL;
            lwm2m_setBsCtrlStat(contextP, STATE_INITIAL);
            goto next_step;
            break;

        case STATE_BS_FAILED:
            SET_BS_LATER(contextP, STATE_BOOTSTRAP_REQUIRED);
            ret = COAP_503_SERVICE_UNAVAILABLE;
            break;

        default:
            // keep on waiting
            bootstrap_step(contextP, tv_sec, timeoutP);
            break;
        }
        break;
#endif
    case STATE_REGISTER_REQUIRED:
        result = registration_start(contextP);
        LOG_ARG("[bootstrap_tag]: ---the return value result = %d of registration_start-----", result);
        if (COAP_NO_ERROR != result)
        {
            SET_BS_LATER(contextP, STATE_REGISTER_REQUIRED);
            ret = result;
            break;
        }
        contextP->state = STATE_REGISTERING;
        break;

    case STATE_REGISTERING:
    {
        switch (registration_getStatus(contextP))
        {
        case STATE_REGISTERED:
            contextP->state = STATE_READY;
            lwm2m_notify_even(MODULE_LWM2M, STATE_REGISTERED, NULL, 0);
            lwm2m_setBsCtrlStat(contextP, STATE_INITIAL);
            break;

        case STATE_REG_FAILED:
            // TODO avoid infinite loop by checking the bootstrap info is different
            //contextP->state = STATE_BOOTSTRAP_REQUIRED;

            lwm2m_notify_even(MODULE_LWM2M,STATE_REG_FAILED, NULL, 0);
            SET_BS_LATER(contextP, STATE_REGISTER_REQUIRED);

            break;

        case STATE_REG_PENDING:
        default:
            // keep on waiting
            break;
        }
    }
    break;

    case STATE_READY:
        if (registration_getStatus(contextP) == STATE_REG_FAILED)
        {
            // TODO avoid infinite loop by checking the bootstrap info is different
            //contextP->state = STATE_BOOTSTRAP_REQUIRED;
            contextP->state = STATE_REGISTER_REQUIRED;
            lwm2m_setBsCtrlStat(contextP, STATE_REGISTER_REQUIRED);
            goto next_step;
            //            break;
        }
        break;

    default:
        // do nothing
        break;
    }

    observe_step(contextP, tv_sec, timeoutP);
#endif

    registration_step(contextP, tv_sec, timeoutP);
    transaction_step(contextP, tv_sec, timeoutP);

    LOG_ARG("Final timeoutP: %" PRId64, *timeoutP);
#ifdef LWM2M_CLIENT_MODE
    LOG_ARG("Final state: %s", STR_STATE(contextP->state));
#endif
    return ret;
}
