1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
5  *
6  * This program is free software: you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation, either version 3 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  */
19 
20 #include <config.h>
21 #include <math.h>
22 #include "protocol.h"
23 
get_memory_size(int type)24 SR_PRIV unsigned int get_memory_size(int type)
25 {
26 	if (type == MEMORY_SIZE_8K)
27 		return (8 * 1024);
28 	else if (type <= MEMORY_SIZE_8M)
29 		return (32 * 1024) << type;
30 	else
31 		return 0;
32 }
33 
clz(unsigned int x)34 static int clz(unsigned int x)
35 {
36 	int n = 0;
37 	if (x == 0)
38 		return 32;
39 	if (!(x & 0xFFFF0000)) {
40 		n = n + 16;
41 		x = x << 16;
42 	}
43 	if (!(x & 0xFF000000)) {
44 		n = n + 8;
45 		x = x << 8;
46 	}
47 	if (!(x & 0xF0000000)) {
48 		n = n + 4;
49 		x = x << 4;
50 	}
51 	if (!(x & 0xC0000000)) {
52 		n = n + 2;
53 		x = x << 2;
54 	}
55 	if (!(x & 0x80000000))
56 		n = n + 1;
57 	return n;
58 }
59 
set_limit_samples(struct dev_context * devc,uint64_t samples)60 SR_PRIV int set_limit_samples(struct dev_context *devc, uint64_t samples)
61 {
62 	if (samples > devc->max_sample_depth)
63 		samples = devc->max_sample_depth;
64 
65 	devc->limit_samples = samples;
66 
67 	if (samples <= (2 * 1024))
68 		devc->memory_size = MEMORY_SIZE_8K;
69 	else if (samples <= (16 * 1024))
70 		devc->memory_size = MEMORY_SIZE_64K;
71 	else
72 		devc->memory_size = 19 - clz(samples - 1);
73 
74 	sr_info("Setting memory size to %dK.",
75 		get_memory_size(devc->memory_size) / 1024);
76 
77 	analyzer_set_memory_size(devc->memory_size);
78 
79 	return SR_OK;
80 }
81 
set_voltage_threshold(struct dev_context * devc,double thresh)82 SR_PRIV int set_voltage_threshold(struct dev_context *devc, double thresh)
83 {
84 	if (thresh > 6.0)
85 		thresh = 6.0;
86 	if (thresh < -6.0)
87 		thresh = -6.0;
88 
89 	devc->cur_threshold = thresh;
90 
91 	analyzer_set_voltage_threshold((int) round(-9.1*thresh + 62.6));
92 
93 	sr_info("Setting voltage threshold to %fV.", devc->cur_threshold);
94 
95 	return SR_OK;
96 }
97 
set_triggerbar(struct dev_context * devc)98 SR_PRIV void set_triggerbar(struct dev_context *devc)
99 {
100 	unsigned int trigger_depth, triggerbar, ramsize_trigger;
101 
102 	trigger_depth = get_memory_size(devc->memory_size) / 4;
103 	if (devc->limit_samples < trigger_depth)
104 		trigger_depth = devc->limit_samples;
105 
106 	if (devc->trigger)
107 		triggerbar = (trigger_depth * devc->capture_ratio) / 100;
108 	else
109 		triggerbar = 0;
110 
111 	ramsize_trigger = trigger_depth - triggerbar;
112 	/* Matches USB packet captures from official app/driver */
113 	if (triggerbar > 2)
114 		triggerbar -= 2;
115 	else {
116 		ramsize_trigger -= 1;
117 		triggerbar = 0;
118 	}
119 
120 	analyzer_set_triggerbar_address(triggerbar);
121 	analyzer_set_ramsize_trigger_address(ramsize_trigger);
122 
123 	sr_dbg("triggerbar_address = %d(0x%x)", triggerbar, triggerbar);
124 	sr_dbg("ramsize_triggerbar_address = %d(0x%x)",
125 	       ramsize_trigger, ramsize_trigger);
126 }
127