Apple2-IO-RPi/RaspberryPi/apple2driver/handlers/block.go
2022-12-31 12:39:15 -05:00

105 lines
2.1 KiB
Go

// Copyright Terence J. Boldt (c)2020-2022
// Use of this source code is governed by an MIT
// license that can be found in the LICENSE file.
// This file is used for handling ProDOS image block reading and writing
package handlers
import (
"fmt"
"github.com/tjboldt/ProDOS-Utilities/prodos"
)
// ReadBlockCommand handles requests to read ProDOS blocks
func ReadBlockCommand(drive1 prodos.ReaderWriterAt, drive2 prodos.ReaderWriterAt) (int, error) {
blockLow, _ := comm.ReadByte()
blockHigh, _ := comm.ReadByte()
var driveUnit byte
var err error
driveUnit, err = comm.ReadByte()
if err != nil {
fmt.Printf("Failed to read block")
return 0, err
}
file := drive1
driveNumber := 1
if driveUnit >= 128 {
file = drive2
driveNumber = 2
}
slotNumber := driveUnit & 0x7F >> 4
block := int(blockHigh)*256 + int(blockLow)
fmt.Printf("Read block %04X in slot %d, drive %d...", block, slotNumber, driveNumber)
buffer, err := prodos.ReadBlock(file, block)
if err != nil {
fmt.Printf("failed %s\n", err)
return 0, err
}
err = comm.WriteBlock(buffer)
if err == nil {
fmt.Printf("succeeded\n")
} else {
fmt.Printf("failed %s\n", err)
}
return block, nil
}
// WriteBlockCommand handles requests to write ProDOS blocks
func WriteBlockCommand(drive1 prodos.ReaderWriterAt, drive2 prodos.ReaderWriterAt) error {
blockLow, _ := comm.ReadByte()
blockHigh, _ := comm.ReadByte()
var driveUnit byte
var err error
driveUnit, err = comm.ReadByte()
if err != nil {
fmt.Printf("Failed to write block")
return err
}
file := drive1
driveNumber := 1
if driveUnit >= 128 {
file = drive2
driveNumber = 2
}
buffer := make([]byte, 512)
block := int(blockHigh)*256 + int(blockLow)
slotNumber := driveUnit & 0x7F >> 4
fmt.Printf("Write block %04X in slot %d, drive %d...", block, slotNumber, driveNumber)
err = comm.ReadBlock(buffer)
if err != nil {
fmt.Printf("failed %s\n", err)
return err
}
fmt.Printf("...")
err = prodos.WriteBlock(file, block, buffer)
if err == nil {
fmt.Printf("succeeded\n")
} else {
fmt.Printf("failed\n")
}
return nil
}