Apple2-IO-RPi/RaspberryPi/apple2driver/handlers/block.go

102 lines
1.9 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"
"os"
"github.com/tjboldt/ProDOS-Utilities/prodos"
)
// ReadBlockCommand handles requests to read ProDOS blocks
func ReadBlockCommand(drive1 *os.File, drive2 *os.File) {
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
}
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
}
err = comm.WriteBlock(buffer)
if err == nil {
fmt.Printf("succeeded\n")
} else {
fmt.Printf("failed %s\n",err)
}
}
// WriteBlockCommand handles requests to write ProDOS blocks
func WriteBlockCommand(drive1 *os.File, drive2 *os.File) {
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
}
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
}
fmt.Printf("...")
err = prodos.WriteBlock(file, block, buffer)
if err == nil {
fmt.Printf("succeeded\n")
} else {
fmt.Printf("failed\n")
}
}