fprime/Autocoders/Python/test/command_string/TestCommandSourceImpl.cpp

/*
 * TestCommand1Impl.cpp
 *
 *  Created on: Mar 28, 2014
 *      Author: tcanham
 */

#include <Autocoders/Python/test/command_string/TestCommandSourceImpl.hpp>
#include <stdio.h>


#if FW_OBJECT_NAMES == 1
TestCommandSourceImpl::TestCommandSourceImpl(const char* name) : Cmd::CommandTesterComponentBase(name)
#else
TestCommandSourceImpl::TestCommandSourceImpl()
#endif
{
}

TestCommandSourceImpl::~TestCommandSourceImpl() {
}

void TestCommandSourceImpl::cmdStatusPort_handler(
        NATIVE_INT_TYPE portNum, FwOpcodeType opCode, U32 cmdSeq,
        Fw::CommandResponse response) {
    this->printStatus(response);
}

void TestCommandSourceImpl::cmdRegPort_handler(NATIVE_INT_TYPE portNum, FwOpcodeType opCode) {
    printf("Received registration for opcode %d\n",opCode);
}

void TestCommandSourceImpl::init(void) {
    Cmd::CommandTesterComponentBase::init();
}

void TestCommandSourceImpl::printStatus(Fw::CommandResponse response) {
    switch (response) {
        case Fw::COMMAND_OK:
            printf("COMMAND OK\n");
            break;
        case Fw::COMMAND_INVALID_OPCODE:
            printf("INVALID OPCODE\n");
            break;
        case Fw::COMMAND_VALIDATION_ERROR:
            printf("VALIDATION ERROR\n");
            break;
        case Fw::COMMAND_FORMAT_ERROR:
            printf("FORMAT ERROR\n");
            break;
        case Fw::COMMAND_EXECUTION_ERROR:
            printf("EXECUTION ERROR\n");
            break;
        default:
            printf("Unknown status %d\n", response);
            break;
    }
}

void TestCommandSourceImpl::test_TEST_CMD_1(I32 arg1, const Fw::CmdStringArg& arg2, I32 arg3) {

    // serialize parameters
    if (!this->isConnected_cmdSendPort_OutputPort(0)) {
        printf("Test command port not connected.");
        return;
    }

    Fw::CmdArgBuffer argBuff;

    // do nominal case

    argBuff.serialize(arg1);
    argBuff.serialize(arg2);
    argBuff.serialize(arg3);

    this->cmdSendPort_out(0, 0x100, 1, argBuff);
return;
    // wrong value

//    argBuff.resetToStart();
//    argBuff.serialize(arg1);
//    argBuff.serialize(arg2+1);
//
//    this->cmdSendPort_FwCmd_out(0, 0x100, 1, argBuff);
//
//    // too many arguments
//    argBuff.resetToStart();
//
//    argBuff.serialize(arg1);
//    argBuff.serialize(arg2);
//    argBuff.serialize(arg2);
//
//    this->cmdSendPort_FwCmd_out(0, 0x100, 1, argBuff);
//
//    // too few arguments
//    argBuff.resetToStart();
//
//    argBuff.serialize(arg1);
//
//    this->cmdSendPort_FwCmd_out(0, 0x100, 1, argBuff);
}