aboutsummaryrefslogtreecommitdiffstats
path: root/HAL-afb/HAL_MOST_UNICENS/wrap_volume.c
blob: cf70647cb26ec7da7546f2635d470e28772c1c06 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
/*
 * Copyright (C) 2017, Microchip Technology Inc. and its subsidiaries.
 * Author Tobias Jahnke
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *   http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 * 
 */
#define _GNU_SOURCE 
#define AFB_BINDING_VERSION 2

#include <string.h>
#include <time.h>
#include <assert.h>
#include <json-c/json.h>
#include <afb/afb-binding.h>

#include "wrap_volume.h"
#include "wrap_unicens.h"
#include "libmostvolume.h"

static int wrap_volume_service_timeout_cb(sd_event_source* source,
        uint64_t timer __attribute__((__unused__)),
        void *userdata __attribute__((__unused__))) {
    
    uint8_t ret;

    sd_event_source_unref(source);
    ret = lib_most_volume_service();
    
    if (ret != 0U) {
        AFB_ERROR("lib_most_volume_service returns %d", ret);
    }
    
    return 0;
}

static void wrap_volume_service_cb(uint16_t timeout) {
    uint64_t usec;
    sd_event_now(afb_daemon_get_event_loop(), CLOCK_BOOTTIME, &usec);
    sd_event_add_time(  afb_daemon_get_event_loop(), NULL, CLOCK_MONOTONIC, 
                        usec + (timeout*1000), 
                        250, 
                        wrap_volume_service_timeout_cb, 
                        NULL);
}

/* Retrieves a new value adapted to a new maximum value. Minimum value is
 * always zero. */
static int wrap_volume_calculate(int value, int max_old, int max_new) {
    
    if (value > max_old)
        value = max_old;
    
    value = (value * max_new) / max_old; /* calculate range: 0..255 */
    assert(value <= max_new);
    
    return value;
}

extern int wrap_volume_init(void) {
    
    uint8_t ret = 0U;
    lib_most_volume_init_t mv_init;
    
    mv_init.writei2c_cb = &wrap_ucs_i2cwrite;
    mv_init.service_cb = wrap_volume_service_cb;
    
    ret = lib_most_volume_init(&mv_init);
    
    return ret * (-1);
}

extern int wrap_volume_master(int volume) {
    
    int new_value, ret;
    
    new_value = wrap_volume_calculate(volume, 100, 255);
    ret = lib_most_volume_set(LIB_MOST_VOLUME_MASTER, (uint8_t)new_value);
    
    if (ret != 0) {
        AFB_ERROR("wrap_volume_master: volume library not ready.");
        ret = ret * (-1); /* make return value negative */
    }
    
    return ret;
}

extern int wrap_volume_pcm(int *volume_ptr, int volume_sz) {
    
    const int MAX_PCM_CHANNELS = 6;
    int cnt, ret;
    assert(volume_ptr != NULL);
    assert(volume_sz <= MAX_PCM_CHANNELS);
    
    for (cnt = 0; cnt < volume_sz; cnt ++) {
        
        int new_value = wrap_volume_calculate(volume_ptr[cnt], 100, 255);
        ret = lib_most_volume_set((enum lib_most_volume_channel_t)cnt, (uint8_t)new_value);
        
        if (ret != 0) {
            AFB_ERROR("wrap_volume_pcm: volume library not ready.");
            ret = ret * (-1); /* make return value negative */
            break;
        }
    }
    
    return ret;
}