pokeysHal/PoKeysLibMatrixLED.c at main · zarfld/pokeysHal · GitHub

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
/*

Copyright (C) 2013 Matev� Bo�nak (matevz@poscope.com)

This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.

This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
Lesser General Public License for more details.

You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA

*/

#include "PoKeysLibHal.h"
#include "PoKeysLibCore.h"

int32_t PK_MatrixLEDConfigurationSet(sPoKeysDevice* device)
{
    if (device == NULL) return PK_ERR_NOT_CONNECTED;

    if (device->info.iMatrixLED == 0) return PK_ERR_GENERIC;

	// Update matrix LED configuration
	CreateRequest(device->request, 0xD5, 0, 0, 0, 0);
	device->request[3] = ((device->MatrixLED[0].displayEnabled ? 1 : 0) + (device->MatrixLED[1].displayEnabled ? 2 : 0));
	device->request[4] = ((device->MatrixLED[0].rows & 0x0F) + (device->MatrixLED[0].columns & 0x0F) * 16);
	device->request[5] = ((device->MatrixLED[1].rows & 0x0F) + (device->MatrixLED[1].columns & 0x0F) * 16);

	if (SendRequest(device) != PK_OK) return PK_ERR_TRANSFER;
	return PK_OK;
}

int32_t PK_MatrixLEDConfigurationGet(sPoKeysDevice* device)
{
    if (device == NULL) return PK_ERR_NOT_CONNECTED;

    if (device->info.iMatrixLED == 0) return PK_ERR_GENERIC;

	// Get matrix LED configuration
	CreateRequest(device->request, 0xD5, 1, 0, 0, 0);
	if (SendRequest(device) != PK_OK) return PK_ERR_TRANSFER;

	device->MatrixLED[0].displayEnabled = (device->response[3] & 1) > 0 ? 1 : 0;
	device->MatrixLED[0].rows = device->response[4] & 0x0F;
	device->MatrixLED[0].columns = (device->response[4] >> 4) & 0x0F;

	device->MatrixLED[1].displayEnabled = (device->response[3] & 2) > 0 ? 1 : 0;
	device->MatrixLED[1].rows = device->response[5] & 0x0F;
	device->MatrixLED[1].columns = (device->response[5] >> 4) & 0x0F;

	return PK_OK;
}

int32_t PK_MatrixLEDUpdate(sPoKeysDevice* device)
{
    uint32_t i, j;
    uint8_t displayCode[] = {1, 11};

    if (device == NULL) return PK_ERR_NOT_CONNECTED;

    if (device->info.iMatrixLED == 0) return PK_ERR_GENERIC;

	// Update matrix LEDs
	for (i = 0; i < device->info.iMatrixLED; i++)
	{
		if (device->MatrixLED[i].RefreshFlag)
		{
			CreateRequest(device->request, 0xD6, displayCode[i], 0, 0, 0);

			for (j = 0; j < 8; j++)
			{
				device->request[8 + j] = device->MatrixLED[i].data[j];
			}
			if (SendRequest(device) != PK_OK) return PK_ERR_TRANSFER;
			device->MatrixLED[i].RefreshFlag = 0;
		}
	}

	return PK_OK;
}