Skip to content

GitLab

Commit 44910e3d authored by ahoms's avatar ahoms
Browse files

* split Espia class into EspiaDev and EspiaAcq 


git-svn-id: https://scm.blissgarden.org/svn/lima/trunk@61 45c4679d-1946-429d-baad-37912b19538b
parent 0d342fc9
Hide whitespace changes
Inline Side-by-side
camera/common/espia/include/Espia.h
View file @ 44910e3d
#ifndef ESPIA_H
#define ESPIA_H
#include "SizeUtils.h"
#include "Exceptions.h"
#include "ThreadUtils.h"
#include "HwFrameCallback.h"
#include "espia_lib.h"
#include "Exceptions.h"
#include <string>
......@@ -22,88 +18,12 @@ class Espia
BlockForever = SCDXIPCI_BLOCK_FOREVER,
};
typedef struct AcqStatus {
bool acq_started;
bool acq_running;
int acq_run_nb;
int last_acq_frame_nb;
} AcqStatusType;
Espia(int dev_nb);
~Espia();
void bufferAlloc(const FrameDim& frame_dim, int& nb_buffers,
int buffer_frames);
void bufferFree();
void getFrameDim(FrameDim& frame_dim);
void getNbBuffers(int& nb_buffers);
void getBufferFrames(int& buffer_frames);
void *getBufferFramePtr(int buffer_nb, int frame_nb = 0);
void *getAcqFramePtr(int acq_frame_nb);
void getFrameInfo(int acq_frame_nb, HwFrameInfoType& info);
void setNbFrames(int nb_frames);
void getNbFrames(int& nb_frames);
void startAcq();
void stopAcq();
void getAcqStatus(AcqStatusType& acq_status);
void getStartTimestamp(Timestamp& start_ts);
void serWrite(const std::string& buffer,
int block_size = 0, double block_delay = 0,
bool no_wait = false);
void serRead(std::string& buffer, int len, double timeout);
void serReadStr(std::string& buffer, int len,
const std::string& term, double timeout);
void serFlush();
void serGetAvailableBytes(int& available_bytes);
static void throwError(int ret, std::string file, std::string func,
int line);
private:
void open(int dev_nb);
void close();
unsigned long sec2usec(double sec);
double usec2sec(unsigned long usec);
bool hasVirtualBuffers();
int realBufferNb(int virt_buffer, int virt_frame);
int realFrameNb (int virt_buffer, int virt_frame);
int virtBufferNb(int real_buffer, int real_frame);
int virtFrameNb (int real_buffer, int real_frame);
void real2virtFrameInfo(const struct img_frame_info& real_info,
HwFrameInfoType& virt_info);
void resetFrameInfo(struct img_frame_info& frame_info);
static int cbDispatch(struct espia_cb_data *cb_data);
void registerLastFrameCb();
void unregisterLastFrameCb();
void lastFrameCb(struct espia_cb_data *cb_data);
AutoMutex acqLock();
int m_dev_nb;
espia_t m_dev;
FrameDim m_frame_dim;
int m_nb_buffers;
int m_buffer_frames;
int m_real_frame_factor;
int m_real_frame_size;
static void throwError(int ret, std::string file, std::string func,
int line);
Mutex m_acq_mutex;
int m_nb_frames;
bool m_started;
Timestamp m_start_ts;
struct img_frame_info m_last_frame_info;
int m_last_frame_cb_nr;
};
#define ESPIA_CHECK_CALL(ret) \
......@@ -125,42 +45,8 @@ inline double Espia::usec2sec(unsigned long usec)
return usec * 1e-6;
}
inline bool Espia::hasVirtualBuffers()
{
return m_real_frame_factor != 1;
}
inline int Espia::realBufferNb(int virt_buffer, int virt_frame)
{
return virt_buffer / m_real_frame_factor;
}
inline int Espia::realFrameNb (int virt_buffer, int virt_frame)
{
return virt_buffer % m_real_frame_factor + virt_frame;
}
inline int Espia::virtBufferNb(int real_buffer, int real_frame)
{
return (real_buffer * m_real_frame_factor +
real_frame / m_buffer_frames);
}
inline int Espia::virtFrameNb (int real_buffer, int real_frame)
{
return real_frame % m_buffer_frames;
}
inline void Espia::getStartTimestamp(Timestamp& start_ts)
{
start_ts = m_start_ts;
}
inline AutoMutex Espia::acqLock()
{
return AutoMutex(m_acq_mutex, AutoMutex::Locked);
}
} // namespace lima
#endif // ESPIA_H
camera/common/espia/include/EspiaAcq.h 0 → 100644
View file @ 44910e3d
#ifndef ESPIAACQ_H
#define ESPIAACQ_H
#include "EspiaDev.h"
#include "SizeUtils.h"
namespace lima
{
class EspiaAcq : public Espia
{
public:
EspiaAcq(EspiaDev& dev);
~EspiaAcq();
typedef struct AcqStatus {
bool acq_started;
bool acq_running;
int acq_run_nb;
int last_acq_frame_nb;
} AcqStatusType;
void bufferAlloc(const FrameDim& frame_dim, int& nb_buffers,
int buffer_frames);
void bufferFree();
void getFrameDim(FrameDim& frame_dim);
void getNbBuffers(int& nb_buffers);
void getBufferFrames(int& buffer_frames);
void *getBufferFramePtr(int buffer_nb, int frame_nb = 0);
void *getAcqFramePtr(int acq_frame_nb);
void getFrameInfo(int acq_frame_nb, HwFrameInfoType& info);
void setNbFrames(int nb_frames);
void getNbFrames(int& nb_frames);
void startAcq();
void stopAcq();
void getAcqStatus(AcqStatusType& acq_status);
void getStartTimestamp(Timestamp& start_ts);
private:
bool hasVirtualBuffers();
int realBufferNb(int virt_buffer, int virt_frame);
int realFrameNb (int virt_buffer, int virt_frame);
int virtBufferNb(int real_buffer, int real_frame);
int virtFrameNb (int real_buffer, int real_frame);
void real2virtFrameInfo(const struct img_frame_info& real_info,
HwFrameInfoType& virt_info);
void resetFrameInfo(struct img_frame_info& frame_info);
static int dispatchFrameCb(struct espia_cb_data *cb_data);
void registerLastFrameCb();
void unregisterLastFrameCb();
void lastFrameCb(struct espia_cb_data *cb_data);
AutoMutex acqLock();
EspiaDev& m_dev;
FrameDim m_frame_dim;
int m_nb_buffers;
int m_buffer_frames;
int m_real_frame_factor;
int m_real_frame_size;
int m_nb_frames;
bool m_started;
Timestamp m_start_ts;
struct img_frame_info m_last_frame_info;
int m_last_frame_cb_nr;
};
inline bool EspiaAcq::hasVirtualBuffers()
{
return m_real_frame_factor != 1;
}
inline int EspiaAcq::realBufferNb(int virt_buffer, int virt_frame)
{
return virt_buffer / m_real_frame_factor;
}
inline int EspiaAcq::realFrameNb (int virt_buffer, int virt_frame)
{
return virt_buffer % m_real_frame_factor + virt_frame;
}
inline int EspiaAcq::virtBufferNb(int real_buffer, int real_frame)
{
return (real_buffer * m_real_frame_factor +
real_frame / m_buffer_frames);
}
inline int EspiaAcq::virtFrameNb (int real_buffer, int real_frame)
{
return real_frame % m_buffer_frames;
}
inline void EspiaAcq::getStartTimestamp(Timestamp& start_ts)
{
start_ts = m_start_ts;
}
} // namespace lima
#endif // ESPIAACQ_H
camera/common/espia/include/EspiaDev.h 0 → 100644
View file @ 44910e3d
#ifndef ESPIADEV_H
#define ESPIADEV_H
#include "Espia.h"
#include "ThreadUtils.h"
#include "HwFrameCallback.h"
namespace lima
{
class EspiaDev : public Espia
{
public:
EspiaDev(int dev_nb);
~EspiaDev();
operator espia_t();
void registerCallback(struct espia_cb_data& cb_data, int& cb_nr);
void unregisterCallback(int& cb_nr);
void serWrite(const std::string& buffer,
int block_size = 0, double block_delay = 0,
bool no_wait = false);
void serRead(std::string& buffer, int len, double timeout);
void serReadStr(std::string& buffer, int len,
const std::string& term, double timeout);
void serFlush();
void serGetAvailableBytes(int& available_bytes);
private:
void open(int dev_nb);
void close();
AutoMutex acqLock();
int m_dev_nb;
espia_t m_dev;
Mutex m_acq_mutex;
};
inline EspiaDev::operator espia_t()
{
return m_dev;
}
inline AutoMutex EspiaDev::acqLock()
{
return AutoMutex(m_acq_mutex, AutoMutex::Locked);
}
} // namespace lima
#endif // ESPIADEV_H
camera/common/espia/src/Espia.cpp
View file @ 44910e3d
#include "Espia.h"
#include "MemUtils.h"
using namespace lima;
using namespace std;
#define CHECK_CALL(ret) ESPIA_CHECK_CALL(ret)
#define ESPIA_MIN_BUFFER_SIZE (128 * 1024)
Espia::Espia(int dev_nb)
{
m_dev_nb = Invalid;
m_dev = ESPIA_DEV_INVAL;
m_nb_buffers = m_buffer_frames = 0;
m_real_frame_factor = m_real_frame_size = 0;
m_nb_frames = 0;
m_started = false;
resetFrameInfo(m_last_frame_info);
m_last_frame_cb_nr = Invalid;
open(dev_nb);
registerLastFrameCb();
}
Espia::~Espia()
{
close();
}
void Espia::open(int dev_nb)
{
if (dev_nb == m_dev_nb)
return;
close();
CHECK_CALL(espia_open(dev_nb, &m_dev));
m_dev_nb = dev_nb;
}
void Espia::close()
{
if (m_dev_nb == Invalid)
return;
bufferFree();
unregisterLastFrameCb();
CHECK_CALL(espia_close(m_dev));
m_dev = ESPIA_DEV_INVAL;
m_dev_nb = Invalid;
}
int Espia::cbDispatch(struct espia_cb_data *cb_data)
{
Espia *espia = (Espia *) cb_data->data;
void (Espia::*method)(struct espia_cb_data *cb_data) = NULL;
int& cb_nr = cb_data->cb_nr;
if (cb_nr == espia->m_last_frame_cb_nr)
method = &Espia::lastFrameCb;
if (method) {
try {
(espia->*method)(cb_data);
} catch (...) {
}
}
return ESPIA_OK;
}
void Espia::registerLastFrameCb()
{
if (m_last_frame_cb_nr != Invalid)
return;
struct espia_cb_data cb_data;
cb_data.type = ESPIA_CB_ACQ;
cb_data.cb = cbDispatch;
cb_data.data = this;
cb_data.timeout = BlockForever;
struct img_frame_info& req_finfo = cb_data.info.acq.req_finfo;
req_finfo.buffer_nr = ESPIA_ACQ_ANY;
req_finfo.frame_nr = ESPIA_ACQ_ANY;
req_finfo.round_count = ESPIA_ACQ_ANY;
req_finfo.acq_frame_nr = ESPIA_ACQ_EACH;
int& cb_nr = m_last_frame_cb_nr;
CHECK_CALL(espia_register_callback(m_dev, &cb_data, &cb_nr));
try {
CHECK_CALL(espia_callback_active(m_dev, cb_nr, true));
} catch (...) {
unregisterLastFrameCb();
throw;
}
}
void Espia::unregisterLastFrameCb()
{
if (m_last_frame_cb_nr == Invalid)
return;
CHECK_CALL(espia_unregister_callback(m_dev, m_last_frame_cb_nr));
m_last_frame_cb_nr = Invalid;
}
void Espia::lastFrameCb(struct espia_cb_data *cb_data)
{
AutoMutex l = acqLock();
struct img_frame_info& cb_finfo = cb_data->info.acq.cb_finfo;
if (!finished_espia_frame_info(&cb_finfo, cb_data->ret))
m_last_frame_info = cb_finfo;
}
void Espia::bufferAlloc(const FrameDim& frame_dim, int& nb_buffers,
int buffer_frames)
{
if (!frame_dim.isValid() || (nb_buffers <= 0) || (buffer_frames <= 0))
throw LIMA_HW_EXC(InvalidValue, "Invalid frame_dim, "
"nb_buffers and/or buffer_frames");
if ((frame_dim == m_frame_dim) && (nb_buffers == m_nb_buffers) &&
(buffer_frames == m_buffer_frames))
return;
bufferFree();
int& virt_buffers = nb_buffers;
int& virt_frames = buffer_frames;
int real_buffers = virt_buffers;
int real_frames = virt_frames;
int real_frame_size = frame_dim.getMemSize();
if (virt_frames == 1) {
int page_size;
GetPageSize(page_size);
real_frame_size += page_size - 1;
real_frame_size &= ~(page_size - 1);
}
int real_buffer_size = real_frame_size * real_frames;
int frame_factor = 1;
if (real_buffer_size < ESPIA_MIN_BUFFER_SIZE) {
frame_factor = ESPIA_MIN_BUFFER_SIZE / real_buffer_size;
real_frames *= frame_factor;
real_buffers += frame_factor - 1;
real_buffers /= frame_factor;
virt_buffers = real_buffers * frame_factor;
}
CHECK_CALL(espia_buffer_alloc(m_dev, real_buffers, real_frames,
real_frame_size));
m_frame_dim = frame_dim;
m_nb_buffers = virt_buffers;
m_buffer_frames = virt_frames;
m_real_frame_factor = frame_factor;
m_real_frame_size = real_frame_size;
}
void Espia::bufferFree()
{
if ((m_nb_buffers == 0) || (m_buffer_frames == 0))
return;
stopAcq();
CHECK_CALL(espia_buffer_free(m_dev));
m_frame_dim = FrameDim();
m_nb_buffers = m_buffer_frames = 0;
m_real_frame_factor = m_real_frame_size = 0;
}
void Espia::getFrameDim(FrameDim& frame_dim)
{
frame_dim = m_frame_dim;
}
void Espia::getNbBuffers(int& nb_buffers)
{
nb_buffers = m_nb_buffers;
}
void Espia::getBufferFrames(int& buffer_frames)
{
buffer_frames = m_buffer_frames;
}
void *Espia::getBufferFramePtr(int buffer_nb, int frame_nb)
{
int real_buffer = realBufferNb(buffer_nb, frame_nb);
int real_frame = realFrameNb(buffer_nb, frame_nb);
void *ptr;
CHECK_CALL(espia_frame_address(m_dev, real_buffer, real_frame, &ptr));
return ptr;
}
void *Espia::getAcqFramePtr(int acq_frame_nb)
{
int buffer_nb = ESPIA_ACQ_ANY;
void *ptr;
CHECK_CALL(espia_frame_address(m_dev, buffer_nb, acq_frame_nb, &ptr));
return ptr;
}
void Espia::getFrameInfo(int acq_frame_nb, HwFrameInfoType& info)
{
struct img_frame_info finfo;
finfo.buffer_nr = ESPIA_ACQ_ANY;
finfo.frame_nr = ESPIA_ACQ_ANY;
finfo.round_count = ESPIA_ACQ_ANY;
finfo.acq_frame_nr = acq_frame_nb;
CHECK_CALL(espia_get_frame(m_dev, &finfo, NoBlock));
real2virtFrameInfo(finfo, info);
}
void Espia::real2virtFrameInfo(const struct img_frame_info& real_info,
HwFrameInfoType& virt_info)
{
char *buffer_ptr = (char *) real_info.buffer_ptr;
int frame_offset = real_info.frame_nr * m_real_frame_size;
virt_info.acq_frame_nb = real_info.acq_frame_nr;
virt_info.frame_ptr = buffer_ptr + frame_offset;
virt_info.frame_dim = &m_frame_dim;
virt_info.frame_timestamp = usec2sec(real_info.time_us);
virt_info.valid_pixels = real_info.pixels;
}
void Espia::resetFrameInfo(struct img_frame_info& frame_info)
{
frame_info.buffer_ptr = NULL;
frame_info.buffer_nr = Invalid;
frame_info.frame_nr = Invalid;
frame_info.round_count = Invalid;
frame_info.acq_frame_nr = Invalid;
frame_info.time_us = 0;
frame_info.pixels = 0;
}
void Espia::setNbFrames(int nb_frames)
{
if (nb_frames < 0)
throw LIMA_HW_EXC(InvalidValue, "Invalid nb of frames");
m_nb_frames = nb_frames;
}
void Espia::getNbFrames(int& nb_frames)
{
nb_frames = m_nb_frames;
}
void Espia::startAcq()
{
AutoMutex l = acqLock();
if (m_started)
throw LIMA_HW_EXC(Error, "Acquisition already running");
resetFrameInfo(m_last_frame_info);
CHECK_CALL(espia_start_acq(m_dev, 0, m_nb_frames, NoBlock));
m_start_ts = Timestamp::now();
m_started = true;
}
void Espia::stopAcq()
{
AutoMutex l = acqLock();
if (!m_started)
return;
CHECK_CALL(espia_stop_acq(m_dev));
m_started = false;
}
void Espia::getAcqStatus(AcqStatusType& acq_status)
{
AutoMutex l = acqLock();