asix-sigma: Pull out the CAPTURE mode handler
Pull out the code handling the Sigma which is in CAPTURE mode into a separate function. This is so we can start reworking this entire code easily soon. Signed-off-by: Marek Vasut <marex@denx.de>
This commit is contained in:
parent
58d6f20748
commit
d405193074
|
@ -1120,16 +1120,71 @@ static void download_capture(struct sr_dev_inst *sdi)
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int receive_data(int fd, int revents, void *cb_data)
|
/*
|
||||||
|
* Handle the Sigma when in CAPTURE mode. This function checks:
|
||||||
|
* - Sampling time ended
|
||||||
|
* - DRAM capacity overflow
|
||||||
|
* This function triggers download of the samples from Sigma
|
||||||
|
* in case either of the above conditions is true.
|
||||||
|
*/
|
||||||
|
static int sigma_capture_mode(struct sr_dev_inst *sdi)
|
||||||
{
|
{
|
||||||
struct sr_dev_inst *sdi;
|
struct dev_context *devc = sdi->priv;
|
||||||
struct dev_context *devc;
|
|
||||||
struct sr_datafeed_packet packet;
|
struct sr_datafeed_packet packet;
|
||||||
uint64_t running_msec;
|
uint64_t running_msec;
|
||||||
struct timeval tv;
|
struct timeval tv;
|
||||||
int numchunks;
|
int numchunks;
|
||||||
uint8_t modestatus;
|
uint8_t modestatus;
|
||||||
|
|
||||||
|
/* Get the current position. */
|
||||||
|
sigma_read_pos(&devc->state.stoppos, &devc->state.triggerpos,
|
||||||
|
devc);
|
||||||
|
|
||||||
|
numchunks = (devc->state.stoppos + 511) / 512;
|
||||||
|
|
||||||
|
/* Check if the timer has expired, or memory is full. */
|
||||||
|
gettimeofday(&tv, 0);
|
||||||
|
running_msec = (tv.tv_sec - devc->start_tv.tv_sec) * 1000 +
|
||||||
|
(tv.tv_usec - devc->start_tv.tv_usec) / 1000;
|
||||||
|
|
||||||
|
if (running_msec < devc->limit_msec && numchunks < 32767)
|
||||||
|
/* Still capturing. */
|
||||||
|
return TRUE;
|
||||||
|
|
||||||
|
/* Stop acquisition. */
|
||||||
|
sigma_set_register(WRITE_MODE, 0x11, devc);
|
||||||
|
|
||||||
|
/* Set SDRAM Read Enable. */
|
||||||
|
sigma_set_register(WRITE_MODE, 0x02, devc);
|
||||||
|
|
||||||
|
/* Get the current position. */
|
||||||
|
sigma_read_pos(&devc->state.stoppos, &devc->state.triggerpos, devc);
|
||||||
|
|
||||||
|
/* Check if trigger has fired. */
|
||||||
|
modestatus = sigma_get_register(READ_MODE, devc);
|
||||||
|
if (modestatus & 0x20)
|
||||||
|
devc->state.triggerchunk = devc->state.triggerpos / 512;
|
||||||
|
else
|
||||||
|
devc->state.triggerchunk = -1;
|
||||||
|
|
||||||
|
/* Transfer captured data from device. */
|
||||||
|
download_capture(sdi);
|
||||||
|
|
||||||
|
/* All done. */
|
||||||
|
packet.type = SR_DF_END;
|
||||||
|
sr_session_send(sdi, &packet);
|
||||||
|
|
||||||
|
dev_acquisition_stop(sdi, sdi);
|
||||||
|
|
||||||
|
return TRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int receive_data(int fd, int revents, void *cb_data)
|
||||||
|
{
|
||||||
|
struct sr_dev_inst *sdi;
|
||||||
|
struct dev_context *devc;
|
||||||
|
|
||||||
(void)fd;
|
(void)fd;
|
||||||
(void)revents;
|
(void)revents;
|
||||||
|
|
||||||
|
@ -1139,47 +1194,8 @@ static int receive_data(int fd, int revents, void *cb_data)
|
||||||
if (devc->state.state == SIGMA_IDLE)
|
if (devc->state.state == SIGMA_IDLE)
|
||||||
return TRUE;
|
return TRUE;
|
||||||
|
|
||||||
if (devc->state.state == SIGMA_CAPTURE) {
|
if (devc->state.state == SIGMA_CAPTURE)
|
||||||
/* Get the current position. */
|
return sigma_capture_mode(sdi);
|
||||||
sigma_read_pos(&devc->state.stoppos, &devc->state.triggerpos,
|
|
||||||
devc);
|
|
||||||
|
|
||||||
numchunks = (devc->state.stoppos + 511) / 512;
|
|
||||||
|
|
||||||
/* Check if the timer has expired, or memory is full. */
|
|
||||||
gettimeofday(&tv, 0);
|
|
||||||
running_msec = (tv.tv_sec - devc->start_tv.tv_sec) * 1000 +
|
|
||||||
(tv.tv_usec - devc->start_tv.tv_usec) / 1000;
|
|
||||||
|
|
||||||
if (running_msec < devc->limit_msec && numchunks < 32767)
|
|
||||||
/* Still capturing. */
|
|
||||||
return TRUE;
|
|
||||||
|
|
||||||
/* Stop acquisition. */
|
|
||||||
sigma_set_register(WRITE_MODE, 0x11, devc);
|
|
||||||
|
|
||||||
/* Set SDRAM Read Enable. */
|
|
||||||
sigma_set_register(WRITE_MODE, 0x02, devc);
|
|
||||||
|
|
||||||
/* Get the current position. */
|
|
||||||
sigma_read_pos(&devc->state.stoppos, &devc->state.triggerpos, devc);
|
|
||||||
|
|
||||||
/* Check if trigger has fired. */
|
|
||||||
modestatus = sigma_get_register(READ_MODE, devc);
|
|
||||||
if (modestatus & 0x20)
|
|
||||||
devc->state.triggerchunk = devc->state.triggerpos / 512;
|
|
||||||
else
|
|
||||||
devc->state.triggerchunk = -1;
|
|
||||||
|
|
||||||
/* Transfer captured data from device. */
|
|
||||||
download_capture(sdi);
|
|
||||||
|
|
||||||
/* All done. */
|
|
||||||
packet.type = SR_DF_END;
|
|
||||||
sr_session_send(sdi, &packet);
|
|
||||||
|
|
||||||
dev_acquisition_stop(sdi, sdi);
|
|
||||||
}
|
|
||||||
|
|
||||||
return TRUE;
|
return TRUE;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue