mirror of
https://github.com/eddyem/IR-controller.git
synced 2026-03-22 01:31:31 +03:00
make some cleanup
This commit is contained in:
@@ -1,419 +0,0 @@
|
||||
/*
|
||||
* hardware_ini.c - functions for HW initialisation
|
||||
*
|
||||
* Copyright 2014 Edward V. Emelianov <eddy@sao.ru, edward.emelianoff@gmail.com>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301, USA.
|
||||
*/
|
||||
|
||||
/*
|
||||
* All hardware-dependent initialisation & definition should be placed here
|
||||
* and in hardware_ini.h
|
||||
*
|
||||
*/
|
||||
|
||||
#include "main.h"
|
||||
#include "hardware_ini.h"
|
||||
#include "onewire.h"
|
||||
|
||||
volatile uint16_t ADC_value[8]; // ADC DMA value
|
||||
|
||||
/*
|
||||
* Configure SPI ports
|
||||
*/
|
||||
/*
|
||||
* SPI1 remapped:
|
||||
* SCK - PB3
|
||||
* MISO - PB4
|
||||
* MOSI - PB5
|
||||
*/
|
||||
void SPI1_init(){
|
||||
// enable AFIO & other clocking
|
||||
rcc_peripheral_enable_clock(&RCC_APB2ENR,
|
||||
RCC_APB2ENR_SPI1EN | RCC_APB2ENR_AFIOEN | RCC_APB2ENR_IOPBEN);
|
||||
// remap SPI1 (change pins from PA5..7 to PB3..5); also turn off JTAG
|
||||
gpio_primary_remap(AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_OFF, AFIO_MAPR_SPI1_REMAP);
|
||||
// SCK, MOSI - push-pull output
|
||||
gpio_set_mode(GPIO_BANK_SPI1_RE_SCK, GPIO_MODE_OUTPUT_50_MHZ,
|
||||
GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_SPI1_RE_SCK);
|
||||
gpio_set_mode(GPIO_BANK_SPI1_RE_MOSI, GPIO_MODE_OUTPUT_50_MHZ,
|
||||
GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_SPI1_RE_MOSI);
|
||||
// MISO - opendrain in
|
||||
gpio_set_mode(GPIO_BANK_SPI1_RE_MISO, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO_SPI1_RE_MISO);
|
||||
spi_reset(SPI1);
|
||||
/* Set up SPI in Master mode with:
|
||||
* Clock baud rate: 1/128 of peripheral clock frequency (APB2, 72MHz)
|
||||
* Clock polarity: Idle High
|
||||
* Clock phase: Data valid on 2nd clock pulse
|
||||
* Data frame format: 8-bit
|
||||
* Frame format: MSB First
|
||||
*/
|
||||
spi_init_master(SPI1, SPI_CR1_BAUDRATE_FPCLK_DIV_128, SPI_CR1_CPOL_CLK_TO_1_WHEN_IDLE,
|
||||
SPI_CR1_CPHA_CLK_TRANSITION_2, SPI_CR1_DFF_8BIT, SPI_CR1_MSBFIRST);
|
||||
nvic_enable_irq(NVIC_SPI1_IRQ); // enable SPI interrupt
|
||||
}
|
||||
|
||||
/*
|
||||
* SPI2:
|
||||
* SCK - PB13
|
||||
* MISO - PB14
|
||||
* MOSI - PB15
|
||||
*/
|
||||
void SPI2_init(){
|
||||
// turn on clocking
|
||||
//rcc_periph_clock_enable(RCC_SPI2 | RCC_GPIOB);
|
||||
rcc_peripheral_enable_clock(&RCC_APB1ENR, RCC_APB1ENR_SPI2EN);
|
||||
rcc_peripheral_enable_clock(&RCC_APB2ENR, RCC_APB2ENR_AFIOEN | RCC_APB2ENR_IOPBEN);
|
||||
// SCK, MOSI - push-pull output
|
||||
gpio_set_mode(GPIO_BANK_SPI2_SCK, GPIO_MODE_OUTPUT_50_MHZ,
|
||||
GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_SPI2_SCK);
|
||||
gpio_set_mode(GPIO_BANK_SPI2_MOSI, GPIO_MODE_OUTPUT_50_MHZ,
|
||||
GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO_SPI2_MOSI);
|
||||
// MISO - opendrain in
|
||||
gpio_set_mode(GPIO_BANK_SPI2_MISO, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO_SPI2_MISO);
|
||||
spi_reset(SPI2);
|
||||
/* Set up SPI in Master mode with:
|
||||
* Clock baud rate: 1/64 of peripheral clock frequency (APB1, 36MHz)
|
||||
* Clock polarity: Idle High
|
||||
* Clock phase: Data valid on 2nd clock pulse
|
||||
* Data frame format: 8-bit
|
||||
* Frame format: MSB First
|
||||
*/
|
||||
spi_init_master(SPI2, SPI_CR1_BAUDRATE_FPCLK_DIV_64, SPI_CR1_CPOL_CLK_TO_1_WHEN_IDLE,
|
||||
SPI_CR1_CPHA_CLK_TRANSITION_2, SPI_CR1_DFF_8BIT, SPI_CR1_MSBFIRST);
|
||||
nvic_enable_irq(NVIC_SPI2_IRQ); // enable SPI interrupt
|
||||
}
|
||||
|
||||
/**
|
||||
* GPIO initialisaion: clocking + pins setup
|
||||
*/
|
||||
void GPIO_init(){
|
||||
/* rcc_periph_clock_enable(RCC_AFIO);
|
||||
rcc_periph_clock_enable(RCC_SPI1);
|
||||
rcc_periph_clock_enable(RCC_GPIOC);*/
|
||||
rcc_peripheral_enable_clock(&RCC_APB2ENR, RCC_APB2ENR_IOPAEN |
|
||||
RCC_APB2ENR_IOPBEN | RCC_APB2ENR_IOPCEN | RCC_APB2ENR_IOPDEN |
|
||||
RCC_APB2ENR_IOPEEN);
|
||||
// USB_DISC: push-pull
|
||||
gpio_set_mode(USB_DISC_PORT, GPIO_MODE_OUTPUT_2_MHZ,
|
||||
GPIO_CNF_OUTPUT_PUSHPULL, USB_DISC_PIN);
|
||||
// USB_POWER: open drain, externall pull down with R7 (22k)
|
||||
gpio_set_mode(USB_POWER_PORT, GPIO_MODE_INPUT,
|
||||
GPIO_CNF_INPUT_FLOAT, USB_POWER_PIN);
|
||||
// AD7794 addr + en
|
||||
gpio_set_mode(ADC_ADDR_PORT, GPIO_MODE_OUTPUT_2_MHZ,
|
||||
GPIO_CNF_OUTPUT_PUSHPULL, ADC_ADDR_MASK | ADC_EN_PIN); // ADDRESS: PD10..12; EN: PD13
|
||||
gpio_clear(ADC_ADDR_PORT, ADC_ADDR_MASK | ADC_EN_PIN); // clear address & turn switch off
|
||||
}
|
||||
|
||||
/*
|
||||
* SysTick used for system timer with period of 1ms
|
||||
*/
|
||||
void SysTick_init(){
|
||||
systick_set_clocksource(STK_CSR_CLKSOURCE_AHB_DIV8); // Systyck: 72/8=9MHz
|
||||
systick_set_reload(8999); // 9000 pulses: 1kHz
|
||||
systick_interrupt_enable();
|
||||
systick_counter_enable();
|
||||
}
|
||||
|
||||
/*
|
||||
* Due to inconvenient pins position on STM32F103VxT6 I had to make this strange location:
|
||||
* my channel # -> ADC1/2 channel #
|
||||
* 0 -> 9 PB1
|
||||
* 1 -> 8 PB0
|
||||
* 2 -> 15 PC5
|
||||
* 3 -> 14 PC4
|
||||
* 4 -> 7 PA7
|
||||
* 5 -> 6 PA6
|
||||
* 6 -> 5 PA5
|
||||
* 7 -> 4 PA4
|
||||
*/
|
||||
uint8_t adc_channel_array[16] = {9,8,15,14,7,6,5,4};
|
||||
#define ADC_CHANNELS_NUMBER 8
|
||||
|
||||
/**
|
||||
* Turn on ADC DMA for filling temperatures buffer
|
||||
*/
|
||||
void adc_dma_on(){
|
||||
// first configure DMA1 Channel1 (ADC1)
|
||||
dma_channel_reset(DMA1, DMA_CHANNEL1); //DMA_DeInit(DMA1_Channel1);
|
||||
dma_set_peripheral_address(DMA1, DMA_CHANNEL1, (uint32_t) &(ADC_DR(ADC1))); // DMA_InitStructure.DMA_PeripheralBaseAddr = ADC1_DR_Address;
|
||||
dma_set_memory_address(DMA1, DMA_CHANNEL1, (uint32_t) ADC_value); // DMA_InitStructure.DMA_MemoryBaseAddr = (uint32_t)&ADC_value;
|
||||
dma_set_number_of_data(DMA1, DMA_CHANNEL1, ADC_CHANNELS_NUMBER); // DMA_InitStructure.DMA_BufferSize = 1;
|
||||
dma_set_read_from_peripheral(DMA1, DMA_CHANNEL1); // DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralSRC;
|
||||
dma_enable_memory_increment_mode(DMA1, DMA_CHANNEL1); // DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Disable;
|
||||
dma_disable_peripheral_increment_mode(DMA1, DMA_CHANNEL1); // DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
|
||||
dma_set_peripheral_size(DMA1, DMA_CHANNEL1, DMA_CCR_PSIZE_16BIT); // DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;
|
||||
dma_set_memory_size(DMA1, DMA_CHANNEL1, DMA_CCR_MSIZE_16BIT); // DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord;
|
||||
dma_enable_circular_mode(DMA1, DMA_CHANNEL1); // DMA_InitStructure.DMA_Mode = DMA_Mode_Circular; DMA_InitStructure.DMA_M2M = DMA_M2M_Disable;
|
||||
dma_set_priority(DMA1, DMA_CHANNEL1, DMA_CCR_PL_HIGH); // DMA_InitStructure.DMA_Priority = DMA_Priority_High;
|
||||
nvic_disable_irq(NVIC_DMA1_CHANNEL1_IRQ);
|
||||
dma_disable_transfer_error_interrupt(DMA1, DMA_CHANNEL1);
|
||||
dma_disable_transfer_complete_interrupt(DMA1, DMA_CHANNEL1);
|
||||
dma_enable_channel(DMA1, DMA_CHANNEL1); // DMA_Cmd(DMA1_Channel1, ENABLE);
|
||||
}
|
||||
|
||||
void ADC_init(){
|
||||
rcc_peripheral_enable_clock(&RCC_APB2ENR, RCC_APB2ENR_ADC1EN); // enable clocking
|
||||
rcc_periph_clock_enable(RCC_ADC1);
|
||||
rcc_set_adcpre(RCC_CFGR_ADCPRE_PCLK2_DIV4);
|
||||
rcc_periph_clock_enable(RCC_GPIOA | RCC_GPIOB | RCC_GPIOC); // clocking for ADC ports
|
||||
// channels 4-7: PA7-PA4
|
||||
gpio_set_mode(GPIOA, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO4|GPIO5|GPIO6|GPIO7);
|
||||
// channels 0,1: PB1, PB0
|
||||
gpio_set_mode(GPIOB, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO0|GPIO1);
|
||||
// channels 2,3: PC5, PC4
|
||||
gpio_set_mode(GPIOC, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO4|GPIO5);
|
||||
|
||||
// Make sure the ADC doesn't run during config
|
||||
adc_off(ADC1);
|
||||
rcc_periph_clock_enable(RCC_DMA1);
|
||||
|
||||
adc_dma_on();
|
||||
|
||||
// Configure ADC as continuous scan mode with DMA
|
||||
adc_set_dual_mode(ADC_CR1_DUALMOD_IND); // ADC_InitStructure.ADC_Mode = ADC_Mode_Independent;
|
||||
adc_enable_scan_mode(ADC1); // ADC_InitStructure.ADC_ScanConvMode = ENABLE;
|
||||
adc_set_continuous_conversion_mode(ADC1); // ADC_InitStructure.ADC_ContinuousConvMode = ENABLE;
|
||||
adc_disable_external_trigger_regular(ADC1); // ADC_InitStructure.ADC_ExternalTrigConv = ADC_ExternalTrigConv_None;
|
||||
adc_set_right_aligned(ADC1); // ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right;
|
||||
adc_set_sample_time_on_all_channels(ADC1, ADC_SMPR_SMP_239DOT5CYC); // ADC_SampleTime_239Cycles5
|
||||
//adc_set_sample_time(ADC1, ADC_CHANNEL8, ADC_SMPR_SMP_239DOT5CYC); // ADC_RegularChannelConfig(ADC1, ADC_Channel_8, 1, ADC_SampleTime_239Cycles5);
|
||||
adc_enable_dma(ADC1); // ADC_DMACmd(ADC1, ENABLE);
|
||||
adc_power_on(ADC1); // ADC_Cmd(ADC1, ENABLE);
|
||||
}
|
||||
|
||||
/**
|
||||
* Starts ADC calibration & after it runs ADC in continuous conversion mode
|
||||
* First call ADC_init(), than wait a little and call this function
|
||||
*/
|
||||
void ADC_calibrate_and_start(){
|
||||
adc_set_regular_sequence(ADC1, ADC_CHANNELS_NUMBER, adc_channel_array);
|
||||
adc_reset_calibration(ADC1);
|
||||
adc_calibration(ADC1);
|
||||
adc_start_conversion_regular(ADC1); // ADC_SoftwareStartConvCmd(ADC1, ENABLE);
|
||||
adc_start_conversion_direct(ADC1);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
uint16_t tim2_buff[TIM2_DMABUFF_SIZE];
|
||||
uint16_t tim2_inbuff[TIM2_DMABUFF_SIZE];
|
||||
int tum2buff_ctr = 0;
|
||||
uint8_t ow_done = 1;
|
||||
/**
|
||||
* this function sends bits of ow_byte (LSB first) to 1-wire line
|
||||
* @param ow_byte - byte to convert
|
||||
* @param Nbits - number of bits to send
|
||||
* @param ini - 1 to zero counter
|
||||
*/
|
||||
uint8_t OW_add_byte(_U_ uint8_t ow_byte, _U_ uint8_t Nbits, _U_ uint8_t ini){
|
||||
uint8_t i, byte;
|
||||
if(ini) tum2buff_ctr = 0;
|
||||
if(Nbits == 0) return 0;
|
||||
if(Nbits > 8) Nbits = 8;
|
||||
for(i = 0; i < Nbits; i++){
|
||||
if(ow_byte & 0x01){
|
||||
byte = OW_1;
|
||||
}else{
|
||||
byte = OW_0;
|
||||
}
|
||||
tim2_buff[tum2buff_ctr++] = byte;
|
||||
if(tum2buff_ctr == TIM2_DMABUFF_SIZE) return 0; // avoid buffer overflow
|
||||
ow_byte = ow_byte >> 1;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
/**
|
||||
* Fill output buffer with data from 1-wire
|
||||
* @param start_idx - index from which to start (bit number)
|
||||
* @param N - data length (in **bytes**)
|
||||
* @outbuf - where to place data
|
||||
*/
|
||||
void read_from_OWbuf(_U_ uint8_t start_idx, _U_ uint8_t N, _U_ uint8_t *outbuf){
|
||||
uint8_t i, j, last = start_idx + N * 8, byte;
|
||||
if(last >= TIM2_DMABUFF_SIZE) last = TIM2_DMABUFF_SIZE;
|
||||
for(i = start_idx; i < last;){
|
||||
byte = 0;
|
||||
for(j = 0; j < 8; j++){
|
||||
byte >>= 1;
|
||||
if(tim2_inbuff[i++] < OW_READ1)
|
||||
byte |= 0x80;
|
||||
}
|
||||
*outbuf++ = byte;
|
||||
}
|
||||
}
|
||||
// there's a mistake in opencm3, so redefine this if needed (TIM_CCMR2_CC3S_IN_TI1 -> TIM_CCMR2_CC3S_IN_TI4)
|
||||
#ifndef TIM_CCMR2_CC3S_IN_TI4
|
||||
#define TIM_CCMR2_CC3S_IN_TI4 (2)
|
||||
#endif
|
||||
void init_ow_dmatimer(){ // tim2_ch4 - PA3, no remap
|
||||
gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ,
|
||||
GPIO_CNF_OUTPUT_ALTFN_OPENDRAIN, GPIO3);
|
||||
rcc_periph_clock_enable(RCC_TIM2);
|
||||
rcc_periph_clock_enable(RCC_DMA1);
|
||||
timer_reset(TIM2);
|
||||
// timers have frequency of 1MHz -- 1us for one step
|
||||
// 36MHz of APB1
|
||||
timer_set_mode(TIM2, TIM_CR1_CKD_CK_INT, TIM_CR1_CMS_EDGE, TIM_CR1_DIR_UP);
|
||||
// 72MHz div 72 = 1MHz
|
||||
TIM2_PSC = 71; // prescaler is (div - 1)
|
||||
TIM2_CR1 &= ~(TIM_CR1_OPM | TIM_CR1_UDIS); // continuous mode & enable update events
|
||||
TIM2_CR1 |= TIM_CR1_ARPE; // changing period immediately
|
||||
TIM2_ARR = OW_BIT; // default period of timer
|
||||
// PWM_OUT: TIM2_CH4; capture: TIM2_CH3
|
||||
// PWM edge-aligned mode & enable preload for CCR4, CC3 takes input from TI4
|
||||
TIM2_CCMR2 = TIM_CCMR2_OC4M_PWM1 | TIM_CCMR2_OC4PE | TIM_CCMR2_CC3S_IN_TI4;
|
||||
TIM2_CCR4 = 0; // set output value to 1 by clearing CCR4
|
||||
TIM2_EGR = TIM_EGR_UG; // update values of ARR & CCR4
|
||||
// set low polarity for CC4, high for CC4 & enable CC4 out and CC3 in
|
||||
TIM2_CCER = TIM_CCER_CC4P | TIM_CCER_CC4E | TIM_CCER_CC3E;
|
||||
}
|
||||
|
||||
void run_dmatimer(){
|
||||
ow_done = 0;
|
||||
DMA1_IFCR = DMA_ISR_TEIF7|DMA_ISR_HTIF7|DMA_ISR_TCIF7|DMA_ISR_GIF7 |
|
||||
DMA_ISR_TEIF1|DMA_ISR_HTIF1|DMA_ISR_TCIF1|DMA_ISR_GIF1; // clear flags
|
||||
|
||||
init_ow_dmatimer();
|
||||
|
||||
// TIM2_CH4 - DMA1, channel 7
|
||||
dma_channel_reset(DMA1, DMA_CHANNEL7);
|
||||
dma_set_peripheral_address(DMA1, DMA_CHANNEL7, (uint32_t) &(TIM_CCR4(TIM2)));
|
||||
dma_set_read_from_memory(DMA1, DMA_CHANNEL7);
|
||||
dma_enable_memory_increment_mode(DMA1, DMA_CHANNEL7);
|
||||
dma_disable_peripheral_increment_mode(DMA1, DMA_CHANNEL7);
|
||||
dma_set_peripheral_size(DMA1, DMA_CHANNEL7, DMA_CCR_PSIZE_16BIT);
|
||||
dma_set_memory_size(DMA1, DMA_CHANNEL7, DMA_CCR_MSIZE_16BIT);
|
||||
dma_enable_transfer_error_interrupt(DMA1, DMA_CHANNEL7);
|
||||
dma_enable_transfer_complete_interrupt(DMA1, DMA_CHANNEL7);
|
||||
dma_set_memory_address(DMA1, DMA_CHANNEL7, (uint32_t)tim2_buff);
|
||||
// TIM2_CH4 - DMA1, channel 7
|
||||
dma_channel_reset(DMA1, DMA_CHANNEL1);
|
||||
dma_set_peripheral_address(DMA1, DMA_CHANNEL1, (uint32_t) &(TIM_CCR3(TIM2)));
|
||||
dma_set_read_from_peripheral(DMA1, DMA_CHANNEL1);
|
||||
dma_enable_memory_increment_mode(DMA1, DMA_CHANNEL1);
|
||||
dma_disable_peripheral_increment_mode(DMA1, DMA_CHANNEL1);
|
||||
dma_set_peripheral_size(DMA1, DMA_CHANNEL1, DMA_CCR_PSIZE_16BIT);
|
||||
dma_set_memory_size(DMA1, DMA_CHANNEL1, DMA_CCR_MSIZE_16BIT);
|
||||
dma_enable_transfer_error_interrupt(DMA1, DMA_CHANNEL1);
|
||||
dma_enable_transfer_complete_interrupt(DMA1, DMA_CHANNEL1);
|
||||
nvic_enable_irq(NVIC_DMA1_CHANNEL1_IRQ);
|
||||
nvic_enable_irq(NVIC_DMA1_CHANNEL7_IRQ); // enable dma1_channel7_isr
|
||||
|
||||
TIM2_SR = 0; // clear all flags
|
||||
TIM2_CR1 &= ~TIM_CR1_OPM; // continuous mode
|
||||
timer_set_period(TIM2, OW_BIT); // bit length
|
||||
timer_generate_event(TIM2, TIM_EGR_UG); // update values
|
||||
dma_set_memory_address(DMA1, DMA_CHANNEL7, (uint32_t)tim2_buff);
|
||||
dma_set_number_of_data(DMA1, DMA_CHANNEL7, tum2buff_ctr);
|
||||
|
||||
//for(i = 0; i < TIM2_DMABUFF_SIZE; i++) tim2_inbuff[i] = 0;
|
||||
dma_set_memory_address(DMA1, DMA_CHANNEL1, (uint32_t) tim2_inbuff);
|
||||
dma_set_number_of_data(DMA1, DMA_CHANNEL1, tum2buff_ctr);
|
||||
|
||||
dma_enable_channel(DMA1, DMA_CHANNEL7);
|
||||
dma_enable_channel(DMA1, DMA_CHANNEL1);
|
||||
|
||||
timer_set_dma_on_compare_event(TIM2);
|
||||
TIM2_CCER |= TIM_CCER_CC3E; // enable input capture
|
||||
TIM2_DIER = TIM_DIER_CC4DE | TIM_DIER_CC3DE; // enable DMA events
|
||||
// set low polarity, enable cc out & enable input capture
|
||||
TIM2_CCER |= TIM_CCER_CC4P | TIM_CCER_CC4E | TIM_CCER_CC3E;
|
||||
TIM2_CR1 |= TIM_CR1_CEN; // run timer
|
||||
|
||||
}
|
||||
|
||||
uint16_t rstat = 0, lastcc3;
|
||||
void ow_reset(){
|
||||
ow_done = 0;
|
||||
rstat = 0;
|
||||
TIM2_SR = 0; // clear all flags
|
||||
TIM2_DIER = 0; // disable timer interrupts
|
||||
TIM2_ARR = OW_RESET_TIME; // set period to 1ms
|
||||
TIM2_CCR4 = OW_RESET; // zero pulse length
|
||||
TIM2_EGR = TIM_EGR_UG; // update values of ARR & CCR4
|
||||
TIM2_CR1 |= TIM_CR1_OPM | TIM_CR1_CEN; // we need only single pulse & run timer
|
||||
TIM2_SR = 0; // clear update flag generated after timer's running
|
||||
TIM2_DIER = TIM_DIER_UIE | TIM_DIER_CC3IE; // generate interrupts on update event & cc
|
||||
nvic_enable_irq(NVIC_TIM2_IRQ);
|
||||
}
|
||||
|
||||
void tim2_isr(){
|
||||
if(TIM2_SR & TIM_SR_UIF){ // update interrupt
|
||||
TIM2_SR &= ~TIM_SR_UIF; // clear flag
|
||||
TIM2_DIER = 0; // disable all timer interrupts
|
||||
TIM2_CCR4 = 0; // set output value to 1
|
||||
TIM2_EGR |= TIM_EGR_UG; // generate update event to change value in CCR4
|
||||
TIM2_CR1 &= ~TIM_CR1_CEN; // timer_disable_counter(TIM2);
|
||||
nvic_disable_irq(NVIC_TIM2_IRQ);
|
||||
ow_done = 1;
|
||||
rstat = lastcc3;
|
||||
print_int(rstat, lastsendfun);
|
||||
MSG("\n");
|
||||
}
|
||||
if(TIM2_SR & TIM_SR_CC3IF){ // we need this interrupt to store CCR3 value
|
||||
TIM2_SR = 0; // clear flag (we've manage TIM_SR_UIF before, so can simply do =0)
|
||||
lastcc3 = TIM2_CCR3;
|
||||
//TIM2_DIER &= ~TIM_DIER_CC3IE; // disable CCR3 interrupts
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void dma1_channel7_isr(){
|
||||
if(DMA1_ISR & DMA_ISR_TCIF7) {
|
||||
DMA1_IFCR = DMA_IFCR_CTCIF7;
|
||||
dma_disable_channel(DMA1, DMA_CHANNEL7);
|
||||
timer_disable_irq(TIM2, TIM_DIER_CC4DE);
|
||||
}else if(DMA1_ISR & DMA_ISR_TEIF7){
|
||||
DMA1_IFCR = DMA_IFCR_CTEIF7;
|
||||
MSG("out transfer error\n");
|
||||
}
|
||||
}
|
||||
|
||||
void dma1_channel1_isr(){
|
||||
int i;
|
||||
if(DMA1_ISR & DMA_ISR_TCIF1) {
|
||||
DMA1_IFCR = DMA_IFCR_CTCIF1;
|
||||
// TIM2_CCER &= ~TIM_CCER_CC4P; //timer_set_oc_polarity_high(TIM2, TIM_OC4);
|
||||
TIM2_CR1 &= ~TIM_CR1_CEN; // timer_disable_counter(TIM2);
|
||||
timer_disable_irq(TIM2, TIM_DIER_CC3DE);
|
||||
// gpio_set(GPIOA, GPIO3);
|
||||
dma_disable_channel(DMA1, DMA_CHANNEL1);
|
||||
nvic_disable_irq(NVIC_DMA1_CHANNEL1_IRQ);
|
||||
ow_done = 1;
|
||||
for(i = 0; i < tum2buff_ctr; i++){
|
||||
print_int(tim2_inbuff[i], lastsendfun);
|
||||
MSG(" ");
|
||||
}
|
||||
MSG("\n");
|
||||
}else if(DMA1_ISR & DMA_ISR_TEIF1){
|
||||
DMA1_IFCR = DMA_IFCR_CTEIF1;
|
||||
MSG("in transfer error\n");
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t OW_get_reset_status(){
|
||||
print_int(rstat, lastsendfun);
|
||||
MSG("\n");
|
||||
if(rstat < OW_PRESENT) return 0; // no devices
|
||||
return 1;
|
||||
}
|
||||
|
||||
Binary file not shown.
@@ -1,259 +0,0 @@
|
||||
/*
|
||||
* onewire.c - functions to work with 1-wire devices
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301, USA.
|
||||
*/
|
||||
#include "onewire.h"
|
||||
|
||||
#define OW_0 0x00
|
||||
#define OW_1 0xff
|
||||
#define OW_R 0xff
|
||||
#define OW_RST 0xf0
|
||||
|
||||
|
||||
uint8_t dev_amount = 0; // amount of 1-wire devices
|
||||
uint8_t ID_buf[64] = {0}; // 1-wire devices ID buffer (8 bytes for every device)
|
||||
uint8_t NUM_buf[8] = {0}; // numerical identificators for each sensor
|
||||
|
||||
/**
|
||||
* this function sends bits of ow_byte (LSB first) to 1-wire line
|
||||
* @param ow_byte - byte to convert
|
||||
* @param Nbits - number of bits to send
|
||||
*/
|
||||
void OW_SendBits(uint8_t ow_byte, uint8_t Nbits){
|
||||
uint8_t i, byte;
|
||||
if(Nbits == 0) return;
|
||||
if(Nbits > 8) Nbits = 8;
|
||||
for(i = 0; i < Nbits; i++){
|
||||
if(ow_byte & 0x01){
|
||||
byte = OW_1;
|
||||
}else{
|
||||
byte = OW_0;
|
||||
}
|
||||
fill_uart_buff(OW_USART_X, byte); // send next "bit"
|
||||
ow_byte = ow_byte >> 1;
|
||||
}
|
||||
}
|
||||
|
||||
void OW_ClearBuff(){
|
||||
UART_buff *curbuff = get_uart_buffer(OW_USART_X);
|
||||
curbuff->end = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Inverce conversion - read data (not more than 8 bits)
|
||||
*/
|
||||
uint8_t OW_ConvertByte(uint8_t *bits, uint8_t L){
|
||||
uint8_t ow_byte = 0, i, *st = bits;
|
||||
if(L > 8) L = 8; // forget all other data
|
||||
for(i = 0; i < L; i++, st++){
|
||||
ow_byte = ow_byte >> 1; // prepare for next bit filling
|
||||
if(*st == OW_1){
|
||||
ow_byte |= 0x80; // MSB = 1
|
||||
}
|
||||
}
|
||||
ow_byte >>= (8 - L);
|
||||
print_hex(bits, L, lastsendfun);
|
||||
lastsendfun(' ');
|
||||
print_hex(&ow_byte, 1, lastsendfun);
|
||||
newline(lastsendfun);
|
||||
return ow_byte; // shift to the end: L could be != 8 ???
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Configure peripherial ports (USART2) for 1-wire
|
||||
*/
|
||||
void OW_Init(){
|
||||
struct usb_cdc_line_coding owlc = {
|
||||
.dwDTERate = 115200,
|
||||
.bCharFormat = USB_CDC_1_STOP_BITS,
|
||||
.bParityType = USB_CDC_NO_PARITY,
|
||||
.bDataBits = 8,
|
||||
};
|
||||
UART_init(OW_USART_X);
|
||||
UART_setspeed(OW_USART_X, &owlc);
|
||||
}
|
||||
|
||||
/*
|
||||
* 1-wire reset
|
||||
* Reset procedure: USART settings are 9600,8,n,1,
|
||||
* send 0xf0 then check what we get
|
||||
* if not 0xf0 line is busy.
|
||||
* Other operations work with next USART settings: 115200,8,n,1
|
||||
*
|
||||
* return 1 in case of 1-wire devices present; otherwise return 0
|
||||
*/
|
||||
uint8_t OW_Reset(){
|
||||
uint8_t ow_presence;
|
||||
UART_buff *curbuff;
|
||||
// change speed to 9600
|
||||
usart_set_baudrate(OW_USART_X, 9600);
|
||||
//USART_ClearFlag(OW_USART_X, USART_FLAG_TC);
|
||||
fill_uart_buff(OW_USART_X, OW_RST); // send 1 byte data
|
||||
// wait for end of transmission
|
||||
while(!(USART_SR(OW_USART_X) & USART_SR_TC));
|
||||
curbuff = get_uart_buffer(OW_USART_X);
|
||||
if(!curbuff || !(curbuff->end)) return 0; // error reading
|
||||
curbuff->end = 0; // zero counter
|
||||
ow_presence = curbuff->buf[0];
|
||||
// change speed back
|
||||
usart_set_baudrate(OW_USART_X, 115200);
|
||||
// if there is any device on bus, it will pull it, so we'll get not 0xf0
|
||||
if(ow_presence != OW_RST){
|
||||
return 1;
|
||||
}
|
||||
// we get 0xf0 -> there's nothing on the bus
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* Procedure of 1-wire communications
|
||||
* variables:
|
||||
* @param sendReset - send RESET before transmission
|
||||
* @param command - bytes sent to the bus (if we want to read, send OW_READ_SLOT)
|
||||
* @param cLen - command buffer length (how many bytes to send)
|
||||
* @return 1 if succeed, 0 if failure
|
||||
*/
|
||||
uint8_t OW_Send(uint8_t sendReset, uint8_t *command, uint8_t cLen){
|
||||
// if reset needed - send RESET and check bus
|
||||
if(sendReset){
|
||||
if(OW_Reset() == 0){
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
while(cLen-- > 0){
|
||||
OW_SendBits(*command, 8);
|
||||
command++;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
/**
|
||||
* Check USART IN buffer for ready & fill user buffer with data on success
|
||||
* @param buflen - expected buffer length
|
||||
* @param data - pointer for reading buffer (if reading needed must be at least buflen-readStart bytes)
|
||||
* @param readStart - first byte to read (starts from 0) or OW_NO_READ (not read)
|
||||
* @return 0 if buffer not ready; 1 if OK
|
||||
*/
|
||||
uint8_t OW_Get(uint8_t buflen, uint8_t *data, uint8_t readStart){
|
||||
UART_buff *curbuff = get_uart_buffer(OW_USART_X);
|
||||
uint8_t *buff = curbuff->buf;
|
||||
if(curbuff->end < buflen/8) return 0;
|
||||
while(buflen-- > 0){
|
||||
if(readStart == 0){
|
||||
*data++ = OW_ConvertByte(buff, 8);
|
||||
}else{
|
||||
if(readStart != OW_NO_READ){
|
||||
readStart--;
|
||||
}
|
||||
}
|
||||
buff += 8;
|
||||
}
|
||||
curbuff->end = 0; // zero counter
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*
|
||||
* scan 1-wire bus
|
||||
* WARNING! The procedure works in real-time, so it is VERY LONG
|
||||
* num - max number of devices
|
||||
* buf - array for devices' ID's (8*num bytes)
|
||||
* return amount of founded devices
|
||||
*
|
||||
uint8_t OW_Scan(uint8_t *buf, uint8_t num){
|
||||
unsigned long path,next,pos;
|
||||
uint8_t bit,chk;
|
||||
uint8_t cnt_bit, cnt_byte, cnt_num;
|
||||
path=0;
|
||||
cnt_num=0;
|
||||
do{
|
||||
//(issue the 'ROM search' command)
|
||||
if( 0 == OW_WriteCmd(OW_SEARCH_ROM) ) return 0;
|
||||
OW_Wait_TX();
|
||||
OW_ClearBuff(); // clear RX buffer
|
||||
next = 0; // next path to follow
|
||||
pos = 1; // path bit pointer
|
||||
for(cnt_byte = 0; cnt_byte != 8; cnt_byte++){
|
||||
buf[cnt_num*8 + cnt_byte] = 0;
|
||||
for(cnt_bit = 0; cnt_bit != 8; cnt_bit++){
|
||||
//(read two bits, 'bit' and 'chk', from the 1-wire bus)
|
||||
OW_SendBits(OW_R, 2);
|
||||
OW_Wait_TX();
|
||||
bit = -----OW_ReadByte();
|
||||
chk = bit & 0x02; // bit 1
|
||||
bit = bit & 0x01; // bit 0
|
||||
if(bit && chk) return 0; // error
|
||||
if(!bit && !chk){ // collision, both are zero
|
||||
if (pos & path) bit = 1; // if we've been here before
|
||||
else next = (path&(pos-1)) | pos; // else, new branch for next
|
||||
pos <<= 1;
|
||||
}
|
||||
//(save this bit as part of the current ROM value)
|
||||
if (bit) buf[cnt_num*8 + cnt_byte]|=(1<<cnt_bit);
|
||||
//(write 'bit' to the 1-wire bus)
|
||||
OW_SendBits(bit, 1);
|
||||
OW_Wait_TX();
|
||||
}
|
||||
}
|
||||
path=next;
|
||||
cnt_num++;
|
||||
}while(path && cnt_num < num);
|
||||
return cnt_num;
|
||||
}*/
|
||||
|
||||
uint8_t OW_Scan(uint8_t *buf, uint8_t num){
|
||||
uint8_t flg, b[11], i;
|
||||
flg = OW_Send(1, (uint8_t*)"\xcc\x33\xff\xff\xff\xff\xff\xff\xff\xff\xff", 11);
|
||||
if(!flg) return 0;
|
||||
OW_Wait_TX();
|
||||
if(!OW_Get(11, b, 0)) return 0;
|
||||
num += 2;
|
||||
for(i = 2; i < num; i++) *buf++ = b[i];
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
//OW_USART_X
|
||||
/*
|
||||
void OW_getTemp(){
|
||||
uint8_t buf[9], i;
|
||||
void printTBuf(){
|
||||
uint8_t j;
|
||||
OW_Send(0, (uint8_t*)"\xbe\xff\xff\xff\xff\xff\xff\xff\xff\xff", 10, buf, 9, 1);
|
||||
for(j = 0; j != 9; j++)
|
||||
printInt(&buf[j], 1);
|
||||
newline();
|
||||
}
|
||||
// send broadcast message to start measurement
|
||||
if(!OW_Send(1, (uint8_t*)"\xcc\x44", 2)) return;
|
||||
Delay(1000);
|
||||
// read values
|
||||
if(dev_amount == 1){
|
||||
if(OW_WriteCmd(OW_SKIP_ROM)) printTBuf();
|
||||
}else{
|
||||
for(i = 0; i < dev_amount; i++){
|
||||
MSG("Device ", "ow");
|
||||
USB_Send_Data(i + '0');
|
||||
MSG(": ", 0);
|
||||
if(OW_WriteCmd(OW_MATCH_ROM)){
|
||||
OW_SendOnly(0, &ID_buf[i*8], 8);
|
||||
printTBuf();
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
*/
|
||||
@@ -1,196 +0,0 @@
|
||||
/*
|
||||
* onewire.c - functions to work with 1-wire devices
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
|
||||
* MA 02110-1301, USA.
|
||||
*/
|
||||
#include "onewire.h"
|
||||
|
||||
#define OW_0 0x00
|
||||
#define OW_1 0xff
|
||||
#define OW_R 0xff
|
||||
#define OW_RST 0xf0
|
||||
|
||||
|
||||
// In/Out buffer
|
||||
// uint8_t ow_buf[8];
|
||||
/**
|
||||
* this function sends bits of ow_byte (LSB first) to 1-wire line
|
||||
* @param ow_byte - byte to convert
|
||||
* @param Nbits - number of bits to send
|
||||
*/
|
||||
void OW_SendBits(uint8_t ow_byte, uint8_t Nbits){
|
||||
uint8_t i, byte;
|
||||
if(Nbits == 0) return;
|
||||
if(Nbits > 8) Nbits = 8;
|
||||
for(i = 0; i < Nbits; i++){
|
||||
if(ow_byte & 0x01){
|
||||
byte = OW_1;
|
||||
}else{
|
||||
byte = OW_0;
|
||||
}
|
||||
fill_uart_buff(OW_USART_X, byte); // send next "bit"
|
||||
ow_byte = ow_byte >> 1;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Inverce conversion - read data (not more than 8 bits)
|
||||
*/
|
||||
uint8_t OW_ReadByte(){
|
||||
UART_buff *curbuff = get_uart_buffer(OW_USART_X);
|
||||
uint8_t ow_byte = 0, i, L, *buf;
|
||||
if(!curbuff || !(L = curbuff->end)) return 0; // no data?
|
||||
if(L > 8) L = 8; // forget all other data
|
||||
buf = curbuff->buf;
|
||||
for(i = 0; i < L; i++, buf++){
|
||||
ow_byte = ow_byte >> 1; // prepare for next bit filling
|
||||
if(*buf == OW_1){
|
||||
ow_byte |= 0x80; // MSB = 1
|
||||
}
|
||||
}
|
||||
return ow_byte >> (8 - L); // shift to the end: L could be != 8 ???
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Configure peripherial ports (USART2) for 1-wire
|
||||
*/
|
||||
void OW_Init(){
|
||||
struct usb_cdc_line_coding owlc = {
|
||||
.dwDTERate = 115200,
|
||||
.bCharFormat = USB_CDC_1_STOP_BITS,
|
||||
.bParityType = USB_CDC_NO_PARITY,
|
||||
.bDataBits = 8,
|
||||
};
|
||||
UART_init(OW_USART_X);
|
||||
UART_setspeed(OW_USART_X, &owlc);
|
||||
}
|
||||
|
||||
/*
|
||||
* 1-wire reset
|
||||
* Reset procedure: USART settings are 9600,8,n,1,
|
||||
* send 0xf0 then check what we get
|
||||
* if not 0xf0 line is busy.
|
||||
* Other operations work with next USART settings: 115200,8,n,1
|
||||
*
|
||||
* return 1 in case of 1-wire devices present; otherwise return 0
|
||||
*/
|
||||
uint8_t OW_Reset() {
|
||||
uint8_t ow_presence;
|
||||
UART_buff *curbuff;
|
||||
// change speed to 9600
|
||||
usart_set_baudrate(OW_USART_X, 9600);
|
||||
//USART_ClearFlag(OW_USART_X, USART_FLAG_TC);
|
||||
fill_uart_buff(OW_USART_X, OW_RST); // send 1 byte data
|
||||
// wait for end of transmission
|
||||
while(!(USART_SR(OW_USART_X) & USART_SR_TC));
|
||||
curbuff = get_uart_buffer(OW_USART_X);
|
||||
if(!curbuff || !(curbuff->end)) return 0; // error reading
|
||||
curbuff->end = 0; // zero counter
|
||||
ow_presence = curbuff->buf[0];
|
||||
// change speed back
|
||||
usart_set_baudrate(OW_USART_X, 115200);
|
||||
// if there is any device on bus, it will pull it, so we'll get not 0xf0
|
||||
if(ow_presence != OW_RST){
|
||||
return 1;
|
||||
}
|
||||
// we get 0xf0 -> there's nothing on the bus
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Procedure of 1-wire communications
|
||||
* variables:
|
||||
* sendReset - send RESET before transmission
|
||||
* command - bytes sent to the bus (if we want to read, send OW_READ_SLOT)
|
||||
* cLen - command buffer length (how many bytes to send)
|
||||
* data - pointer for reading buffer (if reading needed)
|
||||
* readStart - first byte to read (starts from 0) or OW_NO_READ (not read)
|
||||
*
|
||||
* return 1 if succeed, 0 if failure
|
||||
*/
|
||||
uint8_t OW_Send(uint8_t sendReset, uint8_t *command, uint8_t cLen,
|
||||
uint8_t *data, uint8_t dLen, uint8_t readStart) {
|
||||
// if reset needed - send RESET and check bus
|
||||
if(sendReset){
|
||||
if(OW_Reset() == 0){
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
while(cLen > 0){
|
||||
OW_SendBits(*command, 8);
|
||||
command++;
|
||||
cLen--;
|
||||
// wait for EOT
|
||||
while(!(USART_SR(OW_USART_X) & USART_SR_TC));
|
||||
// put data from bus into user buffer
|
||||
if(readStart == 0 && dLen > 0){
|
||||
*data = OW_ReadByte();
|
||||
data++;
|
||||
dLen--;
|
||||
}else{
|
||||
if(readStart != OW_NO_READ){
|
||||
readStart--;
|
||||
}
|
||||
}
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*
|
||||
* scan 1-wire bus
|
||||
* num - max number of devices
|
||||
* buf - array for devices' ID's (8*num bytes)
|
||||
* return amount of founded devices
|
||||
*/
|
||||
uint8_t OW_Scan(uint8_t *buf, uint8_t num) {
|
||||
unsigned long path,next,pos;
|
||||
uint8_t bit,chk;
|
||||
uint8_t cnt_bit, cnt_byte, cnt_num;
|
||||
path=0;
|
||||
cnt_num=0;
|
||||
do{
|
||||
//(issue the 'ROM search' command)
|
||||
if( 0 == OW_WriteCmd(OW_SEARCH_ROM) ) return 0;
|
||||
next=0; // next path to follow
|
||||
pos=1; // path bit pointer
|
||||
for(cnt_byte = 0; cnt_byte != 8; cnt_byte++){
|
||||
buf[cnt_num*8 + cnt_byte] = 0;
|
||||
for(cnt_bit = 0; cnt_bit != 8; cnt_bit++){
|
||||
//(read two bits, 'bit' and 'chk', from the 1-wire bus)
|
||||
OW_SendBits(OW_R, 2);
|
||||
bit = OW_ReadByte();
|
||||
chk = bit & 0x02; // bit 1
|
||||
bit = bit & 0x01; // bit 0
|
||||
//bit = (ow_buf[0] == OW_1); chk = (ow_buf[1] == OW_1);
|
||||
if(bit && chk) return 0; // error
|
||||
if(!bit && !chk){ // collision, both are zero
|
||||
if (pos & path) bit = 1; // if we've been here before
|
||||
else next = (path&(pos-1)) | pos; // else, new branch for next
|
||||
pos <<= 1;
|
||||
}
|
||||
//(save this bit as part of the current ROM value)
|
||||
if (bit) buf[cnt_num*8 + cnt_byte]|=(1<<cnt_bit);
|
||||
//(write 'bit' to the 1-wire bus)
|
||||
OW_SendBits(bit, 1);
|
||||
}
|
||||
}
|
||||
//(output the just-completed ROM value)
|
||||
path=next;
|
||||
cnt_num++;
|
||||
}while(path && cnt_num < num);
|
||||
return cnt_num;
|
||||
}
|
||||
@@ -222,7 +222,7 @@ uint8_t move_motor(uint8_t num, int32_t steps){
|
||||
}*/
|
||||
// don't move motors if there's no power enough
|
||||
if(undervoltage_test(MOTORS_VOLTAGE_THRES)) return 0;
|
||||
if(num < 4){
|
||||
if(num < 3){
|
||||
for(curpos = 0; curpos < 4; curpos++)
|
||||
if(Motor_active[curpos]) N_active_in_group++;
|
||||
}else{
|
||||
|
||||
Reference in New Issue
Block a user