pocketcmd.c

Go to the documentation of this file.

#include "pocketcmd.h"
#include "pocketbus.h"

#include <cfg/macros.h>
#include <cfg/debug.h>
#include <cfg/module.h>

#include <drv/timer.h>

#include <cpu/byteorder.h>
#include <cpu/detect.h>

#include <string.h>

void pocketcmd_poll(struct PocketCmdCtx *ctx)
{
    PocketMsg msg;

    /* Try to read a packet from pocketBus */
    while (pocketbus_recv(ctx->bus_ctx, &msg))
    {
        /* Check address */
        if (msg.addr == ctx->addr ||
            msg.addr == POCKETBUS_BROADCAST_ADDR)
        {

            #if CPU_AVR
                const PocketCmdHdr *hdr = (const PocketCmdHdr *)msg.payload;
            #else
                #if !CPU_ARM
                    #warning Fix alignment problem..
                    /*
                     * The code below make one memcopy, this the only way to
                     * solve alignment problem on ARM. If you are use other
                     * architecture you should find other way to optimize
                     * this code.
                     */
                #endif
                PocketCmdHdr hd;
                memcpy(&hd, msg.payload, sizeof(PocketCmdHdr));
                const PocketCmdHdr *hdr =  &hd;
            #endif

            pocketcmd_t cmd = be16_to_cpu(hdr->cmd);

            /* We're no longer waiting for a reply (in case we were) */
            if (cmd == ctx->waiting)
                ctx->waiting = PKTCMD_NULL;

            /* Check for command callback */
            pocketcmd_hook_t callback = ctx->search(cmd);

            /* Call it if exists */
            if (callback)
            {
                PocketCmdMsg cmd_msg;

                cmd_msg.cmd_ctx = ctx;
                cmd_msg.cmd = cmd;
                cmd_msg.len = msg.len - sizeof(PocketCmdHdr);
                cmd_msg.buf = msg.payload + sizeof(PocketCmdHdr);

                callback(&cmd_msg);
            }
        }
    }
}

bool pocketcmd_send(struct PocketCmdCtx *ctx, pocketcmd_t cmd, const void *buf, size_t len, bool wait_reply)
{
    /* Check if we are waiting a reply from someone */
    if (ctx->waiting != PKTCMD_NULL)
    {
        /* Check is reply timeout is elapsed */
        if (timer_clock() - ctx->reply_timer < ms_to_ticks(PKTCMD_REPLY_TIMEOUT))
        {
            TRACEMSG("Pkt discard! waiting cmd[%04X]\n", ctx->waiting);
            return false;
        }
        else
        {
            TRACEMSG("Timeout waiting cmd[%04X]\n", ctx->waiting);
            ctx->waiting = PKTCMD_NULL;
        }
    }

    /* Endianess! */
    cmd = cpu_to_be16(cmd);

    /* Send packet */
    pocketbus_begin(ctx->bus_ctx, ctx->addr);
    pocketbus_write(ctx->bus_ctx, &cmd, sizeof(cmd));
    pocketbus_write(ctx->bus_ctx, buf, len);
    pocketbus_end(ctx->bus_ctx);

    if (wait_reply)
    {
        ctx->waiting = cmd;
        ctx->reply_timer = timer_clock();
    }
    return true;
}

void pocketcmd_init(struct PocketCmdCtx *ctx, struct PocketBusCtx *bus_ctx, pocketbus_addr_t addr, pocketcmd_lookup_t search)
{
    ASSERT(ctx);
    ASSERT(bus_ctx);
    ASSERT(search);
    MOD_CHECK(timer);

    memset(ctx, 0, sizeof(*ctx));
    ctx->bus_ctx = bus_ctx;
    ctx->search = search;
    pocketcmd_setAddr(ctx, addr);
}

void pocketcmd_replyAck(struct PocketCmdMsg *msg)
{
    uint8_t ack[] = { POCKETBUS_ACK };

    pocketcmd_slaveReply(msg->cmd_ctx, msg->cmd, ack, sizeof(ack));
}

void pocketcmd_replyNak(struct PocketCmdMsg *msg)
{
    uint8_t nak[] = { POCKETBUS_NAK };

    pocketcmd_slaveReply(msg->cmd_ctx, msg->cmd, nak, sizeof(nak));
}