amiro-os / unittests / periphery-lld / src / ut_alld_AT42QT1050_v1.c @ b93c5d98
History | View | Annotate | Download (18.244 KB)
1 | bffb3465 | Thomas Schöpping | /*
|
---|---|---|---|
2 | AMiRo-OS is an operating system designed for the Autonomous Mini Robot (AMiRo) platform.
|
||
3 | Copyright (C) 2016..2019 Thomas Schöpping et al.
|
||
4 | |||
5 | This program is free software: you can redistribute it and/or modify
|
||
6 | it under the terms of the GNU General Public License as published by
|
||
7 | the Free Software Foundation, either version 3 of the License, or
|
||
8 | (at your option) any later version.
|
||
9 | |||
10 | This program is distributed in the hope that it will be useful,
|
||
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
13 | GNU General Public License for more details.
|
||
14 | |||
15 | You should have received a copy of the GNU General Public License
|
||
16 | along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
17 | */
|
||
18 | |||
19 | ddf34c3d | Thomas Schöpping | #include <amiroos.h> |
20 | 2a4dbf93 | Thomas Schöpping | #include <ut_alld_AT42QT1050_v1.h> |
21 | bffb3465 | Thomas Schöpping | |
22 | ddf34c3d | Thomas Schöpping | #if ((AMIROOS_CFG_TESTS_ENABLE == true) && defined(AMIROLLD_CFG_AT42QT1050) && (AMIROLLD_CFG_AT42QT1050 == 1)) || defined(__DOXYGEN__) |
23 | f3ac1c96 | Thomas Schöpping | /******************************************************************************/
|
24 | /* LOCAL DEFINITIONS */
|
||
25 | /******************************************************************************/
|
||
26 | bffb3465 | Thomas Schöpping | |
27 | #define INTERRUPT_EVENT_ID 1 |
||
28 | |||
29 | f3ac1c96 | Thomas Schöpping | /******************************************************************************/
|
30 | /* EXPORTED VARIABLES */
|
||
31 | /******************************************************************************/
|
||
32 | |||
33 | /******************************************************************************/
|
||
34 | /* LOCAL TYPES */
|
||
35 | /******************************************************************************/
|
||
36 | |||
37 | /******************************************************************************/
|
||
38 | /* LOCAL VARIABLES */
|
||
39 | /******************************************************************************/
|
||
40 | |||
41 | /******************************************************************************/
|
||
42 | /* LOCAL FUNCTIONS */
|
||
43 | /******************************************************************************/
|
||
44 | |||
45 | 651cb6e6 | Felix Wittenfeld | void print_settings(apalExitStatus_t* status, BaseSequentialStream* stream, aos_unittest_t* ut) {
|
46 | chprintf(stream, "settings...\n");
|
||
47 | |||
48 | uint8_t test8; |
||
49 | at42qt1050_lld_register_t txbuf; |
||
50 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_LOWPOWERMODE, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
51 | chprintf(stream, "\tmeasurement inverval %d ms\n", test8*8); |
||
52 | |||
53 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_MAXONDURATION, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
54 | chprintf(stream, "\tMax on duration %d ms\n", test8*160); |
||
55 | |||
56 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_FINFOUTMAXCALGUARD, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
57 | chprintf(stream, "\tFast In %d, Fast Out, %d MaxCal %d\n\tGuard channel ",
|
||
58 | test8 & AT42QT1050_LLD_FINFOUTMAXCALGUARD_FI, //enter fast mode whenever an unfiltered signal value is detected
|
||
59 | test8 & AT42QT1050_LLD_FINFOUTMAXCALGUARD_FO, //DI of 4 (global setting for all keys)
|
||
60 | test8 & AT42QT1050_LLD_FINFOUTMAXCALGUARD_MAXCAL);//recalibrate ALL KEYS after a Max On Duration timeout vs. individually
|
||
61 | |||
62 | //guard channel (which gets priority filtering)
|
||
63 | if((test8 & AT42QT1050_LLD_FINFOUTMAXCALGUARD_GUARD) > AT42QT1050_LLD_NUM_KEYS-1) |
||
64 | chprintf(stream, "off");
|
||
65 | else
|
||
66 | chprintf(stream, " %d", test8 & AT42QT1050_LLD_FINFOUTMAXCALGUARD_GUARD);
|
||
67 | |||
68 | chprintf(stream, "\n\n\tkey\tgroup\tintegr.\tdelay\tthresh.\tpulse\tscale\n");
|
||
69 | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
||
70 | chprintf(stream, "\t%d\t", key);
|
||
71 | txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_INTEGRATOR_AKS_0, key); |
||
72 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
73 | if(!((at42qt1050_lld_detectionintegratoraksreg_t)test8).aks)
|
||
74 | chprintf(stream, "none\t");
|
||
75 | else
|
||
76 | chprintf(stream, "%d\t", ((at42qt1050_lld_detectionintegratoraksreg_t)test8).aks);
|
||
77 | |||
78 | if(!((at42qt1050_lld_detectionintegratoraksreg_t)test8).detection_integrator)
|
||
79 | chprintf(stream, "off", key);
|
||
80 | else
|
||
81 | chprintf(stream, "%d", ((at42qt1050_lld_detectionintegratoraksreg_t)test8).detection_integrator);
|
||
82 | |||
83 | txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_CHARGESHAREDELAY_0, key); |
||
84 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
85 | chprintf(stream, "\t+%d", test8);
|
||
86 | |||
87 | txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_NEGATIVETHRESHOLD_0, key); |
||
88 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
89 | chprintf(stream, "\t%d", test8);
|
||
90 | |||
91 | txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_PULSE_SCALE_0, key); |
||
92 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
93 | chprintf(stream, "\t%d\t%d\n", key, ((at42qt1050_lld_pulsescalereg_t)test8).pulse, ((at42qt1050_lld_pulsescalereg_t)test8).scale);
|
||
94 | } |
||
95 | |||
96 | } |
||
97 | |||
98 | void show_live(const uint8_t first_key, apalExitStatus_t* status, |
||
99 | BaseSequentialStream* stream, aos_unittest_t* ut) { |
||
100 | |||
101 | apalDbgAssert(first_key<5);
|
||
102 | |||
103 | event_listener_t event_listener; |
||
104 | aos_timestamp_t tstart, tcurrent, tend; |
||
105 | |||
106 | uint8_t keyStatus, detectionStatus; |
||
107 | uint16_t signal, reference; |
||
108 | uint8_t threshold[AT42QT1050_LLD_NUM_KEYS]; |
||
109 | |||
110 | chprintf(stream, "key, count, signal, ref, [threshold], \033[31mtouch\n\033[0m");
|
||
111 | |||
112 | //get thresholds
|
||
113 | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
||
114 | const at42qt1050_lld_register_t txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_NEGATIVETHRESHOLD_0, key);
|
||
115 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &threshold[key], ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
116 | } |
||
117 | chEvtRegister(((ut_at42qt1050data_t*)ut->data)->evtsource, &event_listener, INTERRUPT_EVENT_ID); |
||
118 | for(uint16_t i=0;; i++) { |
||
119 | aosSysGetUptime(&tstart); |
||
120 | //wait 1 second for a touch event
|
||
121 | tend = tstart + (MICROSECONDS_PER_SECOND); |
||
122 | |||
123 | for (uint8_t key = first_key; key < AT42QT1050_LLD_NUM_KEYS; ++key) {
|
||
124 | |||
125 | //highlight touched key
|
||
126 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_KEYSTATUS, &keyStatus, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
127 | if((key == 0 && keyStatus&AT42QT1050_LLD_KEYSTATUS_KEY0) |
||
128 | || (key == 1 && keyStatus&AT42QT1050_LLD_KEYSTATUS_KEY1)
|
||
129 | || (key == 2 && keyStatus&AT42QT1050_LLD_KEYSTATUS_KEY2)
|
||
130 | || (key == 3 && keyStatus&AT42QT1050_LLD_KEYSTATUS_KEY3)
|
||
131 | || (key == 4 && keyStatus&AT42QT1050_LLD_KEYSTATUS_KEY4))
|
||
132 | chprintf(stream, "\033[31m"); //red |
||
133 | else
|
||
134 | chprintf(stream, "\033[0m"); //black |
||
135 | |||
136 | *status |= at42qt1050_lld_read_keyssignal(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, key, &signal, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
137 | *status |= at42qt1050_lld_read_referencedata(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, key, &reference, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
138 | |||
139 | const uint16_t dist = (signal<reference?0:signal-reference); |
||
140 | chprintf(stream, "\033[Kkey %d, %d\t0x%04X 0x%04X [", key, dist, reference, signal);
|
||
141 | uint16_t stars=0;
|
||
142 | for(; stars < dist; stars++) {
|
||
143 | chprintf(stream, "0");
|
||
144 | if(stars > 40) { //max_stars = 40 |
||
145 | chprintf(stream, "+"); //more than max_stars |
||
146 | break;
|
||
147 | } |
||
148 | } |
||
149 | for(; stars < threshold[key]; stars++)
|
||
150 | chprintf(stream, " ");
|
||
151 | if(stars == threshold[key])
|
||
152 | chprintf(stream, "]");
|
||
153 | chprintf(stream, "\n\033[0m");
|
||
154 | } |
||
155 | |||
156 | aosSysGetUptime(&tcurrent); |
||
157 | // const aos_timestamp_t ttimeout = MICROSECONDS_PER_SECOND - ((tcurrent - tstart) % MICROSECONDS_PER_SECOND);
|
||
158 | const eventmask_t emask = chEvtWaitOneTimeout(EVENT_MASK(INTERRUPT_EVENT_ID), chTimeUS2I(tend));//ttimeout)); |
||
159 | const eventflags_t eflags = chEvtGetAndClearFlags(&event_listener);
|
||
160 | if (emask == EVENT_MASK(INTERRUPT_EVENT_ID) && eflags == ((ut_at42qt1050data_t*)ut->data)->evtflags) {
|
||
161 | // interrupt detected
|
||
162 | chprintf(stream, "interrupt ");
|
||
163 | } // else: timeout
|
||
164 | |||
165 | *status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_DETECTIONSTATUS, &detectionStatus, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
166 | if(detectionStatus & AT42QT1050_LLD_DETECTIONSTATUS_TOUCH)
|
||
167 | chprintf(stream, "touch ");
|
||
168 | if(detectionStatus & AT42QT1050_LLD_DETECTIONSTATUS_OVERFLOW)
|
||
169 | chprintf(stream, "overflow ");
|
||
170 | if(detectionStatus & AT42QT1050_LLD_DETECTIONSTATUS_CALIBRATE)
|
||
171 | chprintf(stream, "calibrate");
|
||
172 | chprintf(stream, "\033[K");
|
||
173 | |||
174 | if(i>=30) |
||
175 | break;
|
||
176 | |||
177 | chprintf(stream, "\033[%dF", 5-first_key); //cursor up |
||
178 | } |
||
179 | chEvtUnregister(((ut_at42qt1050data_t*)ut->data)->evtsource, &event_listener); |
||
180 | } |
||
181 | |||
182 | f3ac1c96 | Thomas Schöpping | /******************************************************************************/
|
183 | /* EXPORTED FUNCTIONS */
|
||
184 | /******************************************************************************/
|
||
185 | |||
186 | bffb3465 | Thomas Schöpping | aos_utresult_t utAlldAt42qt1050Func(BaseSequentialStream* stream, aos_unittest_t* ut) |
187 | { |
||
188 | 651cb6e6 | Felix Wittenfeld | aosDbgCheck(ut->data != NULL && ((ut_at42qt1050data_t*)ut->data)->at42qt1050d != NULL); |
189 | |||
190 | // local variables
|
||
191 | aos_utresult_t result = {0, 0}; |
||
192 | apalExitStatus_t status; |
||
193 | uint8_t test_8; |
||
194 | bool error;
|
||
195 | |||
196 | chprintf(stream, "read register...\n");
|
||
197 | error = false;
|
||
198 | status = at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_CHIPID, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
199 | chprintf(stream, "\t\tchip ID: 0x%02X\n", test_8);
|
||
200 | if (test_8 != AT42QT1050_LLD_CHIPID)
|
||
201 | error = true;
|
||
202 | status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_FIRMWAREVERSION, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
203 | chprintf(stream, "\t\tfirmware version: %u.%u (0x%02X)\n", ((at42qt1050_lld_firmwarereg_t)test_8).major, ((at42qt1050_lld_firmwarereg_t)test_8).minor, test_8);
|
||
204 | if (status == APAL_STATUS_SUCCESS && !error) {
|
||
205 | aosUtPassed(stream, &result); |
||
206 | } else {
|
||
207 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
208 | } |
||
209 | |||
210 | chprintf(stream, "write and readback threshold data...\n");
|
||
211 | status = APAL_STATUS_OK; |
||
212 | const uint8_t threshold_test = 0x40; |
||
213 | error = false;
|
||
214 | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
||
215 | const at42qt1050_lld_register_t txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_NEGATIVETHRESHOLD_0, key);
|
||
216 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, threshold_test , ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
217 | status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
218 | if(test_8 != threshold_test)
|
||
219 | error = true;
|
||
220 | } |
||
221 | if (status == APAL_STATUS_SUCCESS && !error) {
|
||
222 | aosUtPassedMsg(stream, &result, "Set thresholds successfull to 0x%04X\n", threshold_test);
|
||
223 | } else {
|
||
224 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
225 | } |
||
226 | |||
227 | chprintf(stream, "guarding...\nincrease charge_delay0\ndisable multitouch\n");
|
||
228 | |||
229 | //channel 0 is to big to be charged in the default cycle
|
||
230 | status = at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_CHARGESHAREDELAY_0, 128 , ((ut_at42qt1050data_t*)ut->data)->timeout);
|
||
231 | |||
232 | //set all channel to group 1 -> only 1 simultaneous touch in group = single touch
|
||
233 | at42qt1050_lld_detectionintegratoraksreg_t detectionintegrator; |
||
234 | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
||
235 | const at42qt1050_lld_register_t txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_INTEGRATOR_AKS_0, key);
|
||
236 | detectionintegrator.aks = 1; //on touch per group-id simultaneous |
||
237 | detectionintegrator.detection_integrator = 4; //4 times > threshold => touchevent |
||
238 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, 0x11 , ((ut_at42qt1050data_t*)ut->data)->timeout);
|
||
239 | } |
||
240 | if (status == APAL_STATUS_SUCCESS) {
|
||
241 | aosUtPassed(stream, &result); |
||
242 | } else {
|
||
243 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
244 | } |
||
245 | |||
246 | chprintf(stream, "reset device...\n");
|
||
247 | status = at42qt1050_lld_reset(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, ((ut_at42qt1050data_t*)ut->data)->timeout, true);
|
||
248 | if (status == APAL_STATUS_SUCCESS) {
|
||
249 | aosUtPassed(stream, &result); |
||
250 | } else {
|
||
251 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
252 | } |
||
253 | |||
254 | chprintf(stream, "read threshold data again...\n");
|
||
255 | status = APAL_STATUS_OK; |
||
256 | const uint8_t threshold_default = 20; |
||
257 | error = false;
|
||
258 | bffb3465 | Thomas Schöpping | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
259 | 651cb6e6 | Felix Wittenfeld | const at42qt1050_lld_register_t txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_NEGATIVETHRESHOLD_0, key);
|
260 | status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
261 | if(test_8 != threshold_default)
|
||
262 | error = true;
|
||
263 | } |
||
264 | |||
265 | if (status == APAL_STATUS_SUCCESS && !error) {
|
||
266 | aosUtPassedMsg(stream, &result, "threshold 0x%04X = default\n", threshold_default);
|
||
267 | } else {
|
||
268 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
269 | } |
||
270 | |||
271 | chprintf(stream, "demo of default configuration:\n");
|
||
272 | status = APAL_STATUS_OK; |
||
273 | show_live(0, &status, stream, ut);
|
||
274 | if (status == APAL_STATUS_SUCCESS) {
|
||
275 | aosUtPassed(stream, &result); |
||
276 | } else {
|
||
277 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
278 | } |
||
279 | |||
280 | status = APAL_STATUS_OK; |
||
281 | chprintf(stream, "write configuration...\npuls + scale + threshold 16\n");
|
||
282 | at42qt1050_lld_pulsescalereg_t pulse_scale; |
||
283 | //values stored as exponent of 2
|
||
284 | pulse_scale.pulse = 0; // accumulate #pulses -> increase resolution & time to acquire |
||
285 | pulse_scale.scale = 0; // scale = average factor n: NewAvg = (NewData/n) + [OldAvg*(n-1/n)] -> decrease noise |
||
286 | status = at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_PULSE_SCALE_0, pulse_scale.raw , ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
287 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_PULSE_SCALE_3, 0x00u , ((ut_at42qt1050data_t*)ut->data)->timeout);
|
||
288 | pulse_scale.pulse = 4;
|
||
289 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_PULSE_SCALE_1, pulse_scale.raw , ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
290 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_PULSE_SCALE_2, pulse_scale.raw , ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
291 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_PULSE_SCALE_4, pulse_scale.raw , ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
292 | |||
293 | for (uint8_t key = 0; key < AT42QT1050_LLD_NUM_KEYS; ++key) { |
||
294 | const at42qt1050_lld_register_t txbuf = at42qt1050_lld_addr_calc(AT42QT1050_LLD_REG_NEGATIVETHRESHOLD_0, key);
|
||
295 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, txbuf, 16, ((ut_at42qt1050data_t*)ut->data)->timeout);
|
||
296 | } |
||
297 | chprintf(stream, "disable guard key\n");
|
||
298 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_INTEGRATOR_AKS_0, 0 , ((ut_at42qt1050data_t*)ut->data)->timeout); //disable key |
||
299 | status |= at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_FINFOUTMAXCALGUARD, 8 , ((ut_at42qt1050data_t*)ut->data)->timeout); //disable feature |
||
300 | |||
301 | chprintf(stream, "calibrate...\n");
|
||
302 | status = at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_RESET_CALIBRATE, AT42QT1050_LLD_RESETCALIBRATE_CALIBRATE, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
303 | |||
304 | |||
305 | |||
306 | //wait for calibration to complete
|
||
307 | error = true;
|
||
308 | for(uint8_t i=0; i<0xFF; i++) { |
||
309 | usleep(10);
|
||
310 | status |= at42qt1050_lld_read_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_DETECTIONSTATUS, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
311 | if(!(test_8 & AT42QT1050_LLD_DETECTIONSTATUS_CALIBRATE)) {
|
||
312 | error = false;
|
||
313 | break;
|
||
314 | } |
||
315 | } |
||
316 | if (status == APAL_STATUS_SUCCESS) {
|
||
317 | aosUtPassed(stream, &result); |
||
318 | } else {
|
||
319 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
320 | } |
||
321 | chprintf(stream, "demo of custom configuration:\n");
|
||
322 | status = APAL_STATUS_OK; |
||
323 | show_live(1, &status, stream, ut);
|
||
324 | if (status == APAL_STATUS_SUCCESS) {
|
||
325 | aosUtPassed(stream, &result); |
||
326 | } else {
|
||
327 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
328 | } |
||
329 | |||
330 | status = APAL_STATUS_OK; |
||
331 | print_settings(&status, stream, ut); |
||
332 | if (status == APAL_STATUS_SUCCESS) {
|
||
333 | aosUtPassed(stream, &result); |
||
334 | } else {
|
||
335 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
336 | } |
||
337 | |||
338 | chprintf(stream, "shutdown touch\n");
|
||
339 | test_8 = 0; //Power down |
||
340 | status = at42qt1050_lld_write_reg(((ut_at42qt1050data_t*)ut->data)->at42qt1050d, AT42QT1050_LLD_REG_LOWPOWERMODE, &test_8, ((ut_at42qt1050data_t*)ut->data)->timeout); |
||
341 | if (status == APAL_STATUS_SUCCESS) {
|
||
342 | aosUtPassed(stream, &result); |
||
343 | } else {
|
||
344 | aosUtFailedMsg(stream, &result, "0x%08X\n", status);
|
||
345 | } |
||
346 | |||
347 | aosUtInfoMsg(stream,"driver object memory footprint: %u bytes\n", sizeof(AT42QT1050Driver)); |
||
348 | |||
349 | return result;
|
||
350 | bffb3465 | Thomas Schöpping | } |
351 | |||
352 | 651cb6e6 | Felix Wittenfeld | #endif |