sravan/system76-embedded-controller
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add initial commands

Browse Source
This commit is contained in:
Jeremy Soller
2020-02-17 11:02:39 -07:00
parent 4bfe981455
commit 493e61dfbc
1 changed files with 59 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

67
src/board/system76/lemp9/smfi.c
View File

@@ -1,15 +1,39 @@
#include <stdint.h>
#include <stdio.h>
#include <string.h>
#include <common/macro.h>
#include <common/version.h>
// Shared memory host semaphore
volatile uint8_t __xdata __at(0x1022) SMHSR;
// Host RAM window control
volatile uint8_t __xdata __at(0x105A) HRAMWC;
// Host RAM window 0 base address
volatile uint8_t __xdata __at(0x105B) HRAMW0BA;
// Host RAM window 1 base address
volatile uint8_t __xdata __at(0x105C) HRAMW1BA;
// Host RAM window 0 access allow size
volatile uint8_t __xdata __at(0x105D) HRAMW0AAS;
// Host RAM window 1 access allow size
volatile uint8_t __xdata __at(0x105E) HRAMW1AAS;
volatile uint8_t __xdata __at(0xC00) smfi_cmd[256];
volatile uint8_t __xdata __at(0xD00) smfi_dbg[256];
static volatile uint8_t __xdata __at(0xC00) smfi_cmd[256];
static volatile uint8_t __xdata __at(0xD00) smfi_dbg[256];
enum SmfiCmd {
SMFI_CMD_NONE = 0,
SMFI_CMD_PROBE = 1,
SMFI_CMD_BOARD = 2,
SMFI_CMD_VERSION = 3,
//TODO
};
enum SmfiRes {
SMFI_RES_OK = 0,
SMFI_RES_ERR = 1,
//TODO
};
void smfi_init(void) {
int i;
@@ -24,11 +48,6 @@ void smfi_init(void) {
smfi_dbg[i] = 0x00;
}
// Signature
smfi_cmd[1] = 0x76;
smfi_cmd[2] = 0xEC;
// Version
smfi_cmd[3] = 0x01;
// H2RAM window 0 address 0xC00 - 0xCFF, read/write
HRAMW0BA = 0xC0;
@@ -43,5 +62,37 @@ void smfi_init(void) {
}
void smfi_event(void) {
//TODO: when host semaphore occurs, read command
if (smfi_cmd[0]) {
// Default to success
smfi_cmd[1] = SMFI_RES_OK;
switch (smfi_cmd[0]) {
case SMFI_CMD_PROBE:
// Signature
smfi_cmd[2] = 0x76;
smfi_cmd[3] = 0xEC;
// Version
smfi_cmd[4] = 0x01;
break;
case SMFI_CMD_BOARD:
strncpy(&smfi_cmd[2], board(), ARRAY_SIZE(smfi_cmd) - 2);
break;
case SMFI_CMD_VERSION:
strncpy(&smfi_cmd[2], version(), ARRAY_SIZE(smfi_cmd) - 2);
break;
}
// Mark command as finished
smfi_cmd[0] = SMFI_CMD_NONE;
}
if (smfi_dbg[0]) {
int i;
for(i = 1; (i <= (int)smfi_dbg[0]) && (i < ARRAY_SIZE(smfi_dbg)); i++) {
putchar(smfi_dbg[i]);
}
// Mark debug transaction as complete
smfi_dbg[0] = 0;
}
}