fp@39: /******************************************************************************
fp@0:  *
fp@54:  *  d e v i c e . c
fp@0:  *
fp@0:  *  Methoden für ein EtherCAT-Gerät.
fp@0:  *
fp@39:  *  $Id$
fp@0:  *
fp@39:  *****************************************************************************/
fp@0: 
fp@24: #include <linux/module.h>
fp@0: #include <linux/skbuff.h>
fp@0: #include <linux/if_ether.h>
fp@0: #include <linux/netdevice.h>
fp@2: #include <linux/delay.h>
fp@0: 
fp@54: #include "device.h"
fp@0: 
fp@39: /*****************************************************************************/
fp@0: 
fp@0: /**
fp@0:    EtherCAT-Geräte-Konstuktor.
fp@5: 
fp@0:    Initialisiert ein EtherCAT-Gerät, indem es die Variablen
fp@0:    in der Struktur auf die Default-Werte setzt.
fp@0: 
fp@0:    @param ecd Zu initialisierendes EtherCAT-Gerät
fp@0: */
fp@0: 
fp@54: int ec_device_init(ec_device_t *ecd)
fp@0: {
fp@73:     ecd->dev = NULL;
fp@73:     ecd->open = 0;
fp@73:     ecd->tx_time = 0;
fp@73:     ecd->rx_time = 0;
fp@73:     ecd->state = EC_DEVICE_STATE_READY;
fp@73:     ecd->rx_data_length = 0;
fp@73:     ecd->isr = NULL;
fp@73:     ecd->module = NULL;
fp@73:     ecd->error_reported = 0;
fp@73: 
fp@73:     if ((ecd->tx_skb = dev_alloc_skb(ETH_HLEN + EC_MAX_FRAME_SIZE)) == NULL) {
fp@73:         printk(KERN_ERR "EtherCAT: Error allocating device socket buffer!\n");
fp@73:         return -1;
fp@73:     }
fp@73: 
fp@73:     return 0;
fp@39: }
fp@39: 
fp@39: /*****************************************************************************/
fp@0: 
fp@0: /**
fp@0:    EtherCAT-Geräte-Destuktor.
fp@5: 
fp@0:    Gibt den dynamisch allozierten Speicher des
fp@0:    EtherCAT-Gerätes (die beiden Socket-Buffer) wieder frei.
fp@0: 
fp@0:    @param ecd EtherCAT-Gerät
fp@0: */
fp@0: 
fp@54: void ec_device_clear(ec_device_t *ecd)
fp@54: {
fp@73:     if (ecd->open) ec_device_close(ecd);
fp@73: 
fp@73:     ecd->dev = NULL;
fp@73: 
fp@73:     if (ecd->tx_skb) {
fp@73:         dev_kfree_skb(ecd->tx_skb);
fp@73:         ecd->tx_skb = NULL;
fp@73:     }
fp@0: }
fp@0: 
fp@39: /*****************************************************************************/
fp@0: 
fp@0: /**
fp@0:    Führt die open()-Funktion des Netzwerktreibers aus.
fp@0: 
fp@0:    Dies entspricht einem "ifconfig up". Vorher wird der Zeiger
fp@0:    auf das EtherCAT-Gerät auf Gültigkeit geprüft und der
fp@0:    Gerätezustand zurückgesetzt.
fp@0: 
fp@0:    @param ecd EtherCAT-Gerät
fp@0: 
fp@0:    @return 0 bei Erfolg, < 0: Ungültiger Zeiger, oder open()
fp@0:    fehlgeschlagen
fp@0: */
fp@0: 
fp@54: int ec_device_open(ec_device_t *ecd)
fp@0: {
fp@73:     unsigned int i;
fp@73: 
fp@73:     if (!ecd) {
fp@73:         printk(KERN_ERR "EtherCAT: Trying to open a NULL device!\n");
fp@73:         return -1;
fp@73:     }
fp@73: 
fp@73:     if (!ecd->dev) {
fp@73:         printk(KERN_ERR "EtherCAT: No net_device to open!\n");
fp@73:         return -1;
fp@73:     }
fp@73: 
fp@73:     if (ecd->open) {
fp@73:         printk(KERN_WARNING "EtherCAT: Device already opened!\n");
fp@73:     }
fp@73:     else {
fp@73:         // Device could have received frames before
fp@73:         for (i = 0; i < 4; i++) ec_device_call_isr(ecd);
fp@73: 
fp@73:         // Reset old device state
fp@73:         ecd->state = EC_DEVICE_STATE_READY;
fp@73: 
fp@73:         if (ecd->dev->open(ecd->dev) == 0) ecd->open = 1;
fp@73:     }
fp@73: 
fp@73:     return ecd->open ? 0 : -1;
fp@0: }
fp@0: 
fp@39: /*****************************************************************************/
fp@0: 
fp@0: /**
fp@0:    Führt die stop()-Funktion des net_devices aus.
fp@0: 
fp@0:    @param ecd EtherCAT-Gerät
fp@0: 
fp@54:    @return 0 bei Erfolg, < 0: Kein Gerät zum Schliessen oder
fp@73:    Schliessen fehlgeschlagen.
fp@54: */
fp@54: 
fp@54: int ec_device_close(ec_device_t *ecd)
fp@0: {
fp@73:     if (!ecd->dev) {
fp@73:         printk(KERN_ERR "EtherCAT: No device to close!\n");
fp@73:         return -1;
fp@73:     }
fp@73: 
fp@73:     if (!ecd->open) {
fp@73:         printk(KERN_WARNING "EtherCAT: Device already closed!\n");
fp@73:     }
fp@73:     else {
fp@73:         if (ecd->dev->stop(ecd->dev) == 0) ecd->open = 0;
fp@73:     }
fp@73: 
fp@73:     return !ecd->open ? 0 : -1;
fp@73: }
fp@73: 
fp@73: /*****************************************************************************/
fp@73: 
fp@73: /**
fp@73:    Bereitet den geräteinternen Socket-Buffer auf den Versand vor.
fp@73: 
fp@73:    \return Zeiger auf den Speicher, in den die Frame-Daten sollen.
fp@73: */
fp@73: 
fp@73: uint8_t *ec_device_prepare(ec_device_t *ecd /**< EtherCAT-Gerät */)
fp@73: {
fp@73:     // Clear transmit socket buffer and reserve space for Ethernet-II header
fp@73:     skb_trim(ecd->tx_skb, 0);
fp@73:     skb_reserve(ecd->tx_skb, ETH_HLEN);
fp@73: 
fp@73:     // Erstmal Speicher für maximal langen Frame reservieren
fp@73:     return skb_put(ecd->tx_skb, EC_MAX_FRAME_SIZE);
fp@0: }
fp@0: 
fp@39: /*****************************************************************************/
fp@0: 
fp@0: /**
fp@0:    Sendet einen Rahmen über das EtherCAT-Gerät.
fp@0: 
fp@0:    Kopiert die zu sendenden Daten in den statischen Socket-
fp@0:    Buffer, fügt den Ethernat-II-Header hinzu und ruft die
fp@0:    start_xmit()-Funktion der Netzwerkkarte auf.
fp@0: 
fp@73:    \return 0 bei Erfolg, < 0: Vorheriger Rahmen noch
fp@0:    nicht empfangen, oder kein Speicher mehr vorhanden
fp@0: */
fp@0: 
fp@73: void ec_device_send(ec_device_t *ecd, /**< EtherCAT-Gerät */
fp@73:                     unsigned int length /**< Länge der zu sendenden Daten */
fp@73:                     )
fp@73: {
fp@73:     struct ethhdr *eth;
fp@73: 
fp@73:     // Framegroesse auf (jetzt bekannte) Laenge abschneiden
fp@73:     skb_trim(ecd->tx_skb, length);
fp@73: 
fp@73:     // Ethernet-II-Header hinzufuegen
fp@73:     eth = (struct ethhdr *) skb_push(ecd->tx_skb, ETH_HLEN);
fp@73:     eth->h_proto = htons(0x88A4);
fp@73:     memcpy(eth->h_source, ecd->dev->dev_addr, ecd->dev->addr_len);
fp@73:     memset(eth->h_dest, 0xFF, ecd->dev->addr_len);
fp@73: 
fp@73:     ecd->state = EC_DEVICE_STATE_SENT;
fp@73:     ecd->rx_data_length = 0;
fp@73: 
fp@73:     // Senden einleiten
fp@73:     rdtscl(ecd->tx_time); // Get CPU cycles
fp@73:     ecd->dev->hard_start_xmit(ecd->tx_skb, ecd->dev);
fp@73: }
fp@73: 
fp@73: /*****************************************************************************/
fp@73: 
fp@73: /**
fp@73:    Gibt die Anzahl der empfangenen Bytes zurück.
fp@73: 
fp@73:    \return Empfangene Bytes, oder 0, wenn kein Frame empfangen wurde.
fp@73: */
fp@73: 
fp@73: unsigned int ec_device_received(const ec_device_t *ecd)
fp@73: {
fp@73:     return ecd->rx_data_length;
fp@73: }
fp@73: 
fp@73: /*****************************************************************************/
fp@73: 
fp@73: /**
fp@73:    Gibt die empfangenen Daten zurück.
fp@73: 
fp@73:    \return Adresse auf empfangene Daten.
fp@73: */
fp@73: 
fp@73: uint8_t *ec_device_data(ec_device_t *ecd)
fp@73: {
fp@73:     return ecd->rx_data;
fp@73: }
fp@73: 
fp@73: /*****************************************************************************/
fp@73: 
fp@73: /**
fp@73:    Ruft die Interrupt-Routine der Netzwerkkarte auf.
fp@73: 
fp@73:    @param ecd EtherCAT-Gerät
fp@0: 
fp@0:    @return Anzahl der kopierten Bytes bei Erfolg, sonst < 0
fp@0: */
fp@0: 
fp@54: void ec_device_call_isr(ec_device_t *ecd)
fp@5: {
fp@73:     if (likely(ecd->isr)) ecd->isr(0, ecd->dev, NULL);
fp@39: }
fp@39: 
fp@39: /*****************************************************************************/
fp@5: 
fp@5: /**
fp@0:    Gibt alle Informationen über das Device-Objekt aus.
fp@0: 
fp@0:    @param ecd EtherCAT-Gerät
fp@0: */
fp@0: 
fp@73: void ec_device_print(ec_device_t *ecd)
fp@73: {
fp@73:     printk(KERN_DEBUG "---EtherCAT device information begin---\n");
fp@73: 
fp@73:     if (ecd)
fp@73:     {
fp@73:         printk(KERN_DEBUG "Assigned net_device: %X\n",
fp@73:                (unsigned) ecd->dev);
fp@73:         printk(KERN_DEBUG "Transmit socket buffer: %X\n",
fp@73:                (unsigned) ecd->tx_skb);
fp@73:         printk(KERN_DEBUG "Time of last transmission: %u\n",
fp@73:                (unsigned) ecd->tx_time);
fp@73:         printk(KERN_DEBUG "Time of last receive: %u\n",
fp@73:                (unsigned) ecd->rx_time);
fp@73:         printk(KERN_DEBUG "Actual device state: %i\n",
fp@73:                (int) ecd->state);
fp@73:         printk(KERN_DEBUG "Receive buffer: %X\n",
fp@73:                (unsigned) ecd->rx_data);
fp@73:         printk(KERN_DEBUG "Receive buffer fill state: %u/%u\n",
fp@73:                (unsigned) ecd->rx_data_length, EC_MAX_FRAME_SIZE);
fp@73:     }
fp@73:     else
fp@73:     {
fp@73:         printk(KERN_DEBUG "Device is NULL!\n");
fp@73:     }
fp@73: 
fp@73:     printk(KERN_DEBUG "---EtherCAT device information end---\n");
fp@0: }
fp@0: 
fp@54: /******************************************************************************
fp@54:  *
fp@54:  * Treiberschnittstelle
fp@54:  *
fp@54:  *****************************************************************************/
fp@54: 
fp@54: void EtherCAT_dev_state(ec_device_t *ecd, ec_device_state_t state)
fp@54: {
fp@73:     ecd->state = state;
fp@54: }
fp@54: 
fp@54: /*****************************************************************************/
fp@54: 
fp@54: int EtherCAT_dev_is_ec(ec_device_t *ecd, struct net_device *dev)
fp@54: {
fp@73:     return ecd && ecd->dev == dev;
fp@73: }
fp@73: 
fp@73: /*****************************************************************************/
fp@73: 
fp@73: void EtherCAT_dev_receive(ec_device_t *ecd, void *data, unsigned int size)
fp@73: {
fp@73:     // Copy received data to ethercat-device buffer
fp@73:     memcpy(ecd->rx_data, data, size);
fp@73:     ecd->rx_data_length = size;
fp@73:     ecd->state = EC_DEVICE_STATE_RECEIVED;
fp@54: }
fp@54: 
fp@54: /*****************************************************************************/
fp@54: 
fp@54: EXPORT_SYMBOL(EtherCAT_dev_is_ec);
fp@54: EXPORT_SYMBOL(EtherCAT_dev_state);
fp@54: EXPORT_SYMBOL(EtherCAT_dev_receive);
fp@27: 
fp@39: /*****************************************************************************/
fp@42: 
fp@42: /* Emacs-Konfiguration
fp@42: ;;; Local Variables: ***
fp@73: ;;; c-basic-offset:4 ***
fp@42: ;;; End: ***
fp@42: */