kpc9612p_lib.cpp File Reference

#include "device/general/kpc9612p_lib.h"

Include dependency graph for kpc9612p_lib.cpp:

Functions
uint16_t	kpc9612p_calc_fcs (uint8_t *data, uint16_t length)
int32_t	kpc9612p_connect (char *dev, kpc9612p_handle *handle, uint8_t flag)
int32_t	kpc9612p_disconnect (kpc9612p_handle *handle)
int32_t	kpc9612p_recvframe (kpc9612p_handle *handle)
int32_t	kpc9612p_sendframe (kpc9612p_handle *handle)
int32_t	kpc9612p_loadframe (kpc9612p_handle *handle, uint8_t *data, uint16_t size)
int32_t	kpc9612p_loadframe (kpc9612p_handle *handle, vector< uint8_t > data)
int32_t	kpc9612p_unloadframe (kpc9612p_handle *handle, uint8_t *data, uint16_t size)
int32_t	kpc9612p_unloadframe (kpc9612p_handle *handle, vector< uint8_t > &data)
int32_t	kpc9612p_exitkiss (kpc9612p_handle *handle)
int32_t	kpc9612p_enterkiss (kpc9612p_handle *handle)
int32_t	kpc9612p_entercmd (kpc9612p_handle *handle)

Variables
uint16_t	kpc9612p_fcstab [256]

Function Documentation

uint16_t kpc9612p_calc_fcs	(	uint8_t *	data,
		uint16_t	length
	)

{   uint16_t fcs;

    fcs = 0xffff;
    while (length--)
    {   fcs = (fcs >> 8) ^ kpc9612p_fcstab[(fcs ^ ((uint16_t)*data)) & 0xff];
        data++;
    }
    return (~fcs);
}

int32_t kpc9612p_connect	(	char *	dev,
		kpc9612p_handle *	handle,
		uint8_t	flag
	)

{
    int32_t iretn;
    cssl_start();
    handle->serial = cssl_open(dev,KPC9612P_BAUD, KPC9612P_BITS,KPC9612P_PARITY,KPC9612P_STOPBITS);
    if (handle->serial == NULL) return (CSSL_ERROR_OPEN);
    cssl_settimeout(handle->serial, 0, 1.);
    cssl_setflowcontrol(handle->serial, 0, 0);
    handle->flag = flag;

    iretn = kpc9612p_entercmd(handle);
    if (iretn < 0)
    {
        return iretn;
    }

    iretn = kpc9612p_enterkiss(handle);
    if (iretn < 0)
    {
        return iretn;
    }

    return 0;
}

int32_t kpc9612p_disconnect

(

kpc9612p_handle *

handle

)

{
    if (handle->serial == NULL) return (CSSL_ERROR_NOTSTARTED);

    cssl_close(handle->serial);
    return 0;
}

int32_t kpc9612p_recvframe

(

kpc9612p_handle *

handle

)

{
    int32_t iretn;

    iretn = cssl_getslip(handle->serial, handle->frame.full, KPC9612P_FULL_SIZE);
    if (iretn >= 0)
    {
        //      int16_t ch = cssl_getchar(handle->serial);
        //      ch = cssl_getchar(handle->serial);
        handle->frame.size = iretn;
    }
    else
    {
        handle->frame.size = 0;
    }

    return iretn;
}

int32_t kpc9612p_sendframe

(

kpc9612p_handle *

handle

)

{
    int32_t iretn;

    handle->frame.part.header.flag = handle->flag;
    iretn = cssl_putslip(handle->serial, handle->frame.full, handle->frame.size);

    return iretn;
}

int32_t kpc9612p_loadframe	(	kpc9612p_handle *	handle,
		uint8_t *	data,
		uint16_t	size
	)

{
    uint16_t tsize;
    //  uint16_t fcs;

    handle->frame.part.header.flag = handle->flag;
    handle->frame.part.header.protocol_id = AX25_NOLAYER3;
    memcpy(handle->frame.part.header.destination_address,(char *)"ABCDEFG",7);
    memcpy(handle->frame.part.header.source_address,(char *)"GROUND ",7);
    for (uint16_t i=0; i<7; ++i)
    {
        handle->frame.part.header.destination_address[i] <<= 1;
        handle->frame.part.header.source_address[i] <<= 1;
    }
    tsize = (size <= KPC9612P_PAYLOAD_SIZE?size:KPC9612P_PAYLOAD_SIZE);
    //  handle->frame.size = tsize + 19;
    handle->frame.size = tsize + 17;
    memcpy(handle->frame.part.payload, data, tsize);
    //  fcs = kpc9612p_calc_fcs(handle->frame.full, handle->frame.size);
    //  handle->frame.part.payload[tsize] = fcs%256;
    //  handle->frame.part.payload[tsize+1] = fcs>>8;
    //  handle->frame.part.payload[tsize+2] = AX25_FLAG;

    return (tsize);
}

