src/pdo.c
author groke6
Mon, 18 Feb 2008 14:12:19 +0100
changeset 399 8d22c323fe0f
parent 380 fe47568b8281
child 425 4bc4706528ae
permissions -rw-r--r--
some warning errors fixed
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
     1
/*
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     2
  This file is part of CanFestival, a library implementing CanOpen
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     3
  Stack.
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     4
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     5
  Copyright (C): Edouard TISSERANT and Francis DUPIN
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     6
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     7
  See COPYING file for copyrights details.
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     8
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
     9
  This library is free software; you can redistribute it and/or
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    10
  modify it under the terms of the GNU Lesser General Public
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    11
  License as published by the Free Software Foundation; either
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    12
  version 2.1 of the License, or (at your option) any later version.
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    13
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    14
  This library is distributed in the hope that it will be useful,
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    15
  but WITHOUT ANY WARRANTY; without even the implied warranty of
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    16
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    17
  Lesser General Public License for more details.
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    18
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    19
  You should have received a copy of the GNU Lesser General Public
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    20
  License along with this library; if not, write to the Free Software
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    21
  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    22
  USA
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    23
*/
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    24
#include "pdo.h"
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    25
#include "objacces.h"
149
fe50ada8020b Changes in the API:
etisserant
parents: 90
diff changeset
    26
#include "canfestival.h"
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
    27
