Changeset 9435 for trunk/MagicSoft/Cosy/devdrv
- Timestamp:
- 04/29/09 13:05:42 (16 years ago)
- Location:
- trunk/MagicSoft/Cosy/devdrv
- Files:
-
- 3 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/MagicSoft/Cosy/devdrv/DevdrvLinkDef.h
r9132 r9435 6 6 7 7 #pragma link C++ class Dkc+; 8 #pragma link C++ class Macs+;9 #pragma link C++ class ShaftEncoder+;10 8 11 9 #endif -
trunk/MagicSoft/Cosy/devdrv/Makefile
r9132 r9435 17 17 #------------------------------------------------------------------------------ 18 18 19 SRCFILES = shaftencoder.cc macs.ccdkc.cc19 SRCFILES = dkc.cc 20 20 21 21 ############################################################ -
trunk/MagicSoft/Cosy/devdrv/dkc.cc
r9431 r9435 190 190 return; 191 191 192 case 0x100c:193 gLog << inf2 << "- " << GetNodeName() << ": Guard time:" << dec << val << endl;194 return;195 196 case 0x100d:197 gLog << inf2 << "- " << GetNodeName() << ": Life time factor:" << dec << val << endl;198 return;199 200 192 case 0x2002: 201 193 gLog << inf2 << GetNodeName() << ": Current velocity: " << dec << val << endl; … … 264 256 break; 265 257 266 case 0x100c:267 switch (subidx)268 {269 case 0:270 //lout << ddev(MLog::eGui);271 gLog << inf2 << "- " << GetNodeName() << ": Guard time set." << endl;272 //lout << edev(MLog::eGui);273 return;274 }275 break;276 277 case 0x100d:278 switch (subidx)279 {280 case 0:281 //lout << ddev(MLog::eGui);282 gLog << inf2 << "- " << GetNodeName() << ": Life time factor set." << endl;283 //lout << edev(MLog::eGui);284 return;285 }286 break;287 288 case 0x1800:289 switch (subidx)290 {291 case 1:292 //lout << ddev(MLog::eGui);293 gLog << inf2 << "- " << GetNodeName() << ": Status of PDO1 set." << endl;294 //lout << edev(MLog::eGui);295 return;296 }297 break;298 299 258 case 0x2002: 300 switch (subidx) 301 { 302 case 0: 303 //lout << ddev(MLog::eGui); 304 gLog << inf2 << "- " << GetNodeName() << ": Velocity set." << endl; 305 //lout << edev(MLog::eGui); 306 return; 307 } 308 break; 259 //lout << ddev(MLog::eGui); 260 gLog << inf2 << "- " << GetNodeName() << ": Velocity set." << endl; 261 //lout << edev(MLog::eGui); 262 return; 309 263 310 264 case 0x2003: 311 switch (subidx) 312 { 313 case 0: 314 //lout << ddev(MLog::eGui); 315 gLog << inf2 << "- " << GetNodeName() << ": Acceleration set." << endl; 316 //lout << edev(MLog::eGui); 317 return; 318 case 1: 319 //lout << ddev(MLog::eGui); 320 gLog << inf2 << "- " << GetNodeName() << ": Deceleration set." << endl; 321 //lout << edev(MLog::eGui); 322 return; 323 } 324 break; 265 //lout << ddev(MLog::eGui); 266 gLog << inf2 << "- " << GetNodeName() << ": Acceleration set." << endl; 267 //lout << edev(MLog::eGui); 268 return; 325 269 326 270 case 0x3006: … … 359 303 return; 360 304 361 case 0x6003:362 switch (subidx)363 {364 case 0:365 //lout << ddev(MLog::eGui);366 gLog << inf2 << "- " << GetNodeName() << ": Absolute positioning started." << endl;367 //lout << edev(MLog::eGui);368 return;369 370 case 1:371 //lout << ddev(MLog::eGui);372 gLog << inf2 << "- " << GetNodeName() << ": Relative positioning started." << endl;373 //lout << edev(MLog::eGui);374 return;375 }376 break;377 378 305 case 0x6004: 379 306 switch (subidx) … … 421 348 } 422 349 423 void Dkc::SetPDO1On(BYTE_t flag)424 {425 gLog << inf2 << "- " << GetNodeName() << ": " << (flag?"Enable":"Disable") << " PDO1." << endl;426 SendSDO(0x1800, 1, (LWORD_t)(flag?0:1)<<31);427 WaitForSdo(0x1800, 1);428 }429 430 350 void Dkc::StartNode() 431 351 { … … 468 388 WaitForSdo(0x1003, 2); 469 389 470 SetPDO1On(TRUE);471 390 /* 472 391 if (HasError()) … … 528 447 gLog << dbg << "- Setting velocity to: " << vel << endl; 529 448 SendSDO(0x2002, vel); // velocity 530 WaitForSdo(0x2002 , 0);449 WaitForSdo(0x2002); 531 450 } 532 451 … … 535 454 gLog << dbg << "- Setting velocity to: " << vel*100 << "%" << endl; 536 455 SendSDO(0x2002, (LWORD_t)(vel*fVelMax+0.5)); // velocity 537 WaitForSdo(0x2002 , 0);456 WaitForSdo(0x2002); 538 457 } 539 458 … … 544 463 WaitForSdo(0x2003, 0); 545 464 } 546 465 /* 547 466 void Dkc::SetDeceleration(LWORD_t dec) 548 467 { … … 551 470 WaitForSdo(0x2003, 1); 552 471 } 553 472 */ 554 473 void Dkc::SetRpmMode(BYTE_t mode) 555 474 {
Note:
See TracChangeset
for help on using the changeset viewer.