sii_page.c

Go to the documentation of this file.

/*****************************************************************************
 *
 *  Copyright (C) 2026  Florian Pose, Ingenieurgemeinschaft IgH
 *
 *  This file is part of the IgH EtherCAT Master.
 *
 *  The IgH EtherCAT Master is free software; you can redistribute it and/or
 *  modify it under the terms of the GNU General Public License version 2, as
 *  published by the Free Software Foundation.
 *
 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General
 *  Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with the IgH EtherCAT Master; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 ****************************************************************************/

/****************************************************************************/

#include "sii_page.h"

#include <linux/slab.h>

/****************************************************************************/

void ec_sii_page_init(
        ec_sii_page_t *page 
        )
{
    page->vendor_id = 0x00000000;
    page->product_code = 0x00000000;
    page->revision_number = 0x00000000;
    page->serial_number = 0x00000000;
    page->alias = 0x0000;

    page->origin = EC_SII_PAGE_UNKNOWN;

    page->words = NULL;
    page->word_count = 0;
}

/****************************************************************************/

void ec_sii_page_clear(
        ec_sii_page_t *page 
        )
{
    if (page->words) {
        kfree(page->words);
    }
}

/****************************************************************************/

int ec_sii_page_alloc(
        ec_sii_page_t *page, 
        size_t word_count 
        )
{
    if (page->words) {
        kfree(page->words);
    }

    page->word_count = 0;

    if (!(page->words = (uint16_t *) kmalloc(word_count * 2, GFP_KERNEL))) {
        return -ENOMEM;
    }

    page->word_count = word_count;
    return 0;
}

/****************************************************************************/

int ec_sii_page_copy(
        ec_sii_page_t *page, 
        const ec_sii_page_t *from 
        )
{
    int ret;

    page->vendor_id = from->vendor_id;
    page->product_code = from->product_code;
    page->revision_number = from->revision_number;
    page->serial_number = from->serial_number;
    page->alias = from->alias;

    page->origin = from->origin;

    ret = ec_sii_page_alloc(page, from->word_count);
    if (ret) {
        return ret;
    }

    memcpy(page->words, from->words, page->word_count * 2);
    return 0;
}

/****************************************************************************/