bool asic_restore(const emu_image *s) {
asic.deviceType = s->deviceType;
return backlight_restore(s)
&& control_restore(s)
&& cpu_restore(s)
&& flash_restore(s)
&& intrpt_restore(s)
&& keypad_restore(s)
&& lcd_restore(s)
&& mem_restore(s)
&& watchdog_restore(s)
&& protect_restore(s)
&& rtc_restore(s)
&& sha256_restore(s)
&& gpt_restore(s)
&& usb_restore(s)
&& cxxx_restore(s)
&& dxxx_restore(s)
&& exxx_restore(s)
&& sched_restore(s);
}
/* exported; see header for details */
lr_errc_t hcsr_probe(gpio_hndl_t *p_gpio_h, clock_hndl_t *p_clk_h,
unsigned int trig_gpio, unsigned int echo_gpio, unsigned int *p_dist_cm)
{
lr_errc_t ret=LREC_SUCCESS;
unsigned int state, resp_cnt;
bool_t set_high=FALSE;
sched_rt_t sched_h;
uint32_t start;
EXECLK_RG(clock_get_ticks32(p_clk_h, &start));
/* Enter timing critical part
*/
sched_rt_raise_max(&sched_h);
/* trigger the sensor */
/* 100us high */
EXEC_RG(gpio_set_value(p_gpio_h, trig_gpio, 1)); set_high=TRUE;
EXECLK_RG(clock_usleep(p_clk_h, 100));
/* 30us low */
EXEC_RG(gpio_set_value(p_gpio_h, trig_gpio, 0)); set_high=FALSE;
/* retrieve the response loop */
for (state=0, resp_cnt=0; state<2;)
{
uint32_t tick;
unsigned int echo;
EXEC_RG(gpio_get_value(p_gpio_h, echo_gpio, &echo));
EXECLK_RG(clock_get_ticks32(p_clk_h, &tick));
switch(state)
{
case 0: /* request sent, wait for echo */
if (echo) {
state++;
resp_cnt++;
} else {
/* no input changed; check the break threshold */
if (tick-start>=BREAK_THRSHD) goto break_readloop;
}
break;
case 1: /* count echo response */
if (echo)
resp_cnt++;
else
state++; /* finishes the loop */
break;
}
EXECLK_RG(clock_usleep(p_clk_h, CM_PULSE_USEC));
}
break_readloop:
/* Exit timing critical part
*/
sched_restore(&sched_h);
if (!resp_cnt) {
err_printf("[%s] No sensor response\n", __func__);
ret = LREC_NO_RESP;
goto finish;
}
dbg_printf("Sensor response time: %d usec [%d cm]\n",
resp_cnt*CM_PULSE_USEC, resp_cnt);
*p_dist_cm = resp_cnt;
finish:
/* in case of error in the timing critical part */
sched_restore(&sched_h);
if (set_high) {
gpio_set_value(p_gpio_h, trig_gpio, 0);
}
return ret;
}
