[POWERPC] Celleb: support spu priv1 ops

SPU support routines for Celleb platform.

Signed-off-by: Kou Ishizaki <kou.ishizaki@toshiba.co.jp>
Acked-by: Arnd Bergmann <arnd.bergmann@de.ibm.com>
Signed-off-by: Paul Mackerras <paulus@samba.org>

diff --git a/arch/powerpc/platforms/celleb/spu_priv1.c b/arch/powerpc/platforms/celleb/spu_priv1.c
new file mode 100644 (file)
index 0000000..2bf6700
--- /dev/null
+++ b/arch/powerpc/platforms/celleb/spu_priv1.c
@@ -0,0 +1,208 @@
+/*
+ * spu hypervisor abstraction for Beat
+ *
+ * (C) Copyright 2006-2007 TOSHIBA CORPORATION
+ *
+ * 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 <linux/module.h>
+
+#include <asm/types.h>
+#include <asm/spu.h>
+#include <asm/spu_priv1.h>
+
+#include "beat_wrapper.h"
+
+static inline void _int_mask_set(struct spu *spu, int class, u64 mask)
+{
+       spu->shadow_int_mask_RW[class] = mask;
+       beat_set_irq_mask_for_spe(spu->spe_id, class, mask);
+}
+
+static inline u64 _int_mask_get(struct spu *spu, int class)
+{
+       return spu->shadow_int_mask_RW[class];
+}
+
+static void int_mask_set(struct spu *spu, int class, u64 mask)
+{
+       _int_mask_set(spu, class, mask);
+}
+
+static u64 int_mask_get(struct spu *spu, int class)
+{
+       return _int_mask_get(spu, class);
+}
+
+static void int_mask_and(struct spu *spu, int class, u64 mask)
+{
+       u64 old_mask;
+       old_mask = _int_mask_get(spu, class);
+       _int_mask_set(spu, class, old_mask & mask);
+}
+
+static void int_mask_or(struct spu *spu, int class, u64 mask)
+{
+       u64 old_mask;
+       old_mask = _int_mask_get(spu, class);
+       _int_mask_set(spu, class, old_mask | mask);
+}
+
+static void int_stat_clear(struct spu *spu, int class, u64 stat)
+{
+       beat_clear_interrupt_status_of_spe(spu->spe_id, class, stat);
+}
+
+static u64 int_stat_get(struct spu *spu, int class)
+{
+       u64 int_stat;
+       beat_get_interrupt_status_of_spe(spu->spe_id, class, &int_stat);
+       return int_stat;
+}
+
+static void cpu_affinity_set(struct spu *spu, int cpu)
+{
+       return;
+}
+
+static u64 mfc_dar_get(struct spu *spu)
+{
+       u64 dar;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_dar_RW), &dar);
+       return dar;
+}
+
+static u64 mfc_dsisr_get(struct spu *spu)
+{
+       u64 dsisr;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_dsisr_RW), &dsisr);
+       return dsisr;
+}
+
+static void mfc_dsisr_set(struct spu *spu, u64 dsisr)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_dsisr_RW), dsisr);
+}
+
+static void mfc_sdr_setup(struct spu *spu)
+{
+       return;
+}
+
+static void mfc_sr1_set(struct spu *spu, u64 sr1)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_sr1_RW), sr1);
+}
+
+static u64 mfc_sr1_get(struct spu *spu)
+{
+       u64 sr1;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_sr1_RW), &sr1);
+       return sr1;
+}
+
+static void mfc_tclass_id_set(struct spu *spu, u64 tclass_id)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_tclass_id_RW), tclass_id);
+}
+
+static u64 mfc_tclass_id_get(struct spu *spu)
+{
+       u64 tclass_id;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, mfc_tclass_id_RW), &tclass_id);
+       return tclass_id;
+}
+
+static void tlb_invalidate(struct spu *spu)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, tlb_invalidate_entry_W), 0ul);
+}
+
+static void resource_allocation_groupID_set(struct spu *spu, u64 id)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, resource_allocation_groupID_RW),
+               id);
+}
+
+static u64 resource_allocation_groupID_get(struct spu *spu)
+{
+       u64 id;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, resource_allocation_groupID_RW),
+               &id);
+       return id;
+}
+
+static void resource_allocation_enable_set(struct spu *spu, u64 enable)
+{
+       beat_set_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, resource_allocation_enable_RW),
+               enable);
+}
+
+static u64 resource_allocation_enable_get(struct spu *spu)
+{
+       u64 enable;
+       beat_get_spe_privileged_state_1_registers(
+               spu->spe_id,
+               offsetof(struct spu_priv1, resource_allocation_enable_RW),
+               &enable);
+       return enable;
+}
+
+const struct spu_priv1_ops spu_priv1_beat_ops =
+{
+       .int_mask_and = int_mask_and,
+       .int_mask_or = int_mask_or,
+       .int_mask_set = int_mask_set,
+       .int_mask_get = int_mask_get,
+       .int_stat_clear = int_stat_clear,
+       .int_stat_get = int_stat_get,
+       .cpu_affinity_set = cpu_affinity_set,
+       .mfc_dar_get = mfc_dar_get,
+       .mfc_dsisr_get = mfc_dsisr_get,
+       .mfc_dsisr_set = mfc_dsisr_set,
+       .mfc_sdr_setup = mfc_sdr_setup,
+       .mfc_sr1_set = mfc_sr1_set,
+       .mfc_sr1_get = mfc_sr1_get,
+       .mfc_tclass_id_set = mfc_tclass_id_set,
+       .mfc_tclass_id_get = mfc_tclass_id_get,
+       .tlb_invalidate = tlb_invalidate,
+       .resource_allocation_groupID_set = resource_allocation_groupID_set,
+       .resource_allocation_groupID_get = resource_allocation_groupID_get,
+       .resource_allocation_enable_set = resource_allocation_enable_set,
+       .resource_allocation_enable_get = resource_allocation_enable_get,
+};