source: roaraudio/roard/driver_pwmled.c @ 5012:b263759832f1

Last change on this file since 5012:b263759832f1 was 4957:45ba4cf2abe3, checked in by phi, 13 years ago

use roar_mm_*() where possible

File size: 3.6 KB
Line 
1//driver_pwmled.c:
2
3/*
4 *      Copyright (C) Philipp 'ph3-der-loewe' Schafft - 2009-2011
5 *
6 *  This file is part of roard a part of RoarAudio,
7 *  a cross-platform sound system for both, home and professional use.
8 *  See README for details.
9 *
10 *  This file is free software; you can redistribute it and/or modify
11 *  it under the terms of the GNU General Public License version 3
12 *  as published by the Free Software Foundation.
13 *
14 *  RoarAudio is distributed in the hope that it will be useful,
15 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
16 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17 *  GNU General Public License for more details.
18 *
19 *  You should have received a copy of the GNU General Public License
20 *  along with this software; see the file COPYING.  If not, write to
21 *  the Free Software Foundation, 51 Franklin Street, Fifth Floor,
22 *  Boston, MA 02110-1301, USA.
23 *
24 */
25
26#include "roard.h"
27
28#if !defined(ROAR_WITHOUT_DCOMP_PWMLED) && !defined(ROAR_WITHOUT_VIO_DSTR)
29
30int driver_pwmled_open_vio  (struct roar_vio_calls * inst, char * device, struct roar_audio_info * info, int fh, struct roar_stream_server * sstream) {
31 struct roar_vio_defaults def;
32 struct driver_pwmled * self = roar_mm_malloc(sizeof(struct driver_pwmled));
33
34 if ( self == NULL )
35  return -1;
36
37 if ( fh == -1 ) {
38  if ( device == NULL )
39   device = "/dev/ttyS0";
40
41  if ( roar_vio_dstr_init_defaults(&def, ROAR_VIO_DEF_TYPE_NONE, O_WRONLY, 0644) == -1 ) {
42   roar_mm_free(self);
43   return -1;
44  }
45
46  if ( roar_vio_open_dstr(&(self->vio), device, &def, 1) == -1 ) {
47   roar_mm_free(self);
48   return -1;
49  }
50
51  inst->inst = self;
52 } else {
53/*
54  if ( roar_vio_open_fh(inst, fh) == -1 )
55   return -1;
56*/
57  roar_mm_free(self);
58  return -1;
59 }
60
61 inst->read     = NULL;
62 inst->write    = driver_pwmled_write;
63 inst->lseek    = NULL;
64 inst->nonblock = NULL;
65 inst->sync     = NULL;
66 inst->ctl      = driver_pwmled_ctl;
67 inst->close    = driver_pwmled_close;
68
69 info->codec = ROAR_CODEC_DMX512;
70
71 if ( info->rate == g_sa->rate ) {
72  self->rate = 9600;
73 } else {
74  self->rate = info->rate;
75 }
76
77 self->channel = 0;
78
79 if ( roar_light_pwm_new(&(self->state), 16) == -1 ) {
80  roar_mm_free(self);
81  return -1;
82 }
83
84 if ( sstream != NULL )
85  driver_pwmled_ctl(inst, ROAR_VIO_CTL_SET_SSTREAM, sstream);
86
87 return 0;
88}
89
90int     driver_pwmled_close (struct roar_vio_calls * vio) {
91 int ret = roar_vio_close(&(((struct driver_pwmled*)(vio->inst))->vio));
92
93 if ( vio->inst != NULL )
94  roar_mm_free(vio->inst);
95
96 return ret;
97}
98
99// TODO: this function should be optimized.
100ssize_t driver_pwmled_write (struct roar_vio_calls * vio,  void *buf, size_t count) {
101 struct driver_pwmled * self = vio->inst;
102 int value;
103
104 if ( vio == NULL || buf == NULL )
105  return -1;
106
107 if ( count != 512 )
108  return -1;
109
110 value = ((unsigned char*)buf)[self->channel] / 15;
111
112 if ( roar_light_pwm_set(&(self->state), value) == -1 )
113  return -1;
114
115// ROAR_WARN("driver_pwmled_write(*): value=%i", value);
116
117 if ( value ) {
118                                                                     // bit per word, bit per byte
119  return roar_light_pwm_send(&(self->state), &(self->vio), self->rate/11/8/100) == 0 ? count : -1;
120 }
121
122 return count;
123}
124
125int driver_pwmled_ctl(struct roar_vio_calls * vio, int cmd, void * data) {
126 struct driver_pwmled * self = vio->inst;
127
128 if ( vio == NULL )
129  return -1;
130
131 switch (cmd) {
132  case ROAR_VIO_CTL_SET_SSTREAM:
133    ROAR_STREAM(data)->dir = ROAR_DIR_LIGHT_OUT;
134    ROAR_STREAM_SERVER(data)->codec_orgi = ROAR_CODEC_DMX512;
135   break;
136  case ROAR_VIO_CTL_SET_DMXSCHAN:
137    if ( *(uint16_t*)data > 511 )
138     return -1;
139
140    self->channel = *(uint16_t*)data;
141   break;
142  default:
143   return -1;
144 }
145
146 return 0;
147}
148
149#endif
150
151//ll
Note: See TracBrowser for help on using the repository browser.