Mam mały problem z pisaniem biblioteki do diod ws2812, a dokładniej, podejrzewam, że z funkcją ws_set_pixel. Wnioskuje to z tego, że gdy wywołuje taki prosty kod w funkcji main:
[syntax=c]ws_set_pixel(pasek, 1,0x0f0000);
ws281x_asm_send(pasek, 3,WS_PIN);[/syntax]
to nie ma żadnej reakcji ze strony diod. Kompilacja przebiega bezproblemowo, wgrywanie tak samo.
Sprawdziłem funkcję wywoływyjącą ws281x_asm_send(x,x,x) za pomocą funkcji ws_cnt i wszytsko gra.
Pracuje na ATmega32, kwarc 11,0592 MHZ.
Czy jes ktoś w stanie wskazać gdzie się pomyliłem?
Poniżej zamieszam kody:
main.c
[syntax=c]#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
#include <avr/pgmspace.h>
#include <string.h>
#include <stdlib.h>
#include "W2812/ws281x.h"
TWSRGB ws_rgb_leds [WS_LED_CNT]; //tworzenie tablicy
uint8_t * pasek = (uint8_t*)ws_rgb_leds;
int main(void){
while(1){
ws_set_pixel(pasek, 1,0x0f0000);
ws281x_asm_send(pasek, 3,WS_PIN);
}
}[/syntax]
ws281x.c
[syntax=c]#include <avr/io.h>
#include <util/delay.h>
#include <string.h>
#include "ws281x.h"
void ws_cls( void *line, uint32_t color ){
if( !color ) memset(line, 0, WS_LED_CNT*3);
else{
uint16_t x,i;
for( i=0; i<WS_LED_CNT;i++){
x=i*3;
*((uint8_t*)line + x) = color >> 8; //zielony
*((uint8_t*)line + x+1) = color >> 16;//czerwony
*((uint8_t*)line + x+2) = color;//niebieski
}
}
ws281x_asm_send( (uint8_t*)line, WS_LED_CNT, WS_PIN );
}
void ws_set_pixel ( void * line, int x, uint32_t color){
if( x<0 ) return;
if( x >= WS_LED_CNT) return;
*((uint8_t*)line + x*3) = color >> 8; //zielony
*((uint8_t*)line + x*3+1) = color >> 16;//czerwony
*((uint8_t*)line + x*3+2) = color;//niebieski
}
void ws_line ( void *line, int x, uint16_t len, uint32_t color){
int i;
for(i=0; i<(int)x+len; i++){
ws_set_pixel(line,i, color);
}
}
void ws281x_asm_send( void *data, uint16_t datlen, uint8_t pin){
uint8_t databyte=0, cnt, pinLO=~pin;
WS_DIR |= pin;
datlen *=3;
#if F_CPU == 11059200
asm volatile (
" lds %[cnt], %[ws_port] \n\t"
" or %[pinHI], %[cnt] \n\t"
" and %[pinLO], %[cnt] \n\t"
"mPTL%=:subi %A6,1 \n\t"
" sbci%B6,0 \n\t"
" brcsexit%= \n\t"
" ld%[databyte],X+ \n\t"
" ldi%[cnt],8 \n\t"
"oPTL%=:sts %[ws_port], %[pinHI] \n\t"
"nop \n\t"
" lsl%[databyte] \n\t"
" brcs.+2 \n\t"
" sts%[ws_port], %[pinLO] \n\t"
" rjmp.+0 \n\t"
" dec%[cnt] \n\t"
" sts%[ws_port], %[pinLO] \n\t"
" breqmPTL%= \n\t"
" rjmp.+0 \n\t"
" rjmpoPTL%= \n\t"
" exit%=: \n\t"
:[cnt]"=&d" (cnt)
:[databyte]"r" (databyte),
[ws_port]"M" (_SFR_MEM_ADDR(WS_PORT)),
[pinHI]"r" (pin),
[pinLO]"r"(pinLO),
[data]"x"(data),
[datlen]"r"(datlen)
);
#endif
}[/syntax]
ws281x.h
[syntax=c]#ifndef WS281X_H_
#define WS281X_H_
#define WS_PIN_NR PD7
#define WS_PIN ( 1<<WS_PIN_NR)
#define WS_PORT PORTD
#define WS_DIR DDRD
#define WS_LED_CNT 59
typedef struct{
uint8_t g;
uint8_t r;
uint8_t b;
} TWSRGB;
void ws_cls( void *line, uint32_t color );
void ws281x_asm_send( void *data, uint16_t datlen, uint8_t pin);
void ws_debug_test (void * line, uint32_t color );
void ws_set_pixel ( void * line, int x, uint32_t color);
void ws_line ( void *line, int x, uint16_t len, uint32_t color);
#endif /* W2812_WS281X_H_ */[/syntax]
@edit Ma ktoś pomysł?
Statystyki: Napisane przez sMarek — 20 kwi 2015, o 16:21
]]>