/* $Id$ */ /* * Copyright (c) 2011 Dimitri Sokolyuk * * Permission to use, copy, modify, and distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. */ #include #include #include "kernel.h" #include "tasks.h" void hsv(uint8_t *, uint8_t *, uint8_t *, uint16_t, uint8_t, uint8_t); void rgb(void *arg) { struct rgbarg *a = (struct rgbarg *)arg; uint32_t d = deadline(); uint32_t r = release(); uint16_t i = 0; uint8_t v; for (;;) { i = (i + 1) % 360; v = i % 120; v = (v < 60) ? 255 - 2 * v : 15 + 2 * v; hsv(a->r, a->g, a->b, i, 255, v); r = d; d += MSEC(28); update(r, d); } } void pwm(void *arg) { #define SCALE 4 struct pwmarg *a = (struct pwmarg *)arg; uint32_t d = deadline(); uint32_t r = release(); DDRB |= _BV(a->pin); PORTB &= ~_BV(a->pin); for (;;) { if (*a->value > 0) { PORTB |= _BV(a->pin); d = r += USEC(*a->value << SCALE); update(r, d); } if (*a->value < 255) { PORTB &= ~_BV(a->pin); d = r += USEC((255 - *a->value) << SCALE); update(r, d); } } }