GcStreamParser.cxx

 
#include <string>
 
#include "utils/GcStreamParser.hxx"
#include "utils/gc_format.h"
 
bool GcStreamParser::consume_byte(char c)
{
    if (c == ':')
    {
        // Frame is starting here.
        offset_ = 0;
        return false;
    }
    if (c == ';')
    {
        if (offset_ < 0)
        {
            return false;
        }
        // Frame ends here.
        cbuf_[offset_] = 0;
        offset_ = -1;
        return true;
    }
    if (offset_ >= static_cast<int>(sizeof(cbuf_) - 1))
    {
        // We overran the buffer, so this can't be a valid frame.
        // Reset and look for sync byte again.
        offset_ = -1;
        return false;
    }
    if (offset_ >= 0)
    {
        cbuf_[offset_++] = c;
    }
    else
    {
        // Drop byte to the floor -- we're not in the middle of a
        // packet.
    }
    return false;
}
 
void GcStreamParser::frame_buffer(std::string* payload) {
    if (offset_ >= 0) {
        payload->assign(cbuf_, offset_);
    } else {
        payload->assign(cbuf_);
    }
}
 
bool GcStreamParser::parse_frame_to_output(struct can_frame* output_frame) {
    int ret = gc_format_parse(cbuf_, output_frame);
    return (ret == 0);
}