1
6
7
8
9
10
11
12
13
14
15
16
17
20
21
25
26
31
32
36
37
41
42
47
48
57
58
/* ... */
#include "hardware/interp.h"
#include "hardware/structs/sio.h"
#include "hardware/claim.h"
check_hw_size(interp_hw_t, SIO_INTERP1_ACCUM0_OFFSET - SIO_INTERP0_ACCUM0_OFFSET);
check_hw_layout(sio_hw_t, interp, SIO_INTERP0_ACCUM0_OFFSET);
static uint8_t _claimed;
static inline uint interp_lane_bit(interp_hw_t * interp, uint lane) {
return (interp_index(interp) << 1u) | lane;
}{ ... }
void interp_claim_lane(interp_hw_t *interp, uint lane) {
valid_params_if(HARDWARE_INTERP, lane < 2);
hw_claim_or_assert((uint8_t *) &_claimed, interp_lane_bit(interp, lane), "Lane is already claimed");
}{ ... }
void interp_claim_lane_mask(interp_hw_t *interp, uint lane_mask) {
valid_params_if(HARDWARE_INTERP, lane_mask && lane_mask <= 0x3);
if (lane_mask & 1u) interp_claim_lane(interp, 0);
if (lane_mask & 2u) interp_claim_lane(interp, 1);
}{ ... }
void interp_unclaim_lane(interp_hw_t *interp, uint lane) {
valid_params_if(HARDWARE_INTERP, lane < 2);
hw_claim_clear((uint8_t *) &_claimed, interp_lane_bit(interp, lane));
}{ ... }
bool interp_lane_is_claimed(interp_hw_t *interp, uint lane) {
valid_params_if(HARDWARE_INTERP, lane < 2);
return hw_is_claimed((uint8_t *) &_claimed, interp_lane_bit(interp, lane));
}{ ... }
void interp_unclaim_lane_mask(interp_hw_t *interp, uint lane_mask) {
valid_params_if(HARDWARE_INTERP, lane_mask <= 0x3);
if (lane_mask & 1u) interp_unclaim_lane(interp, 0);
if (lane_mask & 2u) interp_unclaim_lane(interp, 1);
}{ ... }
void interp_save(interp_hw_t *interp, interp_hw_save_t *saver) {
saver->accum[0] = interp->accum[0];
saver->accum[1] = interp->accum[1];
saver->base[0] = interp->base[0];
saver->base[1] = interp->base[1];
saver->base[2] = interp->base[2];
saver->ctrl[0] = interp->ctrl[0];
saver->ctrl[1] = interp->ctrl[1];
}{ ... }
void interp_restore(interp_hw_t *interp, interp_hw_save_t *saver) {
interp->accum[0] = saver->accum[0];
interp->accum[1] = saver->accum[1];
interp->base[0] = saver->base[0];
interp->base[1] = saver->base[1];
interp->base[2] = saver->base[2];
interp->ctrl[0] = saver->ctrl[0];
interp->ctrl[1] = saver->ctrl[1];
}{ ... }