summaryrefslogtreecommitdiffstats
path: root/carl9170fw/carlfw/src/cam.c
diff options
context:
space:
mode:
Diffstat (limited to 'carl9170fw/carlfw/src/cam.c')
-rw-r--r--carl9170fw/carlfw/src/cam.c161
1 files changed, 161 insertions, 0 deletions
diff --git a/carl9170fw/carlfw/src/cam.c b/carl9170fw/carlfw/src/cam.c
new file mode 100644
index 0000000..7c0e61c
--- /dev/null
+++ b/carl9170fw/carlfw/src/cam.c
@@ -0,0 +1,161 @@
+/*
+ * carl9170 firmware - used by the ar9170 wireless device
+ *
+ * Security Engine
+ *
+ * Copyright (c) 2000-2005 ZyDAS Technology Corporation
+ * Copyright (c) 2007-2009 Atheros Communications, Inc.
+ * Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
+ * Copyright 2009-2011 Christian Lamparter <chunkeey@googlemail.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program 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 General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ */
+
+#include "carl9170.h"
+#include "cam.h"
+
+#ifdef CONFIG_CARL9170FW_SECURITY_ENGINE
+static void disable_cam_user(const uint16_t userId)
+{
+ if (userId <= 31)
+ andl(AR9170_MAC_REG_CAM_ROLL_CALL_TBL_L, (~((uint32_t) 1 << userId)));
+ else if (userId <= 63)
+ andl(AR9170_MAC_REG_CAM_ROLL_CALL_TBL_H, (~((uint32_t) 1 << (userId - 32))));
+}
+
+static void enable_cam_user(const uint16_t userId)
+{
+ if (userId <= 31)
+ orl(AR9170_MAC_REG_CAM_ROLL_CALL_TBL_L, (((uint32_t) 1) << userId));
+ else if (userId <= 63)
+ orl(AR9170_MAC_REG_CAM_ROLL_CALL_TBL_H, (((uint32_t) 1) << (userId - 32)));
+}
+
+static void wait_for_cam_read_ready(void)
+{
+ while ((get(AR9170_MAC_REG_CAM_STATE) & AR9170_MAC_CAM_STATE_READ_PENDING) == 0) {
+ /*
+ * wait
+ */
+ }
+}
+
+static void wait_for_cam_write_ready(void)
+{
+ while ((get(AR9170_MAC_REG_CAM_STATE) & AR9170_MAC_CAM_STATE_WRITE_PENDING) == 0) {
+ /*
+ * wait some more
+ */
+ }
+}
+
+static void HW_CAM_Avail(void)
+{
+ uint32_t tmpValue;
+
+ do {
+ tmpValue = get(AR9170_MAC_REG_CAM_MODE);
+ } while (tmpValue & AR9170_MAC_CAM_HOST_PENDING);
+}
+
+static void HW_CAM_Write128(const uint32_t address, const uint32_t *data)
+{
+ HW_CAM_Avail();
+
+ set(AR9170_MAC_REG_CAM_DATA0, data[0]);
+ set(AR9170_MAC_REG_CAM_DATA1, data[1]);
+ set(AR9170_MAC_REG_CAM_DATA2, data[2]);
+ set(AR9170_MAC_REG_CAM_DATA3, data[3]);
+
+ set(AR9170_MAC_REG_CAM_ADDR, address | AR9170_MAC_CAM_ADDR_WRITE);
+
+ wait_for_cam_write_ready();
+}
+
+static void HW_CAM_Read128(const uint32_t address, uint32_t *data)
+{
+
+ HW_CAM_Avail();
+ set(AR9170_MAC_REG_CAM_ADDR, address);
+
+ wait_for_cam_read_ready();
+ HW_CAM_Avail();
+ data[0] = get(AR9170_MAC_REG_CAM_DATA0);
+ data[1] = get(AR9170_MAC_REG_CAM_DATA1);
+ data[2] = get(AR9170_MAC_REG_CAM_DATA2);
+ data[3] = get(AR9170_MAC_REG_CAM_DATA3);
+}
+
+void set_key(const struct carl9170_set_key_cmd *key)
+{
+ uint32_t data[4];
+ uint16_t row, wordId, nibbleId, i;
+
+ if (key->user > (AR9170_CAM_MAX_USER + 3))
+ return ;
+
+ if (key->keyId > 1)
+ return ;
+
+ /* Disable Key */
+ disable_cam_user(key->user);
+
+ /* Set encrypt type */
+ if (key->user >= AR9170_CAM_MAX_USER) {
+ /* default */
+ row = DEFAULT_ENCRY_TYPE;
+ wordId = 0;
+ nibbleId = (key->user - AR9170_CAM_MAX_USER) & 0x7;
+ } else {
+ row = ENCRY_TYPE_START_ADDR + (key->user >> 5);
+ wordId = (key->user >> 3) & 0x3;
+ nibbleId = key->user & 0x7;
+ }
+
+ HW_CAM_Read128(row, data);
+ data[wordId] &= (~(0xf << ((uint32_t) nibbleId * 4)));
+ data[wordId] |= (key->type << ((uint32_t) nibbleId * 4));
+ HW_CAM_Write128(row, data);
+
+ /* Set MAC address */
+ if (key->user < AR9170_CAM_MAX_USER) {
+ uint16_t byteId;
+ wordId = (key->user >> 2) & 0x3;
+ byteId = key->user & 0x3;
+ row = (key->user >> 4) * 6;
+
+ for (i = 0; i < 6; i++) {
+ HW_CAM_Read128(row + i, data);
+ data[wordId] &= (~(0xff << ((uint32_t) byteId * 8)));
+ data[wordId] |= (key->macAddr[i] << ((uint32_t) byteId * 8));
+ HW_CAM_Write128(row + i, data);
+ }
+ }
+
+ /* Set key */
+ row = KEY_START_ADDR + (key->user * 2) + key->keyId;
+
+ HW_CAM_Write128(row, key->key);
+
+ /* Enable Key */
+ enable_cam_user(key->user);
+}
+
+void disable_key(const struct carl9170_disable_key_cmd *key)
+{
+ disable_cam_user(key->user);
+}
+
+#endif /* CONFIG_CARL9170FW_SECURITY_ENGINE */