#include "sysdep.h"
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
    28
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    29
/*!
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    30
** @file   pdo.c
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    31
** @author Edouard TISSERANT and Francis DUPIN
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    32
** @date   Tue Jun  5 09:32:32 2007
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    33
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    34
** @brief
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    35
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    36
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    37
*/
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    38
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    39
/*!
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    40
**
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    41
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    42
** @param d
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    43
** @param TPDO_com TPDO communication parameters OD entry
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    44
** @param TPDO_map TPDO mapping parameters OD entry
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    45
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    46
** @return
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
    47
**/
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    48
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    49
UNS8 buildPDO(CO_Data* d, UNS8 numPdo, Message *pdo)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    50
{
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    51
	const indextable* TPDO_com = d->objdict + d->firstIndex->PDO_TRS + numPdo; 
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    52
	const indextable* TPDO_map = d->objdict + d->firstIndex->PDO_TRS_MAP + numPdo;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    53
	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    54
	UNS8 prp_j = 0x00;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    55
	UNS8 offset = 0x00;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    56
	const UNS8* pMappingCount = (UNS8*) TPDO_map->pSubindex[0].pObject;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    57
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
    58
	pdo->cob_id = *(UNS16*)TPDO_com->pSubindex[1].pObject & UNS16_LE(0x7FF);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    59
	pdo->rtr = NOT_A_REQUEST;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    60
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    61
	MSG_WAR(0x3009, "  PDO CobId is : ", *(UNS32*)TPDO_com->pSubindex[1].pObject);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    62
	MSG_WAR(0x300D, "  Number of objects mapped : ",*pMappingCount );
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    63
	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    64
	do{
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    65
		UNS8 dataType; /* Unused */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    66
		UNS8 tmp[]= {0,0,0,0,0,0,0,0}; /* temporary space to hold bits */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    67
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    68
		/* pointer fo the var which holds the mapping parameter of an mapping entry  */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    69
		UNS32* pMappingParameter = (UNS32*) TPDO_map->pSubindex[prp_j + 1].pObject;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    70
		UNS16 index = (UNS16)((*pMappingParameter) >> 16);
380
fe47568b8281 Solved a mistake with parentheses in last change
luis
parents: 379
diff changeset
    71
		UNS8 Size = (UNS8)(*pMappingParameter & (UNS32)0x000000FF); /* Size in bits */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    72
		
350
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    73
		/* get variable only if Size != 0 and Size is lower than remaining bits in the PDO */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    74
		if(Size && ((offset + Size) <= 64)) {
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    75
			UNS8 ByteSize = 1 + ((Size - 1) >> 3); /*1->8 => 1 ; 9->16 => 2, ... */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    76
			UNS8 subIndex = (UNS8)(( (*pMappingParameter) >> (UNS8)8 ) & (UNS32)0x000000FF);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    77
			
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    78
			MSG_WAR(0x300F, "  got mapping parameter : ", *pMappingParameter);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    79
			MSG_WAR(0x3050, "    at index : ", TPDO_map->index);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    80
			MSG_WAR(0x3051, "    sub-index : ", prp_j + 1);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    81
			
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    82
			if( getODentry(d, index, subIndex, tmp, &ByteSize, &dataType, 0 ) != OD_SUCCESSFUL ){
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    83
				MSG_ERR(0x1013, " Couldn't find mapped variable at index-subindex-size : ", (UNS16)(*pMappingParameter));
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    84
				return 0xFF;
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    85
			}
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    86
			/* copy bit per bit in little endian*/
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    87
			CopyBits(Size, ((UNS8*)tmp), 0 , 0, (UNS8*)&pdo->data[offset>>3], offset%8, 0);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    88
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
    89
			offset += Size ;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    90
		}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    91
		prp_j++;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    92
	}while( prp_j < *pMappingCount );
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    93
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    94
	pdo->len = 1 + ((offset - 1) >> 3);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    95
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    96
	MSG_WAR(0x3015, "  End scan mapped variable", 0);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    97
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    98
	return 0;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
    99
}
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   100
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   101
/*!
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   102
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   103
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   104
** @param d
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   105
** @param cobId
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   106
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   107
** @return
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   108
**/
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   109
UNS8 sendPDOrequest( CO_Data* d, UNS16 RPDOIndex )
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   110
{
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   111
  UNS16 * pwCobId;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   112
  UNS16 offset = d->firstIndex->PDO_RCV;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   113
  UNS16 lastIndex = d->lastIndex->PDO_RCV;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   114
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   115
  /* Sending the request only if the cobid have been found on the PDO
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   116
     receive */
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   117
  /* part dictionary */
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   118
  
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   119
  MSG_WAR(0x3930, "sendPDOrequest RPDO Index : ",RPDOIndex);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   120
  
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   121
  if (offset && RPDOIndex >= 0x1400){
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   122
    offset += RPDOIndex - 0x1400;  
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   123
    if (offset <= lastIndex) {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   124
      /* get the CobId*/
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   125
      pwCobId = (UNS16*) d->objdict[offset].pSubindex[1].pObject;
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   126
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   127
      MSG_WAR(0x3930, "sendPDOrequest cobId is : ",*pwCobId);
252
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   128
      {
285
dbf7695290ae Removed struct initializer with non-constant pointer, making TI compiler fail
etisserant
parents: 252
diff changeset
   129
          Message pdo;
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   130
          pdo.cob_id = *pwCobId;
285
dbf7695290ae Removed struct initializer with non-constant pointer, making TI compiler fail
etisserant
parents: 252
diff changeset
   131
          pdo.rtr = REQUEST;
dbf7695290ae Removed struct initializer with non-constant pointer, making TI compiler fail
etisserant
parents: 252
diff changeset
   132
          pdo.len = 0;      
dbf7695290ae Removed struct initializer with non-constant pointer, making TI compiler fail
etisserant
parents: 252
diff changeset
   133
          return canSend(d->canHandle,&pdo);
252
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   134
      }
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   135
    }
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   136
  }
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   137
  MSG_ERR(0x1931, "sendPDOrequest : RPDO Index not found : ", RPDOIndex);
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   138
  return 0xFF;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   139
}
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   140
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   141
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   142
/*!
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   143
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   144
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   145
** @param d
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   146
** @param m
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   147
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   148
** @return
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   149
**/
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   150
UNS8 proceedPDO(CO_Data* d, Message *m)
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   151
{
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   152
  UNS8   numPdo;
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   153
  UNS8   numMap;  /* Number of the mapped varable */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   154
  UNS8 *     pMappingCount = NULL;    /* count of mapped objects... */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   155
  /* pointer to the var which is mapped to a pdo... */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   156
  /*  void *     pMappedAppObject = NULL;   */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   157
  /* pointer fo the var which holds the mapping parameter of an
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   158
     mapping entry */
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   159
  UNS32 *    pMappingParameter = NULL;
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   160
  UNS8  *    pTransmissionType = NULL; /* pointer to the transmission
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   161
                                         type */
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   162
  UNS16 *    pwCobId = NULL;
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   163
  UNS8       Size;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   164
  UNS8       offset;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   165
  UNS8       status;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   166
  UNS32      objDict;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   167
  UNS16      offsetObjdict;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   168
  UNS16      lastIndex;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   169
  
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   170
  status = state2;
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   171
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   172
  MSG_WAR(0x3935, "proceedPDO, cobID : ", ((*m).cob_id & UNS16_LE(0x7ff)));
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   173
  offset = 0x00;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   174
  numPdo = 0;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   175
  numMap = 0;
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   176
  if((*m).rtr == NOT_A_REQUEST ) { /* The PDO received is not a
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   177
                                     request. */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   178
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   179
    offsetObjdict = d->firstIndex->PDO_RCV;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   180
    lastIndex = d->lastIndex->PDO_RCV;
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   181
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   182
    /* study of all the PDO stored in the dictionary */
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   183
    if(offsetObjdict)
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   184
      while (offsetObjdict <= lastIndex) {
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   185
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   186
        switch( status ) {
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   187
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   188
        case state2:
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   189
          /* get CobId of the dictionary correspondant to the received
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   190
             PDO */
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   191
          pwCobId = (UNS16*) d->objdict[offsetObjdict].pSubindex[1].pObject;
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   192
          /* check the CobId coherance */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   193
          /*pwCobId is the cobId read in the dictionary at the state 3
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   194
            */
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   195
          if ( *pwCobId == (*m).cob_id ){
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   196
            /* The cobId is recognized */
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   197
            status = state4;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   198
            MSG_WAR(0x3936, "cobId found at index ", 0x1400 + numPdo);
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   199
            break;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   200
          }
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   201
          else {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   202
            /* cobId received does not match with those write in the
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   203
              dictionnary */
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   204
            numPdo++;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   205
            offsetObjdict++;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   206
            status = state2;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   207
            break;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   208
          }
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   209
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   210
            case state4:/* Get Mapped Objects Number */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   211
               /* The cobId of the message received has been found in the
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   212
                 dictionnary. */
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   213
               offsetObjdict = d->firstIndex->PDO_RCV_MAP;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   214
             lastIndex = d->lastIndex->PDO_RCV_MAP;
217
94c3f89bc3cc Fixed compile error because of missed type casting in certain compiler (http://www.iar.se/). Thanks to Raphael Studer
etisserant
parents: 215
diff changeset
   215
             pMappingCount = (UNS8*) (d->objdict + offsetObjdict + numPdo)->pSubindex[0].pObject;
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   216
             numMap = 0;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   217
             while (numMap < *pMappingCount) {
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   218
               UNS8 tmp[]= {0,0,0,0,0,0,0,0};
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   219
               UNS8 ByteSize;
217
94c3f89bc3cc Fixed compile error because of missed type casting in certain compiler (http://www.iar.se/). Thanks to Raphael Studer
etisserant
parents: 215
diff changeset
   220
               pMappingParameter = (UNS32*) (d->objdict + offsetObjdict + numPdo)->pSubindex[numMap + 1].pObject;
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   221
               if (pMappingParameter == NULL) {
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   222
                 MSG_ERR(0x1937, "Couldn't get mapping parameter : ", numMap + 1);
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   223
                 return 0xFF;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   224
               }
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   225
               /* Get the addresse of the mapped variable. */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   226
               /* detail of *pMappingParameter : */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   227
               /* The 16 hight bits contains the index, the medium 8 bits
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   228
                 contains the subindex, */
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   229
               /* and the lower 8 bits contains the size of the mapped
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   230
                 variable. */
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   231
380
fe47568b8281 Solved a mistake with parentheses in last change
luis
parents: 379
diff changeset
   232
               Size = (UNS8)(*pMappingParameter & (UNS32)0x000000FF);
350
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   233
					
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   234
					/* set variable only if Size != 0 and Size is lower than remaining bits in the PDO */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   235
               if(Size && ((offset + Size) <= (m->len << 3))) {
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   236
                 /* copy bit per bit in little endian */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   237
                 CopyBits(Size, (UNS8*)&m->data[offset>>3], offset%8, 0, ((UNS8*)tmp), 0, 0);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   238
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   239
                 ByteSize = 1 + ((Size - 1) >> 3); /*1->8 => 1 ; 9->16 =>
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   240
                                                     2, ... */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   241
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   242
                 objDict = setODentry(d, (UNS16)((*pMappingParameter) >> 16),
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   243
                                      (UNS8)(((*pMappingParameter) >> 8 ) & 0xFF),
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   244
                                   tmp, &ByteSize, 0 );
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   245
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   246
                 if(objDict != OD_SUCCESSFUL) {
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   247
                   MSG_ERR(0x1938, "error accessing to the mapped var : ", numMap + 1);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   248
                   MSG_WAR(0x2939, "         Mapped at index : ", (*pMappingParameter) >> 16);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   249
                   MSG_WAR(0x2940, "                subindex : ", ((*pMappingParameter) >> 8 ) & 0xFF);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   250
                   return 0xFF;
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   251
                 }
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   252
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   253
                 MSG_WAR(0x3942, "Variable updated with value received by PDO cobid : ", m->cob_id);
350
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   254
                 MSG_WAR(0x3943, "         Mapped at index : ", (*pMappingParameter) >> 16);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   255
                 MSG_WAR(0x3944, "                subindex : ", ((*pMappingParameter) >> 8 ) & 0xFF);
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   256
                 /* MSG_WAR(0x3945, "                data : ",*((UNS32*)pMappedAppObject)); */
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   257
                 offset += Size;
e90113f7030b Size verification of the mapped variables in PDOs (both reception and transmission)
luis
parents: 320
diff changeset
   258
					}
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   259
               numMap++;
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   260
             } /* end loop while on mapped variables */
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   261
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   262
             offset=0x00;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   263
             numMap = 0;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   264
             return 0;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   265
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   266
        }/* end switch status*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   267
      }/* end while*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   268
  }/* end if Donnees */
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   269
  else if ((*m).rtr == REQUEST ){
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   270
    MSG_WAR(0x3946, "Receive a PDO request cobId : ", m->cob_id);
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   271
    status = state1;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   272
    offsetObjdict = d->firstIndex->PDO_TRS;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   273
    lastIndex = d->lastIndex->PDO_TRS;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   274
    if(offsetObjdict) while( offsetObjdict  <= lastIndex ){
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   275
      /* study of all PDO stored in the objects dictionary */
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   276
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   277
      switch( status ){
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   278
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   279
      case state1:/* check the CobId */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   280
        /* get CobId of the dictionary which match to the received PDO
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   281
         */
370
6fecf36df407 Fixed some endianization problems caused by switch to UNS16 for cob_id member in CAN messages. To be continued.
etisserant
parents: 365
diff changeset
   282
        pwCobId = (UNS16*) (d->objdict + offsetObjdict)->pSubindex[1].pObject;
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   283
        if ( *pwCobId == (*m).cob_id ) {
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   284
          status = state4;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   285
          break;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   286
        }
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   287
        else {
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   288
          numPdo++;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   289
          offsetObjdict++;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   290
        }
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   291
        status = state1;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   292
        break;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   293
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   294
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   295
      case state4:/* check transmission type */
217
94c3f89bc3cc Fixed compile error because of missed type casting in certain compiler (http://www.iar.se/). Thanks to Raphael Studer
etisserant
parents: 215
diff changeset
   296
        pTransmissionType = (UNS8*) d->objdict[offsetObjdict].pSubindex[2].pObject;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   297
        /* If PDO is to be sampled and send on RTR, do it*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   298
        if ( (*pTransmissionType == TRANS_RTR)) {
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   299
          status = state5;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   300
          break;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   301
        /* RTR_SYNC mean data is prepared at SYNC, and transmitted on RTR */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   302
        }else if ((*pTransmissionType == TRANS_RTR_SYNC )) {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   303
    	  if(d->PDO_status[numPdo].transmit_type_parameter & PDO_RTR_SYNC_READY){
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   304
            /*Data ready, just send*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   305
    	    canSend(d->canHandle,&d->PDO_status[numPdo].last_message);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   306
            return 0;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   307
    	  }else{
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   308
            /* if SYNC did never occur, force emission with current data */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   309
            /* DS301 do not tell what to do in such a case...*/
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   310
            MSG_ERR(0x1947, "Not ready RTR_SYNC TPDO send current data : ", m->cob_id);
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   311
            status = state5;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   312
    	  }
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   313
          break;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   314
        }else if(
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   315
             (*pTransmissionType == TRANS_EVENT_PROFILE) ||
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   316
             (*pTransmissionType == TRANS_EVENT_SPECIFIC) ) {
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   317
	  /* Zap all timers and inhibit flag */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   318
	  d->PDO_status[numPdo].event_timer = DelAlarm(d->PDO_status[numPdo].event_timer);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   319
	  d->PDO_status[numPdo].inhibit_timer = DelAlarm(d->PDO_status[numPdo].inhibit_timer);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   320
  	  d->PDO_status[numPdo].transmit_type_parameter &= ~PDO_INHIBITED;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   321
  	  /* Call  PDOEventTimerAlarm for this TPDO, this will trigger emission et reset timers */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   322
          PDOEventTimerAlarm(d, numPdo);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   323
          return 0;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   324
        }else {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   325
          /* The requested PDO is not to send on request. So, does
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   326
            nothing. */
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   327
          MSG_WAR(0x2947, "PDO is not to send on request : ", m->cob_id);
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   328
          return 0xFF;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   329
        }
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   330
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   331
      case state5:/* build and send requested PDO */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   332
      {
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   333
      	Message pdo;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   334
    	if( buildPDO(d, numPdo, &pdo))
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   335
    	{
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   336
          MSG_ERR(0x1948, " Couldn't build TPDO n°", numPdo);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   337
          return 0xFF;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   338
    	}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   339
    	canSend(d->canHandle,&pdo);
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   340
        return 0;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   341
      }
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   342
      }/* end switch status */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   343
    }/* end while */
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   344
  }/* end if Requete */
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   345
0
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   346
  return 0;
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   347
}
4472ee7c6c3e Commit a new cvs repo.
etisserant
parents:
diff changeset
   348
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   349
/*!
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   350
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   351
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   352
** @param NbBits
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   353
** @param SrcByteIndex
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   354
** @param SrcBitIndex
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   355
** @param SrcBigEndian
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   356
** @param DestByteIndex
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   357
** @param DestBitIndex
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   358
** @param DestBigEndian
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   359
**/
201
2966cd34162a Boolean variable mapped in PDO
greg
parents: 149
diff changeset
   360
void CopyBits(UNS8 NbBits, UNS8* SrcByteIndex, UNS8 SrcBitIndex, UNS8 SrcBigEndian, UNS8* DestByteIndex, UNS8 DestBitIndex, UNS8 DestBigEndian)
2966cd34162a Boolean variable mapped in PDO
greg
parents: 149
diff changeset
   361
{
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   362
  /* This loop copy as many bits that it can each time, crossing*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   363
  /* successively bytes*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   364
  // boundaries from LSB to MSB.
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   365
  while(NbBits > 0)
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   366
    {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   367
      /* Bit missalignement between src and dest*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   368
      INTEGER8 Vect = DestBitIndex - SrcBitIndex;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   369
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   370
      /* We can now get src and align it to dest*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   371
      UNS8 Aligned = Vect>0 ? *SrcByteIndex << Vect : *SrcByteIndex >> -Vect;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   372
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   373
      /* Compute the nb of bit we will be able to copy*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   374
      UNS8 BoudaryLimit = (Vect>0 ? 8 - DestBitIndex :  8 - SrcBitIndex );
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   375
      UNS8 BitsToCopy = BoudaryLimit > NbBits ? NbBits : BoudaryLimit;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   376
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   377
      /* Create a mask that will serve in:*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   378
      UNS8 Mask = ((0xff << (DestBitIndex + BitsToCopy)) | (0xff >> (8 - DestBitIndex)));
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   379
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   380
      /* - Filtering src*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   381
      UNS8 Filtered = Aligned & ~Mask;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   382
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   383
      /* - and erase bits where we write, preserve where we don't*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   384
      *DestByteIndex &= Mask;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   385
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   386
      /* Then write.*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   387
      *DestByteIndex |= Filtered ;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   388
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   389
      /*Compute next time cursors for src*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   390
      if((SrcBitIndex += BitsToCopy)>7)/* cross boundary ?*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   391
        {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   392
          SrcBitIndex = 0;/* First bit*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   393
          SrcByteIndex += (SrcBigEndian ? -1 : 1);/* Next byte*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   394
        }
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   395
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   396
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   397
      /*Compute next time cursors for dest*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   398
      if((DestBitIndex += BitsToCopy)>7)
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   399
        {
215
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   400
          DestBitIndex = 0;/* First bit*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   401
          DestByteIndex += (DestBigEndian ? -1 : 1);/* Next byte*/
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   402
        }
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   403
f49e5a6b7804 Manual and Documentation finish
nico
parents: 208
diff changeset
   404
      /*And decrement counter.*/
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   405
      NbBits -= BitsToCopy;
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   406
    }
201
2966cd34162a Boolean variable mapped in PDO
greg
parents: 149
diff changeset
   407
2966cd34162a Boolean variable mapped in PDO
greg
parents: 149
diff changeset
   408
}
208
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   409
/*!
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   410
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   411
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   412
** @param d
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   413
**
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   414
** @return
05d95c45b388 Manual convertion -> latex -> pdf
nico
parents: 204
diff changeset
   415
**/
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   416
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   417
UNS8 sendPDOevent( CO_Data* d)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   418
{
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   419
  /* Calls _sendPDOevent specifying it is not a sync event */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   420
  return _sendPDOevent(d, 0);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   421
}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   422
	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   423
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   424
void PDOEventTimerAlarm(CO_Data* d, UNS32 pdoNum)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   425
{
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   426
	/* This is needed to avoid deletion of re-attribuated timer */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   427
	d->PDO_status[pdoNum].event_timer = TIMER_NONE;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   428
	/* force emission of PDO by artificially changing last emitted*/
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   429
	d->PDO_status[pdoNum].last_message.cob_id = 0;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   430
	_sendPDOevent( d, 0 ); /* not a Sync Event*/	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   431
}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   432
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   433
void PDOInhibitTimerAlarm(CO_Data* d, UNS32 pdoNum)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   434
{
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   435
	/* This is needed to avoid deletion of re-attribuated timer */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   436
	d->PDO_status[pdoNum].inhibit_timer = TIMER_NONE;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   437
	/* Remove inhibit flag */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   438
	d->PDO_status[pdoNum].transmit_type_parameter &= ~PDO_INHIBITED;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   439
	_sendPDOevent( d, 0 ); /* not a Sync Event*/
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   440
}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   441
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   442
/*!
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   443
**
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   444
**
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   445
** @param d
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   446
** @param isSyncEvent
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   447
**
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   448
** @return
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   449
**/
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   450
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   451
UNS8 _sendPDOevent( CO_Data* d, UNS8 isSyncEvent )
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   452
{ 
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   453
  UNS8 	pdoNum = 0x00;       /* number of the actual processed pdo-nr. */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   454
  UNS8* pTransmissionType = NULL;  
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   455
  UNS8 status = state3;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   456
  UNS16 offsetObjdict = d->firstIndex->PDO_TRS;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   457
  UNS16 offsetObjdictMap = d->firstIndex->PDO_TRS_MAP;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   458
  UNS16 lastIndex = d->lastIndex->PDO_TRS;  
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   459
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   460
  /* study all PDO stored in the objects dictionary */	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   461
  if(offsetObjdict){
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   462
   Message pdo = Message_Initializer;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   463
   while( offsetObjdict <= lastIndex) {  
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   464
    switch( status ) {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   465
    case state3:
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   466
      if (/*d->objdict[offsetObjdict].bSubCount < 5 || not necessary with objdictedit (always 5)*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   467
          /* check if TPDO is not valid */ 
298
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   468
          *(UNS32*)d->objdict[offsetObjdict].pSubindex[1].pObject & 0x80000000) {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   469
	  MSG_WAR(0x3960, "Not a valid PDO ", 0x1800 + pdoNum);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   470
	  /*Go next TPDO*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   471
	  status = state11;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   472
	  break;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   473
	}
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   474
      /* get the PDO transmission type */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   475
      pTransmissionType = (UNS8*) d->objdict[offsetObjdict].pSubindex[2].pObject;    
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   476
      MSG_WAR(0x3962, "Reading PDO at index : ", 0x1800 + pdoNum);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   477
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   478
      /* check if transmission type is SYNCRONOUS */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   479
      /* The message is transmited every n SYNC with n=TransmissionType */      
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   480
      if( isSyncEvent && 
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   481
      	  (*pTransmissionType >= TRANS_SYNC_MIN) &&
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   482
      	  (*pTransmissionType <= TRANS_SYNC_MAX) &&
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   483
          (++d->PDO_status[pdoNum].transmit_type_parameter == *pTransmissionType) ) {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   484
        /*Reset count of SYNC*/	
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   485
	d->PDO_status[pdoNum].transmit_type_parameter = 0;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   486
	MSG_WAR(0x3964, "  PDO is on SYNCHRO. Trans type : ", *pTransmissionType);
252
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   487
 {
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   488
 Message msg_init = Message_Initializer;
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   489
 pdo = msg_init;
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   490
 }	
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   491
        if(buildPDO(d, pdoNum, &pdo))
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   492
        {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   493
            MSG_ERR(0x1906, " Couldn't build TPDO number : ", pdoNum);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   494
	    status = state11;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   495
	    break;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   496
        }
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   497
	status = state5;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   498
      /* If transmission RTR, with data sampled on SYNC */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   499
      }else if( isSyncEvent && 
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   500
      	  (*pTransmissionType == TRANS_RTR_SYNC)) {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   501
          if(buildPDO(d, pdoNum, &d->PDO_status[pdoNum].last_message))
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   502
          {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   503
             MSG_ERR(0x1966, " Couldn't build TPDO number : ", pdoNum);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   504
             d->PDO_status[pdoNum].transmit_type_parameter &= ~PDO_RTR_SYNC_READY; 
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   505
          }else{
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   506
             d->PDO_status[pdoNum].transmit_type_parameter |= PDO_RTR_SYNC_READY; 
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   507
          }
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   508
	  status = state11;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   509
	  break;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   510
      /* If transmission on Event and not inhibited, check for changes */
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   511
      }else if((*pTransmissionType == TRANS_EVENT_PROFILE ||
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   512
               *pTransmissionType == TRANS_EVENT_SPECIFIC )&&
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   513
              !(d->PDO_status[pdoNum].transmit_type_parameter & PDO_INHIBITED)) {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   514
	MSG_WAR(0x3968, "  PDO is on EVENT. Trans type : ", *pTransmissionType);
252
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   515
 {
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   516
 Message msg_init = Message_Initializer;
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   517
 pdo = msg_init;
b0dd37421d28 *** empty log message ***
leonid
parents: 236
diff changeset
   518
 }	
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   519
        if(buildPDO(d, pdoNum, &pdo))
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   520
        {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   521
            MSG_ERR(0x3907, " Couldn't build TPDO number : ", pdoNum);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   522
	    status = state11;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   523
	    break;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   524
        }
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   525
        
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   526
	/*Compare new and old PDO*/
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   527
	if(d->PDO_status[pdoNum].last_message.cob_id == pdo.cob_id &&
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   528
	   d->PDO_status[pdoNum].last_message.len == pdo.len &&
315
1d3bf87b8658 Workaround for unsupported UNS64 on some compiler.
etisserant
parents: 298
diff changeset
   529
#ifdef UNS64
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   530
	   *(UNS64*)(&d->PDO_status[pdoNum].last_message.data[0]) == *(UNS64*)(&pdo.data[0])){
315
1d3bf87b8658 Workaround for unsupported UNS64 on some compiler.
etisserant
parents: 298
diff changeset
   531
#else /* don't ALLOW_64BIT_OPS*/
1d3bf87b8658 Workaround for unsupported UNS64 on some compiler.
etisserant
parents: 298
diff changeset
   532
       *(UNS32*)(&d->PDO_status[pdoNum].last_message.data[0]) == *(UNS32*)(&pdo.data[0]) &&
1d3bf87b8658 Workaround for unsupported UNS64 on some compiler.
etisserant
parents: 298
diff changeset
   533
       *(UNS32*)(&d->PDO_status[pdoNum].last_message.data[4]) == *(UNS32*)(&pdo.data[4])){
1d3bf87b8658 Workaround for unsupported UNS64 on some compiler.
etisserant
parents: 298
diff changeset
   534
#endif 
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   535
	   	/* No changes -> go to next pdo*/
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   536
		status = state11;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   537
	}else{
298
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   538
		
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   539
		UNS16 EventTimerDuration;
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   540
        UNS16 InhibitTimerDuration;
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   541
		
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   542
		MSG_WAR(0x306A, "Changes TPDO number : ", pdoNum);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   543
		/* Changes detected -> transmit message */
298
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   544
        EventTimerDuration = *(UNS16*)d->objdict[offsetObjdict].pSubindex[5].pObject;
dba062c5c3c1 Checking if TPDO was valid was wrong (pdo.c)
luis
parents: 297
diff changeset
   545
        InhibitTimerDuration = *(UNS16*)d->objdict[offsetObjdict].pSubindex[3].pObject;
297
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   546
        
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   547
		status = state5;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   548
		
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   549
		/* Start both event_timer and inhibit_timer*/
297
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   550
        if(EventTimerDuration){
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   551
           DelAlarm(d->PDO_status[pdoNum].event_timer);
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   552
           d->PDO_status[pdoNum].event_timer = SetAlarm(d, pdoNum, &PDOEventTimerAlarm, MS_TO_TIMEVAL(EventTimerDuration), 0);
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   553
        }
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   554
		
297
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   555
        if(InhibitTimerDuration){
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   556
		   DelAlarm(d->PDO_status[pdoNum].inhibit_timer);
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   557
		   d->PDO_status[pdoNum].inhibit_timer = SetAlarm(d, pdoNum, &PDOInhibitTimerAlarm, US_TO_TIMEVAL(InhibitTimerDuration * 100), 0);
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   558
           /* and inhibit TPDO */
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   559
           d->PDO_status[pdoNum].transmit_type_parameter |= PDO_INHIBITED;
639e5ec5a120 Fixed some transmit type issues (for 254 255) with null event and/or inhibit time
etisserant
parents: 285
diff changeset
   560
        }
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   561
		
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   562
	}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   563
      }else{
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   564
	MSG_WAR(0x306C, "  PDO is not on EVENT or synchro or not at this SYNC. Trans type : ", *pTransmissionType);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   565
	status = state11;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   566
      }      
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   567
        break;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   568
    case state5: /*Send the pdo*/
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   569
	/*store_as_last_message*/
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   570
	d->PDO_status[pdoNum].last_message = pdo;	
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   571
	MSG_WAR(0x396D, "sendPDO cobId :", pdo.cob_id);
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   572
	MSG_WAR(0x396E,  "     Nb octets  : ",  pdo.len);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   573
    	
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   574
    	canSend(d->canHandle,&pdo);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   575
	status = state11;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   576
	break;     
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   577
    case state11: /*Go to next TPDO*/     
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   578
	pdoNum++;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   579
	offsetObjdict++;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   580
	offsetObjdictMap++;
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   581
	MSG_WAR(0x3970, "next pdo index : ", pdoNum);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   582
	status = state3;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   583
	break;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   584
      
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   585
    default:
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   586
      MSG_ERR(0x1972,"Unknown state has been reached : %d",status);
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   587
      return 0xFF;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   588
    }/* end switch case */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   589
    
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   590
  }/* end while */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   591
  }
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   592
  return 0;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   593
}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   594
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   595
/*!
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   596
**
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   597
**
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   598
** @param d
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   599
** @param OD_entry
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   600
** @param bSubindex 
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   601
** @return always 0
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   602
**/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   603
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   604
UNS32 TPDO_Communication_Parameter_Callback(CO_Data* d, const indextable * OD_entry, UNS8 bSubindex)
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   605
{
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   606
  /* If PDO are actives */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   607
  if(d->CurrentCommunicationState.csPDO) switch(bSubindex)
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   608
  {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   609
  	case 2: /* Changed transmition type */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   610
  	case 3: /* Changed inhibit time */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   611
  	case 5: /* Changed event time */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   612
  	{
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   613
          const indextable* TPDO_com = d->objdict + d->firstIndex->PDO_TRS; 
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   614
          UNS8 numPdo = OD_entry - TPDO_com;       /* number of the actual processed pdo-nr. */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   615
        
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   616
          /* Zap all timers and inhibit flag */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   617
          d->PDO_status[numPdo].event_timer = DelAlarm(d->PDO_status[numPdo].event_timer);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   618
          d->PDO_status[numPdo].inhibit_timer = DelAlarm(d->PDO_status[numPdo].inhibit_timer);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   619
          d->PDO_status[numPdo].transmit_type_parameter = 0;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   620
          /* Call  PDOEventTimerAlarm for this TPDO, this will trigger emission et reset timers */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   621
          PDOEventTimerAlarm(d, numPdo);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   622
          return 0;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   623
  	}
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   624
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   625
  	default: /* other subindex are ignored*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   626
  	break;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   627
  }
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   628
  return 0;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   629
}
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   630
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   631
void PDOInit(CO_Data* d)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   632
{
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   633
  /* For each TPDO mapping parameters */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   634
  UNS16	pdoIndex = 0x1800; /* OD index of TDPO */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   635
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   636
  UNS16 offsetObjdict = d->firstIndex->PDO_TRS;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   637
  UNS16 lastIndex = d->lastIndex->PDO_TRS;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   638
  if(offsetObjdict) while( offsetObjdict <= lastIndex) {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   639
    /* Assign callbacks to sensible TPDO mapping subindexes */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   640
    UNS32 errorCode;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   641
    ODCallback_t *CallbackList;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   642
    /* Find callback list */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   643
    scanIndexOD (d, pdoIndex, &errorCode, &CallbackList);
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   644
    if(errorCode == OD_SUCCESSFUL && CallbackList)
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   645
    {
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   646
      /*Assign callbacks to corresponding subindex*/
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   647
      /* Transmission type */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   648
      CallbackList[2] = &TPDO_Communication_Parameter_Callback;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   649
      /* Inhibit time */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   650
      CallbackList[3] = &TPDO_Communication_Parameter_Callback;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   651
      /* Event timer */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   652
      CallbackList[5] = &TPDO_Communication_Parameter_Callback;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   653
    }
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   654
    pdoIndex++;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   655
    offsetObjdict++;
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   656
  }  
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   657
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   658
  /* Trigger a non-sync event */
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   659
  _sendPDOevent( d, 0 );
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   660
}
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   661
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   662
void PDOStop(CO_Data* d)
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   663
{
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   664
  /* For each TPDO mapping parameters */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   665
  UNS8 	pdoNum = 0x00;       /* number of the actual processed pdo-nr. */
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   666
  UNS16 offsetObjdict = d->firstIndex->PDO_TRS;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   667
  UNS16 lastIndex = d->lastIndex->PDO_TRS;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   668
  if(offsetObjdict) while( offsetObjdict <= lastIndex) {
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   669
  	/* Delete TPDO timers */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   670
	d->PDO_status[pdoNum].event_timer = DelAlarm(d->PDO_status[pdoNum].event_timer);
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   671
	d->PDO_status[pdoNum].inhibit_timer = DelAlarm(d->PDO_status[pdoNum].inhibit_timer);
236
905677ed00f3 Full preliminary implementation of TPDO transmit type:
etisserant
parents: 235
diff changeset
   672
	/* Reset transmit type parameter */
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   673
	d->PDO_status[pdoNum].transmit_type_parameter = 0;
365
9b76e0881beb Changed cob_id from struct{UNS32} to UNS16
etisserant
parents: 350
diff changeset
   674
	d->PDO_status[pdoNum].last_message.cob_id = 0;
235
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   675
	pdoNum++;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   676
	offsetObjdict++;
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   677
  }  
f812bf6b7237 Preliminary implementation of Event Timer and Inhibit Timer driven TPDO
etisserant
parents: 217
diff changeset
   678
}