avr: added devices, more work on modules.
This commit is contained in:
@@ -54,12 +54,12 @@ CNY70_Init:
|
||||
rcall Utils_FillSram
|
||||
|
||||
; setup pins
|
||||
sbi CNY70_DDR_LED, CNY70_PINNUM_LED ; set DATA port as output
|
||||
sbi CNY70_PORT_LED, CNY70_PINNUM_LED ; LED off
|
||||
cbi CNY70_PORT_ADC, CNY70_PINNUM_ADC ; disable internal pullup for ADC
|
||||
cbi CNY70_DDR_ADC, CNY70_PINNUM_ADC ; set ADC port as input
|
||||
sbi CNY70_LED_DDR, CNY70_LED_PIN ; set DATA port as output
|
||||
sbi CNY70_LED_PORT, CNY70_LED_PIN ; LED off
|
||||
cbi CNY70_ADC_PORT, CNY70_ADC_PIN ; disable internal pullup for ADC
|
||||
cbi CNY70_ADC_DDR, CNY70_ADC_PIN ; set ADC port as input
|
||||
|
||||
ldi r16, CNY70_MUX_ADC ; select input pin, use Vcc as reference voltage
|
||||
ldi r16, CNY70_ADC_MUX ; select input pin, use Vcc as reference voltage
|
||||
out ADMUX, r16
|
||||
ldi r16, (1 << ADLAR)
|
||||
out ADCSRB, r16
|
||||
@@ -107,14 +107,14 @@ CNY70_OnTimer:
|
||||
sts cny70Flags, r16
|
||||
in r16, ADCH ; read value from ADC
|
||||
sts cny70LastData, r16
|
||||
sbi CNY70_PORT_LED, CNY70_PINNUM_LED ; LED off
|
||||
sbi CNY70_LED_PORT, CNY70_LED_PIN ; LED off
|
||||
nop
|
||||
nop
|
||||
nop
|
||||
ret
|
||||
|
||||
CNY70_OnTimer_startConversion:
|
||||
cbi CNY70_PORT_LED, CNY70_PINNUM_LED ; LED on
|
||||
cbi CNY70_LED_PORT, CNY70_LED_PIN ; LED on
|
||||
lds r16, cny70Flags
|
||||
ori r16, CNY70_FLAGS_ADC_STARTED
|
||||
sts cny70Flags, r16
|
||||
|
||||
Reference in New Issue
Block a user