-
Notifications
You must be signed in to change notification settings - Fork 0
/
wide_alu_driver.c
97 lines (83 loc) · 2.54 KB
/
wide_alu_driver.c
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
88
89
90
91
92
93
94
95
96
#include <wide_alu_driver.h>
#include <stdint.h>
#include <stdio.h>
#include "wide_alu.h"
#define WIDE_ALU0_BASE_ADDR 0x1A400000
void set_op(uint8_t operation)
{
uint32_t volatile *ctrl2_reg = (uint32_t *)(WIDE_ALU_CTRL2_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
uint32_t ctrl2_old_value = *ctrl2_reg;
*ctrl2_reg = ctrl2_old_value | (operation & WIDE_ALU_CTRL2_OPSEL_MASK);
}
void set_delay(uint8_t delay)
{
uint32_t volatile * ctrl2_reg = (uint32_t*)(WIDE_ALU_CTRL2_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
uint32_t ctrl2_old_value;
//Read old value
ctrl2_old_value = *ctrl2_reg;
//Overwrite operation bits
*ctrl2_reg = ctrl2_old_value | (delay & WIDE_ALU_CTRL2_DELAY_MASK);
}
void set_operands(uint32_t* a, uint32_t* b)
{
uint32_t volatile * op_a_reg_start = (uint32_t*)WIDE_ALU_OP_A_0_REG_OFFSET;
uint32_t volatile * op_b_reg_start = (uint32_t*)WIDE_ALU_OP_B_0_REG_OFFSET;
//Make sure we are in idle state before changing the operands
for (int i = 0; i<256/32; i++)
{
op_a_reg_start[i] = a[i];
op_b_reg_start[i] = b[i];
}
}
void trigger_op(void) {
uint32_t volatile *ctrl1_reg = (uint32_t *)(WIDE_ALU_CTRL1_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
asm volatile ("": : : "memory");
*ctrl1_reg = (1 & 0x1) << WIDE_ALU_CTRL1_TRIGGER_BIT;
asm volatile ("": : : "memory");
}
int poll_done(void)
{
uint32_t volatile * status_reg = (uint32_t*)(WIDE_ALU_STATUS_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
uint32_t current_status;
do {
current_status = (*status_reg)&WIDE_ALU_STATUS_CODE_MASK;
} while(current_status == WIDE_ALU_STATUS_CODE_VALUE_PENDING);
if (current_status == WIDE_ALU_STATUS_CODE_VALUE_IDLE)
return 0;
else
return current_status;
}
void get_result(uint32_t* result)
{
uint32_t volatile * result_reg_start = (uint32_t*)(WIDE_ALU_RESULT_0_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
for (int i = 0; i<512/32; i++)
{
result[i] = result_reg_start[i];
}
}
void clear_error(void)
{
uint32_t volatile * ctrl1_reg = (uint32_t*)(WIDE_ALU_CTRL1_REG_OFFSET + WIDE_ALU0_BASE_ADDR);
//Trigger operation by writing to trigger bit
*ctrl1_reg = (1 & 0x1)<<WIDE_ALU_CTRL1_CLEAR_ERR_BIT;
}
int wide_multiply(uint32_t a[8], uint32_t b[8], uint32_t result[16]) {
int status = poll_done();
if (status != 0) {
printf("error: setting up multiplication\n");
return status;
}
set_operands(a, b);
set_op(WIDE_ALU_CTRL2_OPSEL_VALUE_MUL);
trigger_op();
status = poll_done();
if (status != 0) {
printf("operation failed\n");
return status;
}
else
{
get_result(result);
return 0;
}
}