389 lines
6.8 KiB
Go
389 lines
6.8 KiB
Go
package asm
|
|
|
|
import (
|
|
"bytes"
|
|
"encoding/binary"
|
|
"fmt"
|
|
"io"
|
|
"log"
|
|
"math"
|
|
"strconv"
|
|
"strings"
|
|
|
|
"github.com/alecthomas/participle/v2"
|
|
"github.com/alecthomas/participle/v2/lexer"
|
|
|
|
"git.defalsify.org/festive/vm"
|
|
)
|
|
|
|
|
|
type Asm struct {
|
|
Instructions []*Instruction `@@*`
|
|
}
|
|
|
|
type Arg struct {
|
|
Sym *string `(@Sym Whitespace?)?`
|
|
Size *uint32 `(@Size Whitespace?)?`
|
|
Flag *uint8 `(@Size Whitespace?)?`
|
|
Selector *string `(@Sym Whitespace?)?`
|
|
Desc *string `(Quote ((@Sym | @Size) @Whitespace?)+ Quote Whitespace?)?`
|
|
}
|
|
|
|
func flush(b *bytes.Buffer, w io.Writer) (int, error) {
|
|
if w != nil {
|
|
return w.Write(b.Bytes())
|
|
}
|
|
return 0, nil
|
|
}
|
|
|
|
func parseDescType(b *bytes.Buffer, arg Arg) (int, error) {
|
|
var rn int
|
|
var err error
|
|
|
|
var selector string
|
|
if arg.Flag != nil {
|
|
selector = strconv.FormatUint(uint64(*arg.Flag), 10)
|
|
} else if arg.Selector != nil {
|
|
selector = *arg.Selector
|
|
}
|
|
|
|
var size string
|
|
if arg.Size != nil {
|
|
size = strconv.FormatUint(uint64(*arg.Size), 10)
|
|
n, err := writeSym(b, size)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
}
|
|
|
|
if arg.Sym != nil {
|
|
n, err := writeSym(b, *arg.Sym)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
}
|
|
|
|
if selector != "" {
|
|
n, err := writeSym(b, *arg.Selector)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
}
|
|
|
|
n, err := writeSym(b, *arg.Desc)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
return rn, nil
|
|
}
|
|
|
|
func parseTwoSym(b *bytes.Buffer, arg Arg) (int, error) {
|
|
var rn int
|
|
|
|
var selector string
|
|
var sym string
|
|
if arg.Size != nil {
|
|
selector = strconv.FormatUint(uint64(*arg.Size), 10)
|
|
sym = *arg.Selector
|
|
} else if arg.Selector != nil {
|
|
sym = *arg.Sym
|
|
selector = *arg.Selector
|
|
}
|
|
|
|
n, err := writeSym(b, selector)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
n, err = writeSym(b, sym)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
return rn, nil
|
|
}
|
|
|
|
func parseSig(b *bytes.Buffer, arg Arg) (int, error) {
|
|
var rn int
|
|
|
|
n, err := writeSym(b, *arg.Sym)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
n, err = writeSize(b, *arg.Size)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
n, err = b.Write([]byte{uint8(*arg.Flag)})
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
return rn, nil
|
|
}
|
|
|
|
func parseSized(b *bytes.Buffer, arg Arg) (int, error) {
|
|
var rn int
|
|
|
|
n, err := writeSym(b, *arg.Sym)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
n, err = writeSize(b, *arg.Size)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
|
|
return rn, nil
|
|
}
|
|
|
|
func parseOne(op vm.Opcode, instruction *Instruction, w io.Writer) (int, error) {
|
|
a := instruction.OpArg
|
|
var n_buf int
|
|
var n_out int
|
|
|
|
b := bytes.NewBuffer(nil)
|
|
|
|
n, err := writeOpcode(b, op)
|
|
n_buf += n
|
|
if err != nil {
|
|
return n_out, err
|
|
}
|
|
|
|
// Catch MOUT
|
|
if a.Desc != nil {
|
|
n, err := parseDescType(b, a)
|
|
n_buf += n
|
|
if err != nil {
|
|
return n_out, err
|
|
}
|
|
return flush(b, w)
|
|
}
|
|
|
|
// Catch
|
|
if a.Selector != nil {
|
|
log.Printf("entering twosym for %v", op)
|
|
n, err := parseTwoSym(b, a)
|
|
n_buf += n
|
|
if err != nil {
|
|
return n_out, err
|
|
}
|
|
return flush(b, w)
|
|
}
|
|
|
|
// Catch CATCH, LOAD
|
|
if a.Size != nil {
|
|
if a.Flag != nil {
|
|
n, err := parseSig(b, a)
|
|
n_buf += n
|
|
if err != nil {
|
|
return n_out, err
|
|
}
|
|
} else {
|
|
n, err := parseSized(b, a)
|
|
n_buf += n
|
|
if err != nil {
|
|
return n_out, err
|
|
}
|
|
}
|
|
return flush(b, w)
|
|
}
|
|
|
|
// Catch HALT
|
|
if a.Sym == nil {
|
|
return flush(b, w)
|
|
}
|
|
|
|
n, err = writeSym(b, *a.Sym)
|
|
n_buf += n
|
|
return flush(b, w)
|
|
|
|
}
|
|
|
|
func (a Arg) String() string {
|
|
s := "[Arg]"
|
|
if a.Sym != nil {
|
|
s += " Sym: " + *a.Sym
|
|
}
|
|
if a.Size != nil {
|
|
s += fmt.Sprintf(" Size: %v", *a.Size)
|
|
}
|
|
if a.Flag != nil {
|
|
s += fmt.Sprintf(" Flag: %v", *a.Flag)
|
|
}
|
|
if a.Selector != nil {
|
|
s += " Selector: " + *a.Selector
|
|
}
|
|
if a.Desc != nil {
|
|
s += " Description: " + *a.Desc
|
|
}
|
|
|
|
return fmt.Sprintf(s)
|
|
}
|
|
|
|
type Instruction struct {
|
|
OpCode string `@Ident`
|
|
OpArg Arg `(Whitespace @@)?`
|
|
Comment string `Comment? EOL`
|
|
}
|
|
|
|
func (i Instruction) String() string {
|
|
return fmt.Sprintf("%s %s", i.OpCode, i.OpArg)
|
|
}
|
|
|
|
var (
|
|
asmLexer = lexer.MustSimple([]lexer.SimpleRule{
|
|
{"Comment", `(?:#)[^\n]*`},
|
|
{"Ident", `^[A-Z]+`},
|
|
{"Size", `[0-9]+`},
|
|
{"Sym", `[a-zA-Z_][a-zA-Z0-9_]*`},
|
|
{"Whitespace", `[ \t]+`},
|
|
{"EOL", `[\n\r]+`},
|
|
{"Quote", `["']`},
|
|
})
|
|
asmParser = participle.MustBuild[Asm](
|
|
participle.Lexer(asmLexer),
|
|
participle.Elide("Comment", "Whitespace"),
|
|
)
|
|
)
|
|
|
|
func numSize(n uint32) int {
|
|
v := math.Log2(float64(n))
|
|
return int((v / 8) + 1)
|
|
}
|
|
|
|
func writeOpcode(w *bytes.Buffer, op vm.Opcode) (int, error) {
|
|
bn := [2]byte{}
|
|
binary.BigEndian.PutUint16(bn[:], uint16(op))
|
|
n, err := w.Write(bn[:])
|
|
return n, err
|
|
}
|
|
|
|
func writeSym(w *bytes.Buffer, s string) (int, error) {
|
|
sz := len(s)
|
|
if sz > 255 {
|
|
return 0, fmt.Errorf("string size %v too big", sz)
|
|
}
|
|
w.Write([]byte{byte(sz)})
|
|
return w.WriteString(s)
|
|
}
|
|
|
|
func writeDisplay(w *bytes.Buffer, s string) (int, error) {
|
|
s = strings.Trim(s, "\"'")
|
|
sz := len(s)
|
|
if sz > 255 {
|
|
return 0, fmt.Errorf("string size %v too big", sz)
|
|
}
|
|
w.Write([]byte{byte(sz)})
|
|
return w.WriteString(s)
|
|
}
|
|
func writeSize(w *bytes.Buffer, n uint32) (int, error) {
|
|
bn := [4]byte{}
|
|
sz := numSize(n)
|
|
if sz > 4 {
|
|
return 0, fmt.Errorf("number size %v too big", sz)
|
|
}
|
|
w.Write([]byte{byte(sz)})
|
|
binary.BigEndian.PutUint32(bn[:], n)
|
|
c := 4-sz
|
|
return w.Write(bn[c:])
|
|
}
|
|
|
|
type Batcher struct {
|
|
menuProcessor MenuProcessor
|
|
inMenu bool
|
|
}
|
|
|
|
func NewBatcher(mp MenuProcessor) Batcher {
|
|
return Batcher{
|
|
menuProcessor: NewMenuProcessor(),
|
|
}
|
|
}
|
|
|
|
func(bt *Batcher) MenuExit(w io.Writer) (int, error) {
|
|
if !bt.inMenu {
|
|
return 0, nil
|
|
}
|
|
bt.inMenu = false
|
|
b := bt.menuProcessor.ToLines()
|
|
log.Printf("tolines %v", b)
|
|
return w.Write(b)
|
|
}
|
|
|
|
func(bt *Batcher) MenuAdd(w io.Writer, code string, arg Arg) (int, error) {
|
|
bt.inMenu = true
|
|
var selector string
|
|
if arg.Size != nil {
|
|
selector = strconv.FormatUint(uint64(*arg.Size), 10)
|
|
} else if arg.Selector != nil {
|
|
selector = *arg.Selector
|
|
}
|
|
log.Printf("menu processor add %v '%v' '%v' '%v'", code, *arg.Sym, selector, *arg.Desc)
|
|
err := bt.menuProcessor.Add(code, *arg.Sym, selector, *arg.Desc)
|
|
return 0, err
|
|
}
|
|
|
|
func(bt *Batcher) Exit(w io.Writer) (int, error) {
|
|
return bt.MenuExit(w)
|
|
}
|
|
|
|
func Parse(s string, w io.Writer) (int, error) {
|
|
rd := strings.NewReader(s)
|
|
ast, err := asmParser.Parse("file", rd)
|
|
if err != nil {
|
|
return 0, err
|
|
}
|
|
|
|
batch := Batcher{
|
|
|
|
}
|
|
|
|
var rn int
|
|
for _, v := range ast.Instructions {
|
|
log.Printf("parsing line %v: %v", v.OpCode, v.OpArg)
|
|
op, ok := vm.OpcodeIndex[v.OpCode]
|
|
if !ok {
|
|
n, err := batch.MenuAdd(w, v.OpCode, v.OpArg)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
} else {
|
|
n, err := batch.MenuExit(w)
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
rn += n
|
|
n, err = parseOne(op, v, w)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
log.Printf("wrote %v bytes for %v", n, v.OpArg)
|
|
}
|
|
}
|
|
n, err := batch.Exit(w)
|
|
rn += n
|
|
if err != nil {
|
|
return rn, err
|
|
}
|
|
rn += n
|
|
|
|
return rn, err
|
|
}
|