/****************************************************************************** * * $Id$ * * Copyright (C) 2006 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 * as published by the Free Software Foundation; version 2 of the License. * * 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 * *****************************************************************************/ /** \file Mailbox functionality. */ /*****************************************************************************/ #include #include #include "mailbox.h" #include "command.h" #include "master.h" /*****************************************************************************/ /** Prepares a mailbox-send command. \return pointer to mailbox command data */ uint8_t *ec_slave_mbox_prepare_send(ec_slave_t *slave, /**< slave */ uint8_t type, /**< mailbox protocol */ size_t size /**< size of the data */ ) { ec_command_t *command = &slave->mbox_command; size_t total_size; if (unlikely(!slave->sii_mailbox_protocols)) { EC_ERR("Slave %i does not support mailbox communication!\n", slave->ring_position); return NULL; } total_size = size + 6; if (unlikely(total_size > slave->sii_rx_mailbox_size)) { EC_ERR("Data size does not fit in mailbox!\n"); return NULL; } if (ec_command_npwr(command, slave->station_address, slave->sii_rx_mailbox_offset, slave->sii_rx_mailbox_size)) return NULL; EC_WRITE_U16(command->data, size); // mailbox service data length EC_WRITE_U16(command->data + 2, slave->station_address); // station address EC_WRITE_U8 (command->data + 4, 0x00); // hhannel & priority EC_WRITE_U8 (command->data + 5, type); // underlying protocol type return command->data + 6; } /*****************************************************************************/ /** Prepares a command for checking the mailbox state. \return 0 in case of success, else < 0 */ int ec_slave_mbox_prepare_check(ec_slave_t *slave /**< slave */) { ec_command_t *command = &slave->mbox_command; // FIXME: second sync manager? if (ec_command_nprd(command, slave->station_address, 0x808, 8)) return -1; return 0; } /*****************************************************************************/ /** Processes a mailbox state checking command. \return 0 in case of success, else < 0 */ int ec_slave_mbox_check(const ec_slave_t *slave /**< slave */) { return EC_READ_U8(slave->mbox_command.data + 5) & 8 ? 1 : 0; } /*****************************************************************************/ /** Prepares a command to fetch mailbox data. \return 0 in case of success, else < 0 */ int ec_slave_mbox_prepare_fetch(ec_slave_t *slave /**< slave */) { ec_command_t *command = &slave->mbox_command; if (ec_command_nprd(command, slave->station_address, slave->sii_tx_mailbox_offset, slave->sii_tx_mailbox_size)) return -1; return 0; } /*****************************************************************************/ /** Processes received mailbox data. \return pointer to the received data */ uint8_t *ec_slave_mbox_fetch(ec_slave_t *slave, /**< slave */ uint8_t type, /**< expected mailbox protocol */ size_t *size /**< size of the received data */ ) { ec_command_t *command = &slave->mbox_command; size_t data_size; if ((EC_READ_U8(command->data + 5) & 0x0F) != type) { EC_ERR("Unexpected mailbox protocol 0x%02X (exp.: 0x%02X) at" " slave %i!\n", EC_READ_U8(command->data + 5), type, slave->ring_position); return NULL; } if ((data_size = EC_READ_U16(command->data)) > slave->sii_tx_mailbox_size - 6) { EC_ERR("Currupt mailbox response detected!\n"); return NULL; } *size = data_size; return command->data + 6; } /*****************************************************************************/ /** Sends a mailbox command and waits for its reception. \return pointer to the received data */ uint8_t *ec_slave_mbox_simple_io(ec_slave_t *slave, /**< slave */ size_t *size /**< size of the received data */ ) { uint8_t type; ec_command_t *command; command = &slave->mbox_command; type = EC_READ_U8(command->data + 5); if (unlikely(ec_master_simple_io(slave->master, command))) { EC_ERR("Mailbox checking failed on slave %i!\n", slave->ring_position); return NULL; } return ec_slave_mbox_simple_receive(slave, type, size); } /*****************************************************************************/ /** Waits for the reception of a mailbox command. \return pointer to the received data */ uint8_t *ec_slave_mbox_simple_receive(ec_slave_t *slave, /**< slave */ uint8_t type, /**< expected protocol */ size_t *size /**< received data size */ ) { cycles_t start, end, timeout; ec_command_t *command; command = &slave->mbox_command; start = get_cycles(); timeout = (cycles_t) 100 * cpu_khz; // 100ms while (1) { if (ec_slave_mbox_prepare_check(slave)) return NULL; if (unlikely(ec_master_simple_io(slave->master, command))) { EC_ERR("Mailbox checking failed on slave %i!\n", slave->ring_position); return NULL; } end = get_cycles(); if (ec_slave_mbox_check(slave)) break; // proceed with receiving data if ((end - start) >= timeout) { EC_ERR("Mailbox check - Slave %i timed out.\n", slave->ring_position); return NULL; } udelay(100); } if (ec_slave_mbox_prepare_fetch(slave)) return NULL; if (unlikely(ec_master_simple_io(slave->master, command))) { EC_ERR("Mailbox receiving failed on slave %i!\n", slave->ring_position); return NULL; } if (unlikely(slave->master->debug_level) > 1) EC_DBG("Mailbox receive took %ius.\n", ((u32) (end - start) * 1000 / cpu_khz)); return ec_slave_mbox_fetch(slave, type, size); } /*****************************************************************************/