int32_t kpc9612p_loadframe	(	kpc9612p_handle *	handle,
		vector< uint8_t >	data
	)

{
    uint16_t tsize;
    //  uint16_t fcs;

    handle->frame.part.header.flag = handle->flag;
    handle->frame.part.header.protocol_id = AX25_NOLAYER3;
    memcpy(handle->frame.part.header.destination_address,(char *)"ABCDEFG",7);
    memcpy(handle->frame.part.header.source_address,(char *)"GROUND ",7);
    for (uint16_t i=0; i<7; ++i)
    {
        handle->frame.part.header.destination_address[i] <<= 1;
        handle->frame.part.header.source_address[i] <<= 1;
    }
    tsize = (data.size() <= KPC9612P_PAYLOAD_SIZE?data.size():KPC9612P_PAYLOAD_SIZE);
    //  handle->frame.size = tsize + 19;
    handle->frame.size = tsize + 17;
    memcpy(handle->frame.part.payload, &data[0], tsize);
    //  fcs = kpc9612p_calc_fcs(handle->frame.full, handle->frame.size);
    //  handle->frame.part.payload[tsize] = fcs%256;
    //  handle->frame.part.payload[tsize+1] = fcs>>8;
    //  handle->frame.part.payload[tsize+2] = AX25_FLAG;

    return (tsize);
}

int32_t kpc9612p_unloadframe	(	kpc9612p_handle *	handle,
		uint8_t *	data,
		uint16_t	size
	)

{
    uint16_t tsize;

    tsize = (handle->frame.size-17 <= size?handle->frame.size-17:size);
    memcpy(data, handle->frame.part.payload, tsize);
    data[tsize] = 0;
    return (tsize);
}

int32_t kpc9612p_unloadframe	(	kpc9612p_handle *	handle,
		vector< uint8_t > &	data
	)

{
    uint16_t tsize;

    if (handle->frame.size >= 17)
    {
        tsize = handle->frame.size-17;
        data.resize(tsize);
        memcpy(&data[0], handle->frame.part.payload, tsize);
    }
    else
    {
        tsize = 0;
        data.resize(tsize);
    }
    return (tsize);
}

int32_t kpc9612p_exitkiss

(

kpc9612p_handle *

handle

)

{
    cssl_putchar(handle->serial, 0xc0);
    cssl_putchar(handle->serial, 0xff);
    cssl_putchar(handle->serial, 0xc0);
    COSMOS_SLEEP(1.);
    cssl_putchar(handle->serial, '\r');
    return 0;
}

int32_t kpc9612p_enterkiss

(

kpc9612p_handle *

handle

)

{
    cssl_putstring(handle->serial, (char *)"INTFACE KISS\r");
    cssl_putstring(handle->serial, (char *)"RESET\r");
    return 0;
}

int32_t kpc9612p_entercmd

(

kpc9612p_handle *

handle

)

{
    int32_t iretn;
    uint8_t buffer[256];

    // Check if we are in COMMAND mode already
    cssl_drain(handle->serial);
    iretn = cssl_putchar(handle->serial, '\r');
    if (iretn < 0)
    {
        return iretn;
    }
    iretn = cssl_getdata(handle->serial, buffer, 255);
    if (iretn < 0)
    {
        return iretn;
    }
    if (iretn > 4 && !strcmp((char *)&buffer[iretn-4], "cmd:"))
    {
        return 0;
    }
    // If not, check if we are in KISS mode
    iretn = kpc9612p_exitkiss(handle);
    if (iretn < 0)
    {
        return iretn;
    }
    iretn = cssl_getdata(handle->serial, buffer, 255);
    if (iretn < 0)
    {
        return iretn;
    }
    if (iretn > 4 && !strcmp((char *)&buffer[iretn-4], "cmd:"))
    {
        return 0;
    }
    // If still not, check if we are in TRANSPARENT mode
    COSMOS_SLEEP(1.);
    iretn = cssl_putchar(handle->serial, 0x03);
    if (iretn < 0)
    {
        return iretn;
    }
    iretn = cssl_putchar(handle->serial, 0x03);
    if (iretn < 0)
    {
        return iretn;
    }
    iretn = cssl_putchar(handle->serial, 0x03);
    if (iretn < 0)
    {
        return iretn;
    }
    COSMOS_SLEEP(1.);
    iretn = cssl_getdata(handle->serial, buffer, 255);
    if (iretn < 0)
    {
        return iretn;
    }
    if (iretn > 4 && !strcmp((char *)&buffer[iretn-4], "cmd:"))
    {
        return 0;
    }
    // Failure
    return GENERAL_ERROR_UNDEFINED;
}

Variable Documentation

uint16_t kpc9612p_fcstab[256]