Added 'mp_raise_NotImplementedError(NULL)'
This commit is contained in:
microbuilder
parent
b9e229f739
commit
ad7cd0399d
@ -46,7 +46,7 @@ void pulseout_reset() {
|
|||||||
}
|
}
|
||||||
|
|
||||||
void common_hal_pulseio_pulseout_construct(pulseio_pulseout_obj_t* self, const pulseio_pwmout_obj_t* carrier) {
|
void common_hal_pulseio_pulseout_construct(pulseio_pulseout_obj_t* self, const pulseio_pwmout_obj_t* carrier) {
|
||||||
|
mp_raise_NotImplementedError(NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
bool common_hal_pulseio_pulseout_deinited(pulseio_pulseout_obj_t* self) {
|
bool common_hal_pulseio_pulseout_deinited(pulseio_pulseout_obj_t* self) {
|
||||||
@ -60,147 +60,3 @@ void common_hal_pulseio_pulseout_deinit(pulseio_pulseout_obj_t* self) {
|
|||||||
void common_hal_pulseio_pulseout_send(pulseio_pulseout_obj_t* self, uint16_t* pulses, uint16_t length) {
|
void common_hal_pulseio_pulseout_send(pulseio_pulseout_obj_t* self, uint16_t* pulses, uint16_t length) {
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#if 0
|
|
||||||
// This timer is shared amongst all PulseOut objects under the assumption that
|
|
||||||
// the code is single threaded. Its stored in MICROPY_PORT_ROOT_POINTERS so it
|
|
||||||
// doesn't get garbage collected.
|
|
||||||
static uint8_t refcount = 0;
|
|
||||||
|
|
||||||
static __IO PORT_PINCFG_Type *active_pincfg = NULL;
|
|
||||||
static uint16_t *pulse_buffer = NULL;
|
|
||||||
static volatile uint16_t pulse_index = 0;
|
|
||||||
static uint16_t pulse_length;
|
|
||||||
static volatile uint32_t current_compare = 0;
|
|
||||||
|
|
||||||
static void turn_on(__IO PORT_PINCFG_Type * pincfg) {
|
|
||||||
pincfg->reg = PORT_PINCFG_PMUXEN;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void turn_off(__IO PORT_PINCFG_Type * pincfg) {
|
|
||||||
pincfg->reg = PORT_PINCFG_RESETVALUE;
|
|
||||||
}
|
|
||||||
|
|
||||||
void pulse_finish(struct tc_module *const module) {
|
|
||||||
pulse_index++;
|
|
||||||
|
|
||||||
if (active_pincfg == NULL) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
// Always turn it off.
|
|
||||||
turn_off(active_pincfg);
|
|
||||||
if (pulse_index >= pulse_length) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
current_compare = (current_compare + pulse_buffer[pulse_index] * 3 / 4) & 0xffff;
|
|
||||||
tc_set_compare_value(MP_STATE_VM(pulseout_tc_instance), TC_COMPARE_CAPTURE_CHANNEL_0, current_compare);
|
|
||||||
if (pulse_index % 2 == 0) {
|
|
||||||
turn_on(active_pincfg);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void pulseout_reset() {
|
|
||||||
refcount = 0;
|
|
||||||
MP_STATE_VM(pulseout_tc_instance) = NULL;
|
|
||||||
active_pincfg = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
void common_hal_pulseio_pulseout_construct(pulseio_pulseout_obj_t* self,
|
|
||||||
const pulseio_pwmout_obj_t* carrier) {
|
|
||||||
if (refcount == 0) {
|
|
||||||
// Find a spare timer.
|
|
||||||
Tc *t = NULL;
|
|
||||||
Tc *tcs[TC_INST_NUM] = TC_INSTS;
|
|
||||||
for (uint8_t i = TC_INST_NUM; i > 0; i--) {
|
|
||||||
if (tcs[i - 1]->COUNT16.CTRLA.bit.ENABLE == 0) {
|
|
||||||
t = tcs[i - 1];
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if (t == NULL) {
|
|
||||||
mp_raise_RuntimeError("All timers in use");
|
|
||||||
}
|
|
||||||
MP_STATE_VM(pulseout_tc_instance) = gc_alloc(sizeof(struct tc_module), false);
|
|
||||||
if (t == NULL) {
|
|
||||||
mp_raise_msg(&mp_type_MemoryError, "");
|
|
||||||
}
|
|
||||||
|
|
||||||
struct tc_config config_tc;
|
|
||||||
tc_get_config_defaults(&config_tc);
|
|
||||||
|
|
||||||
config_tc.counter_size = TC_COUNTER_SIZE_16BIT;
|
|
||||||
config_tc.clock_prescaler = TC_CTRLA_PRESCALER_DIV64;
|
|
||||||
config_tc.wave_generation = TC_WAVE_GENERATION_NORMAL_FREQ;
|
|
||||||
|
|
||||||
tc_init(MP_STATE_VM(pulseout_tc_instance), t, &config_tc);
|
|
||||||
tc_register_callback(MP_STATE_VM(pulseout_tc_instance), pulse_finish, TC_CALLBACK_CC_CHANNEL0);
|
|
||||||
tc_enable(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
tc_stop_counter(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
}
|
|
||||||
refcount++;
|
|
||||||
|
|
||||||
self->pin = carrier->pin->pin;
|
|
||||||
|
|
||||||
PortGroup *const port_base = port_get_group_from_gpio_pin(self->pin);
|
|
||||||
self->pincfg = &port_base->PINCFG[self->pin % 32];
|
|
||||||
|
|
||||||
// Set the port to output a zero.
|
|
||||||
port_base->OUTCLR.reg = 1 << (self->pin % 32);
|
|
||||||
port_base->DIRSET.reg = 1 << (self->pin % 32);
|
|
||||||
|
|
||||||
// Turn off the pinmux which should connect the port output.
|
|
||||||
turn_off(self->pincfg);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool common_hal_pulseio_pulseout_deinited(pulseio_pulseout_obj_t* self) {
|
|
||||||
return self->pin == NO_PIN;
|
|
||||||
}
|
|
||||||
|
|
||||||
void common_hal_pulseio_pulseout_deinit(pulseio_pulseout_obj_t* self) {
|
|
||||||
if (common_hal_pulseio_pulseout_deinited(self)) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
PortGroup *const port_base = port_get_group_from_gpio_pin(self->pin);
|
|
||||||
port_base->DIRCLR.reg = 1 << (self->pin % 32);
|
|
||||||
|
|
||||||
turn_on(self->pincfg);
|
|
||||||
|
|
||||||
refcount--;
|
|
||||||
if (refcount == 0) {
|
|
||||||
tc_reset(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
gc_free(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
MP_STATE_VM(pulseout_tc_instance) = NULL;
|
|
||||||
}
|
|
||||||
self->pin = NO_PIN;
|
|
||||||
}
|
|
||||||
|
|
||||||
void common_hal_pulseio_pulseout_send(pulseio_pulseout_obj_t* self, uint16_t* pulses, uint16_t length) {
|
|
||||||
if (active_pincfg != NULL) {
|
|
||||||
mp_raise_RuntimeError("Another send is already active");
|
|
||||||
}
|
|
||||||
active_pincfg = self->pincfg;
|
|
||||||
pulse_buffer = pulses;
|
|
||||||
pulse_index = 0;
|
|
||||||
pulse_length = length;
|
|
||||||
|
|
||||||
current_compare = pulses[0] * 3 / 4;
|
|
||||||
tc_set_compare_value(MP_STATE_VM(pulseout_tc_instance), TC_COMPARE_CAPTURE_CHANNEL_0, current_compare);
|
|
||||||
|
|
||||||
tc_enable_callback(MP_STATE_VM(pulseout_tc_instance), TC_CALLBACK_CC_CHANNEL0);
|
|
||||||
turn_on(active_pincfg);
|
|
||||||
tc_start_counter(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
|
|
||||||
while(pulse_index < length) {
|
|
||||||
// Do other things while we wait. The interrupts will handle sending the
|
|
||||||
// signal.
|
|
||||||
#ifdef MICROPY_VM_HOOK_LOOP
|
|
||||||
MICROPY_VM_HOOK_LOOP
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
tc_stop_counter(MP_STATE_VM(pulseout_tc_instance));
|
|
||||||
tc_disable_callback(MP_STATE_VM(pulseout_tc_instance), TC_CALLBACK_CC_CHANNEL0);
|
|
||||||
active_pincfg = NULL;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user