lin-epics-modules/motorBase
0
0
Fork 0
forked from epics_driver_modules/motorBase
Code Pull Requests Activity

Added SVN keywords to file headers and set svn:eol-style to "native".

Browse Source
This commit is contained in:
Ron Sluiter
2012-07-27 18:15:35 +00:00
parent 9952e735ae
commit 0eb80002f9
23 changed files with 7603 additions and 7485 deletions
Download Patch File Download Diff File Expand all files Collapse all files
motorApp/PIGCS2Src/PIE517Controller.cpp
+80 -73
View File
@@ -1,73 +1,80 @@
/*
* PIGCSPiezoController
*
* Created on: 15.12.2010
* Author: sra
*/
#include "PIE517Controller.h"
#include "PIasynAxis.h"
#include <stdlib.h>
#include <math.h>
#undef asynPrint
#define asynPrint(user,reason,format...) 0
asynStatus PIE517Controller::init()
{
asynStatus status;
status = PIGCSPiezoController::init();
if (asynSuccess != status)
{
return status;
}
// all output channels need to be set "online" before
// any commands are accepted over the interface.
status = getNrOutputChannels();
if (asynSuccess != status)
{
return status;
}
for (int ch=1; ch<=m_nrOutputChannels; ch++)
{
status = setOnline(ch, 1);
if (asynSuccess != status)
{
return status;
}
}
return status;
}
asynStatus PIE517Controller::setOnline(int channel, int onlineState)
{
char cmd[100];
sprintf(cmd, "ONL %d %d", channel, onlineState);
asynStatus status = sendOnly(cmd);
return status;
}
asynStatus PIE517Controller::getNrOutputChannels()
{
char buf[255];
asynStatus status = sendAndReceive("TPC?", buf, 99);
if (status != asynSuccess)
{
return status;
}
m_nrOutputChannels = atoi(buf);
return status;
}
asynStatus PIE517Controller::initAxis(PIasynAxis* pAxis)
{
pAxis->m_movingStateMask = pow(2.0, pAxis->getAxisNo());
return setServo(pAxis, 1);
}
/*
* PIGCSPiezoController
*
* Created on: 15.12.2010
* Author: sra
*/
/*
Version: $Revision$
Modified By: $Author$
Last Modified: $Date$
HeadURL: $URL$
*/
#include "PIE517Controller.h"
#include "PIasynAxis.h"
#include <stdlib.h>
#include <math.h>
#undef asynPrint
#define asynPrint(user,reason,format...) 0
asynStatus PIE517Controller::init()
{
asynStatus status;
status = PIGCSPiezoController::init();
if (asynSuccess != status)
{
return status;
}
// all output channels need to be set "online" before
// any commands are accepted over the interface.
status = getNrOutputChannels();
if (asynSuccess != status)
{
return status;
}
for (int ch=1; ch<=m_nrOutputChannels; ch++)
{
status = setOnline(ch, 1);
if (asynSuccess != status)
{
return status;
}
}
return status;
}
asynStatus PIE517Controller::setOnline(int channel, int onlineState)
{
char cmd[100];
sprintf(cmd, "ONL %d %d", channel, onlineState);
asynStatus status = sendOnly(cmd);
return status;
}
asynStatus PIE517Controller::getNrOutputChannels()
{
char buf[255];
asynStatus status = sendAndReceive("TPC?", buf, 99);
if (status != asynSuccess)
{
return status;
}
m_nrOutputChannels = atoi(buf);
return status;
}
asynStatus PIE517Controller::initAxis(PIasynAxis* pAxis)
{
pAxis->m_movingStateMask = pow(2.0, pAxis->getAxisNo());
return setServo(pAxis, 1);
}