Fixed RO dsk's after reset problem. Added working SDC.
Big change is the addition of a llcocosdc compatible sdc controller. This can run the default .dsk superfloppy and is EOU compatible
This commit is contained in:
1 parent
5880d42fa7
commit
87e1f91177
8 files changed
+1071
-40
No files matched your search
+21
-8
@@ -142,7 +142,7 @@ input [15:0] ioctl_index,
|
||||
// SD block level interface
|
||||
input [3:0] img_mounted, // signaling that new image has been mounted
|
||||
input img_readonly, // mounted as read only. valid only for active bit in img_mounted
|
||||
input [19:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
input [63:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
|
||||
output [31:0] sd_lba[4],
|
||||
output [5:0] sd_blk_cnt[4], // number of blocks-1, total size ((sd_blk_cnt+1)*(1<<(BLKSZ+7))) must be <= 16384!
|
||||
@@ -825,6 +825,7 @@ COCO_ROM_CART CC3_ROM_CART(
|
||||
.WRITE((ioctl_index[5:0] == 6'd1) & ioctl_wr)
|
||||
);
|
||||
|
||||
wire SDC_EN_CS;
|
||||
|
||||
assign ENA_ORCC = ({CART_SEL, MPI_CTS} == 3'b100) ? 1'b1: // Orchestra-90CC C000-DFFF Slot 1
|
||||
1'b0;
|
||||
@@ -834,7 +835,9 @@ assign ENA_PAK = ({CART_SEL, MPI_CTS} == 3'b110) ? 1'b1: // ROM SLOT 3
|
||||
1'b0;
|
||||
assign ENA_DSK = ({CART_SEL, MPI_CTS} == 3'b111) ? 1'b1: // Disk C000-DFFF Slot 4
|
||||
1'b0;
|
||||
assign HDD_EN = ({MPI_SCS[0], ADDRESS[15:4]} == 13'b1111111110100) ? 1'b1: // FF40-FF4F with MPI switch = 2 or 4
|
||||
assign HDD_EN = ({MPI_SCS, ADDRESS[15:4]} == 14'b11111111110100) ? 1'b1: // FF40-FF4F with MPI switch = 4
|
||||
1'b0;
|
||||
assign SDC_EN_CS = ({MPI_SCS, ADDRESS[15:4]} == 14'b01111111110100) ? 1'b1: // FF40-FF4F with MPI switch = 2
|
||||
1'b0;
|
||||
assign RS232_EN = (ADDRESS[15:2] == 14'b11111111011010) ? 1'b1: //FF68-FF6B
|
||||
1'b0;
|
||||
@@ -903,7 +906,7 @@ assign DATA_IN =
|
||||
(sdram_BE_0) ? hold_data_L[7:0]:
|
||||
(sdram_BE_1) ? hold_data_L[15:8]:
|
||||
FLASH_CE_S ? FLASH_DATA:
|
||||
HDD_EN ? DATA_HDD:
|
||||
(HDD_EN | SDC_EN_CS) ? DATA_HDD:
|
||||
RS232_EN ? DATA_RS232:
|
||||
SLOT3_HW ? {5'b00000, ROM_BANK}:
|
||||
// FF00, FF04, FF08, FF0C
|
||||
@@ -1421,6 +1424,7 @@ wire FF40_read;
|
||||
wire wd1793_data_read;
|
||||
wire wd1793_read;
|
||||
wire wd1793_write;
|
||||
wire SDC_REG_W_ENA, SDC_REG_READ;
|
||||
|
||||
assign FF40_ENA = ({PH_2, RW_N, HDD_EN, ADDRESS[3:0]} == 7'B1010000) ? 1'b1:
|
||||
1'b0;
|
||||
@@ -1431,30 +1435,39 @@ assign wd1793_data_read = (HDD_EN && ADDRESS[3]);
|
||||
assign wd1793_read = (RW_N && HDD_EN && ADDRESS[3]);
|
||||
assign wd1793_write = (~RW_N && HDD_EN && ADDRESS[3]);
|
||||
|
||||
assign SDC_REG_W_ENA = ({PH_2, RW_N, HDD_EN} == 3'B101) ? 1'b1: // This is for the FF40/4F SDC detect
|
||||
1'b0;
|
||||
|
||||
assign SDC_REG_READ = HDD_EN; // This is for the FF40/4F SDC detect
|
||||
|
||||
fdc coco_fdc(
|
||||
.CLK(clk_sys), // clock
|
||||
.RESET_N(RESET_N), // async reset
|
||||
.ADDRESS(ADDRESS[1:0]), // i/o port addr for wd1793 & FF48+
|
||||
.ADDRESS(ADDRESS[3:0]), // i/o port addr for wd1793 & FF48+
|
||||
.CLK_EN(PH_2),
|
||||
.DATA_IN(DATA_OUT), // data in
|
||||
.DATA_HDD(DATA_HDD), // data out
|
||||
.HALT(HALT), // DMA request
|
||||
.NMI_09(NMI_09),
|
||||
.DS_ENABLE(1'b0), // Not Used
|
||||
|
||||
// FDC host r/w handling
|
||||
.FF40_CLK(clk_sys),
|
||||
.FF40_ENA(FF40_ENA),
|
||||
|
||||
.FF40_RD(FF40_read),
|
||||
.HDD_EN(HDD_EN),
|
||||
.WD1793_RD(wd1793_data_read),
|
||||
|
||||
.WD1793_WR_CTRL(wd1793_write),
|
||||
.WD1793_RD_CTRL(wd1793_read),
|
||||
|
||||
|
||||
// SDC I/O
|
||||
.SDC_REG_W_ENA(SDC_REG_W_ENA),
|
||||
.SDC_REG_READ(SDC_REG_READ),
|
||||
|
||||
// SD block level interface
|
||||
.img_mounted(img_mounted), // signaling that new image has been mounted
|
||||
.img_readonly(img_readonly), // mounted as read only. valid only for active bit in img_mounted
|
||||
.img_size(img_size), // size of image in bytes. 1MB MAX!
|
||||
.img_size(img_size), // size of image in bytes.
|
||||
|
||||
.sd_lba(sd_lba),
|
||||
.sd_blk_cnt(sd_blk_cnt), // number of blocks-1, total size ((sd_blk_cnt+1)*(1<<(BLKSZ+7))) must be <= 16384!
|
||||
|
||||
+85
-22
@@ -52,28 +52,33 @@
|
||||
module fdc(
|
||||
input CLK, // clock
|
||||
input RESET_N, // async reset
|
||||
input [1:0] ADDRESS, // i/o port addr [extended for coco]
|
||||
input [3:0] ADDRESS, // i/o port addr [extended for coco]
|
||||
input CLK_EN,
|
||||
input [7:0] DATA_IN, // data in
|
||||
output [7:0] DATA_HDD, // data out
|
||||
output HALT, // DMA request
|
||||
output NMI_09,
|
||||
|
||||
input DS_ENABLE, // Turn on DS support
|
||||
// FDC host r/w handling
|
||||
|
||||
input FF40_CLK, // FDC Write support
|
||||
input FF40_ENA,
|
||||
|
||||
input FF40_RD, // FDC Read Data support
|
||||
input HDD_EN, // FDC Read Data support
|
||||
input WD1793_RD,
|
||||
|
||||
input WD1793_WR_CTRL, // 1793 RD & WR control signal generation
|
||||
input WD1793_RD_CTRL,
|
||||
|
||||
// SDC I/O
|
||||
input SDC_REG_W_ENA,
|
||||
input SDC_REG_READ,
|
||||
|
||||
// SD block level interface
|
||||
|
||||
input [3:0] img_mounted, // signaling that new image has been mounted
|
||||
input img_readonly, // mounted as read only. valid only for active bit in img_mounted
|
||||
input [19:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
input [63:0] img_size, // size of image in bytes.
|
||||
|
||||
output [31:0] sd_lba[4],
|
||||
output [5:0] sd_blk_cnt[4], // number of blocks-1, total size ((sd_blk_cnt+1)*(1<<(BLKSZ+7))) must be <= 16384!
|
||||
@@ -117,20 +122,78 @@ begin
|
||||
end
|
||||
end
|
||||
|
||||
localparam SDC_MAGIC_CMD = 4'd0;
|
||||
localparam SDC_MAGIC_CMD = 8'h43;
|
||||
|
||||
wire [7:0] FF40_READ_VALUE = {HALT_EN, DRIVE_SEL_EXT[3], DENSITY, WRT_PREC, MOTOR, DRIVE_SEL_EXT[2:0]};
|
||||
wire SDC_EN = (FF40_READ_VALUE == SDC_MAGIC_CMD);
|
||||
wire [7:0] FF40_READ_VALUE = {HALT_EN, DRIVE_SEL_EXT[3], DENSITY, WRT_PREC, MOTOR, DRIVE_SEL_EXT[2:0]};
|
||||
wire SDC_EN = (FF40_READ_VALUE == SDC_MAGIC_CMD);
|
||||
wire [7:0] SDC_READ_DATA;
|
||||
wire sdc_always;
|
||||
wire FF40_RD = ({HDD_EN, ADDRESS[3:0]} == 5'h10);
|
||||
|
||||
assign SDC_READ_DATA = 8'h00; // To be deleted.
|
||||
|
||||
//FDC read data path. =$ff40 or wd1793(s)
|
||||
assign DATA_HDD = (SDC_EN) ? SDC_READ_DATA:
|
||||
assign DATA_HDD = (SDC_EN | sdc_always) ? SDC_READ_DATA:
|
||||
(HDD_EN & (ADDRESS[3:1] == 3'b001)) ? SDC_READ_DATA: // FF42 & FF43
|
||||
(FF40_RD) ? FF40_READ_VALUE:
|
||||
(WD1793_RD) ? DATA_1793: //(1793[s])
|
||||
8'h00;
|
||||
|
||||
wire [31:0] sdc_sd_lba[2];
|
||||
wire [31:0] fdc_sd_lba[2];
|
||||
wire [1:0] sdc_sd_rd;
|
||||
wire [1:0] fdc_sd_rd;
|
||||
wire [1:0] sdc_sd_wr;
|
||||
wire [1:0] fdc_sd_wr;
|
||||
wire [7:0] sdc_sd_buff_din[2];
|
||||
wire [7:0] fdc_sd_buff_din[2];
|
||||
|
||||
assign sd_lba[0:1] = (SDC_EN | sdc_always) ? sdc_sd_lba[0:1]:
|
||||
fdc_sd_lba[0:1];
|
||||
|
||||
assign sd_rd[1:0] = (SDC_EN | sdc_always) ? sdc_sd_rd[1:0]:
|
||||
fdc_sd_rd[1:0];
|
||||
|
||||
assign sd_wr[1:0] = (SDC_EN | sdc_always) ? sdc_sd_wr[1:0]:
|
||||
fdc_sd_wr[1:0];
|
||||
|
||||
assign sd_buff_din[0:1] = (SDC_EN | sdc_always) ? sdc_sd_buff_din[0:1]:
|
||||
fdc_sd_buff_din[0:1];
|
||||
|
||||
sdc coco_sdc(
|
||||
.CLK(CLK), // clock
|
||||
.RESET_N(RESET_N), // async reset
|
||||
.ADDRESS(ADDRESS), // i/o port addr [extended for coco]
|
||||
.SDC_DATA_IN(DATA_IN), // data in
|
||||
.SDC_READ_DATA, // data out
|
||||
|
||||
.SDC_EN(SDC_EN), // SDC is active [input to sdc]
|
||||
.CLK_EN(CLK_EN),
|
||||
.SDC_WR(SDC_REG_W_ENA),
|
||||
.SDC_RD(SDC_REG_READ),
|
||||
|
||||
.sdc_always(sdc_always), // SDC is active [output from sdc (sdc is turning off fdc)]
|
||||
|
||||
|
||||
// SD block level interface
|
||||
|
||||
.img_mounted(img_mounted[1:0]), // signaling that new image has been mounted
|
||||
.img_readonly(img_readonly), // mounted as read only. valid only for active bit in img_mounted
|
||||
.img_size(img_size), // size of image in bytes.
|
||||
|
||||
.sd_lba(sdc_sd_lba[0:1]),
|
||||
.sd_rd(sdc_sd_rd[1:0]),
|
||||
.sd_wr(sdc_sd_wr[1:0]),
|
||||
.sd_ack(sd_ack[1:0]),
|
||||
|
||||
// SD byte level access. Signals for 2-PORT altsyncram.
|
||||
.sd_buff_addr(sd_buff_addr),
|
||||
.sd_buff_dout(sd_buff_dout),
|
||||
.sd_buff_din(sdc_sd_buff_din[0:1]),
|
||||
.sd_buff_wr(sd_buff_wr)
|
||||
);
|
||||
|
||||
|
||||
|
||||
// $ff40 control register [part 1]
|
||||
|
||||
wire [3:0] DRIVE_SEL_EXT_PRE = {DATA_IN[6], DATA_IN[2:0]};
|
||||
@@ -270,10 +333,10 @@ begin
|
||||
begin
|
||||
|
||||
// synchronizers
|
||||
read1 <= WD1793_RD_CTRL;
|
||||
read1 <= WD1793_RD_CTRL & ~(SDC_EN | sdc_always);
|
||||
read <= read1;
|
||||
|
||||
write1 <= WD1793_WR_CTRL;
|
||||
write1 <= WD1793_WR_CTRL & ~(SDC_EN | sdc_always);
|
||||
write <= write1;
|
||||
|
||||
// delays for edge detection
|
||||
@@ -395,7 +458,7 @@ always @(negedge img_mounted[0])
|
||||
begin
|
||||
drive_wp[0] <= img_readonly;
|
||||
drive_ready[0] <= 1'b1;
|
||||
double_sided[0]<= img_size > 20'd368600;//20'd368640;
|
||||
double_sided[0]<= (img_size > 64'd368600) & (img_size < 64'd740000);//20'd368640;
|
||||
end
|
||||
|
||||
// Drive 1
|
||||
@@ -404,7 +467,7 @@ always @(negedge img_mounted[1])
|
||||
begin
|
||||
drive_wp[1] <= img_readonly;
|
||||
drive_ready[1] <= 1'b1;
|
||||
double_sided[1]<= img_size > 20'd368600;//20'd368640;
|
||||
double_sided[1]<= (img_size > 64'd368600) & (img_size < 64'd740000);//20'd368640;
|
||||
end
|
||||
|
||||
// Drive 2
|
||||
@@ -413,7 +476,7 @@ always @(negedge img_mounted[2])
|
||||
begin
|
||||
drive_wp[2] <= img_readonly;
|
||||
drive_ready[2] <= 1'b1;
|
||||
double_sided[2]<= img_size > 20'd368600;//20'd368640;
|
||||
double_sided[2]<= (img_size > 64'd368600) & (img_size < 64'd740000);//20'd368640;
|
||||
end
|
||||
|
||||
// Drive 3
|
||||
@@ -443,14 +506,14 @@ wd1793 #(1,1) coco_wd1793_0
|
||||
.img_mounted(img_mounted[0]),
|
||||
.img_size(img_size),
|
||||
|
||||
.sd_lba(sd_lba[0]),
|
||||
.sd_rd(sd_rd[0]),
|
||||
.sd_wr(sd_wr[0]),
|
||||
.sd_lba(fdc_sd_lba[0]),
|
||||
.sd_rd(fdc_sd_rd[0]),
|
||||
.sd_wr(fdc_sd_wr[0]),
|
||||
.sd_ack(sd_ack[0]),
|
||||
|
||||
.sd_buff_addr(sd_buff_addr),
|
||||
.sd_buff_dout(sd_buff_dout),
|
||||
.sd_buff_din(sd_buff_din[0]),
|
||||
.sd_buff_din(fdc_sd_buff_din[0]),
|
||||
.sd_buff_wr(sd_buff_wr),
|
||||
|
||||
.wp(drive_wp[0]),
|
||||
@@ -484,14 +547,14 @@ wd1793 #(1,0) coco_wd1793_1
|
||||
.img_mounted(img_mounted[1]),
|
||||
.img_size(img_size),
|
||||
|
||||
.sd_lba(sd_lba[1]),
|
||||
.sd_rd(sd_rd[1]),
|
||||
.sd_wr(sd_wr[1]),
|
||||
.sd_lba(fdc_sd_lba[1]),
|
||||
.sd_rd(fdc_sd_rd[1]),
|
||||
.sd_wr(fdc_sd_wr[1]),
|
||||
.sd_ack(sd_ack[1]),
|
||||
|
||||
.sd_buff_addr(sd_buff_addr),
|
||||
.sd_buff_dout(sd_buff_dout),
|
||||
.sd_buff_din(sd_buff_din[1]),
|
||||
.sd_buff_din(fdc_sd_buff_din[1]),
|
||||
.sd_buff_wr(sd_buff_wr),
|
||||
|
||||
.wp(drive_wp[1]),
|
||||
|
||||
+483
@@ -0,0 +1,483 @@
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
// Project Name: COCO3 Targeting MISTer
|
||||
// File Name: sdc.sv
|
||||
//
|
||||
// SD Controller for MISTer
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// Code based partily on work by Gary Becker
|
||||
// Copyright (c) 2008 Gary Becker ([email protected])
|
||||
//
|
||||
// SD Controller (sdc.vs) by Stan Hodge ([email protected])
|
||||
// Copyright (c) 2022 by Stan Hodge ([email protected])
|
||||
//
|
||||
// All rights reserved
|
||||
|
||||
// Redistribution and use in source and synthezised forms, with or without
|
||||
// modification, are permitted provided that the following conditions are met:
|
||||
//
|
||||
// Redistributions of source code must retain the above copyright notice,
|
||||
// this list of conditions and the following disclaimer.
|
||||
//
|
||||
// Redistributions in synthesized form must reproduce the above copyright
|
||||
// notice, this list of conditions and the following disclaimer in the
|
||||
// documentation and/or other materials provided with the distribution.
|
||||
//
|
||||
// Neither the name of the author nor the names of other contributors may
|
||||
// be used to endorse or promote products derived from this software without
|
||||
// specific prior written permission.
|
||||
//
|
||||
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
||||
// THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||||
// PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE
|
||||
// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
// POSSIBILITY OF SUCH DAMAGE.
|
||||
//
|
||||
// Please report bugs to the author, but before you do so, please
|
||||
// make sure that this is not a derivative work and that
|
||||
// you have the latest version of this file.
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
module sdc(
|
||||
input CLK, // clock
|
||||
input RESET_N, // async reset
|
||||
input [3:0] ADDRESS, // i/o port addr [extended for coco]
|
||||
input [7:0] SDC_DATA_IN, // data in
|
||||
output [7:0] SDC_READ_DATA, // data out
|
||||
|
||||
input SDC_EN, // SDC is active
|
||||
input CLK_EN,
|
||||
input SDC_WR,
|
||||
input SDC_RD,
|
||||
|
||||
output sdc_always,
|
||||
|
||||
// SD block level interface
|
||||
|
||||
input [1:0] img_mounted, // signaling that new image has been mounted
|
||||
input img_readonly, // mounted as read only. valid only for active bit in img_mounted
|
||||
input [19:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
|
||||
output [31:0] sd_lba[2],
|
||||
output reg [1:0] sd_rd,
|
||||
output reg [1:0] sd_wr,
|
||||
input [1:0] sd_ack,
|
||||
|
||||
// SD byte level access. Signals for 2-PORT altsyncram.
|
||||
input [8:0] sd_buff_addr,
|
||||
input [7:0] sd_buff_dout,
|
||||
output [7:0] sd_buff_din[2],
|
||||
input sd_buff_wr
|
||||
);
|
||||
|
||||
reg [23:0] LSN;
|
||||
reg [7:0] command;
|
||||
reg [7:0] transfer_address;
|
||||
|
||||
reg new_cmd, new_cmd_d, cmd_done;
|
||||
reg data_inc, run;
|
||||
reg [3:0] state;
|
||||
reg transfer_clear;
|
||||
reg [3:0] sdc_data_reg;
|
||||
|
||||
wire [7:0] sdc_status_reg = {sdc_data_reg, 4'h4};
|
||||
reg [15:0] drive_size[2];
|
||||
|
||||
localparam state_idle = 4'd0;
|
||||
localparam state_read = 4'd1;
|
||||
localparam state_r1 = 4'd2;
|
||||
localparam state_r1a = 4'd3;
|
||||
localparam state_r2 = 4'd4;
|
||||
localparam state_r3 = 4'd5;
|
||||
localparam state_r4 = 4'd6;
|
||||
localparam state_write = 4'd7;
|
||||
localparam state_w1 = 4'd8;
|
||||
localparam state_w1a = 4'd9;
|
||||
localparam state_w2 = 4'd10;
|
||||
localparam state_w3 = 4'd11;
|
||||
localparam state_ext = 4'd12;
|
||||
localparam state_e1 = 4'd13;
|
||||
localparam state_e2 = 4'd14;
|
||||
|
||||
|
||||
localparam ADRS_FF42 = 4'h2;
|
||||
localparam ADRS_FF43 = 4'h3;
|
||||
localparam ADRS_FF48 = 4'h8;
|
||||
localparam ADRS_FF49 = 4'h9;
|
||||
localparam ADRS_FF4A = 4'hA;
|
||||
localparam ADRS_FF4B = 4'hB;
|
||||
|
||||
always @(negedge CLK or negedge RESET_N)
|
||||
begin
|
||||
if(!RESET_N)
|
||||
begin
|
||||
LSN <= 24'h000000;
|
||||
command <= 8'h00;
|
||||
new_cmd <= 1'b0;
|
||||
data_inc <= 1'b0;
|
||||
transfer_address <= 8'h00;
|
||||
sdc_data_reg <= 4'h0;
|
||||
end
|
||||
else
|
||||
begin
|
||||
data_inc <= 1'b0;
|
||||
|
||||
if (cmd_done)
|
||||
new_cmd <= 1'b0;
|
||||
|
||||
if (SDC_WR) //Write
|
||||
begin
|
||||
case(ADDRESS)
|
||||
ADRS_FF42: // $ff42
|
||||
sdc_data_reg <= SDC_DATA_IN[7:4];
|
||||
|
||||
endcase
|
||||
end
|
||||
|
||||
if ((SDC_EN | sdc_always) & SDC_WR) //Write
|
||||
begin
|
||||
case(ADDRESS)
|
||||
|
||||
ADRS_FF48: // $ff48
|
||||
begin
|
||||
command <= SDC_DATA_IN;
|
||||
transfer_address <= 8'h00;
|
||||
new_cmd <= 1'b1;
|
||||
end
|
||||
|
||||
ADRS_FF49: // $ff49
|
||||
if (~run)
|
||||
LSN[23:16] <= SDC_DATA_IN;
|
||||
|
||||
ADRS_FF4A: // $ff4A
|
||||
begin
|
||||
if (~run)
|
||||
LSN[15:8] <= SDC_DATA_IN;
|
||||
else
|
||||
data_inc <= 1'b1;
|
||||
end
|
||||
|
||||
ADRS_FF4B: // $ff4B
|
||||
begin
|
||||
if (~run)
|
||||
LSN[7:0] <= SDC_DATA_IN;
|
||||
else
|
||||
data_inc <= 1'b1;
|
||||
end
|
||||
endcase
|
||||
end
|
||||
|
||||
if (CLK_EN & SDC_RD & (ADDRESS[3:1] == 3'b101) & (run)) // Read @ $ff4A / $ff4B
|
||||
data_inc <= 1'b1;
|
||||
|
||||
if (data_inc)
|
||||
transfer_address <= transfer_address + 1'b1;
|
||||
|
||||
if (transfer_clear)
|
||||
transfer_address <= 8'h00;
|
||||
|
||||
end
|
||||
end
|
||||
|
||||
wire sdc_fail, sdc_ready, sdc_busy;
|
||||
|
||||
localparam CMD_READ = 5'b10000;
|
||||
localparam CMD_WRITE = 5'b10100;
|
||||
localparam CMD_EXT = 5'b11000;
|
||||
|
||||
reg wr_cmd;
|
||||
reg ack_d;
|
||||
reg ext_response;
|
||||
reg [23:0] response_reg;
|
||||
wire end_ack = ~sd_ack[command[0]] & ack_d;
|
||||
|
||||
always @(negedge CLK or negedge RESET_N)
|
||||
begin
|
||||
if(!RESET_N)
|
||||
begin
|
||||
state <= state_idle;
|
||||
sdc_ready <= 1'b0;
|
||||
sdc_busy <= 1'b0;
|
||||
sd_rd[0] <= 1'b0;
|
||||
sd_rd[1] <= 1'b0;
|
||||
sd_wr[0] <= 1'b0;
|
||||
sd_wr[1] <= 1'b0;
|
||||
sd_lba[0] <= 32'h00000000;
|
||||
sd_lba[1] <= 32'h00000000;
|
||||
run <= 1'b0;
|
||||
cmd_done <= 1'b0;
|
||||
wr_cmd <= 1'b0;
|
||||
ack_d <= 1'b0;
|
||||
transfer_clear <= 1'b0;
|
||||
sdc_fail <= 1'b0;
|
||||
ext_response <= 1'b0;
|
||||
response_reg <= 24'h000000;
|
||||
sdc_always <= 1'b0;
|
||||
end
|
||||
else
|
||||
begin
|
||||
new_cmd_d <= new_cmd;
|
||||
cmd_done <= 1'b0;
|
||||
|
||||
ack_d <= sd_ack[command[0]];
|
||||
|
||||
if (~(SDC_EN | sdc_always))
|
||||
begin
|
||||
sdc_busy <= 1'b1;
|
||||
sdc_ready <= 1'b0;
|
||||
end
|
||||
|
||||
case(state)
|
||||
state_idle:
|
||||
begin
|
||||
sdc_busy <= 1'b0;
|
||||
run <= 1'b0;
|
||||
wr_cmd <= 1'b0;
|
||||
transfer_clear <= 1'b1;
|
||||
if (new_cmd & ~new_cmd_d)
|
||||
if (command[7:3] == CMD_READ)
|
||||
state <= state_read;
|
||||
else if (command[7:3] == CMD_WRITE)
|
||||
begin
|
||||
state <= state_read;
|
||||
wr_cmd <= 1'b1;
|
||||
end
|
||||
else if (command[7:3] == CMD_EXT)
|
||||
state <= state_ext;
|
||||
else // no valid command found
|
||||
cmd_done <= 1'b1;
|
||||
end
|
||||
state_read:
|
||||
begin
|
||||
ext_response <= 1'b0;
|
||||
transfer_clear <= 1'b0;
|
||||
run <= 1'b1;
|
||||
sdc_busy <= 1'b1;
|
||||
// Issue sda read command...
|
||||
if (~command[0])
|
||||
sd_lba[0] <= {8'h00, 1'b0, LSN[23:1]};
|
||||
else
|
||||
sd_lba[1] <= {8'h00, 1'b0, LSN[23:1]};
|
||||
state <= state_r1;
|
||||
end
|
||||
state_r1:
|
||||
begin
|
||||
sd_rd[command[0]] <= 1'b1;
|
||||
state <= state_r1a;
|
||||
end
|
||||
state_r1a:
|
||||
if (sd_ack[command[0]])
|
||||
begin
|
||||
sd_rd[command[0]] <= 1'b0;
|
||||
state <= state_r3;
|
||||
end
|
||||
// state_r2:
|
||||
// begin
|
||||
// sd_rd[command[0]] <= 1'b0;
|
||||
// state <= state_r3;
|
||||
// end
|
||||
state_r3:
|
||||
begin
|
||||
if (sd_ack[command[0]] & sd_buff_wr & (sd_buff_addr == 9'b111111111)) // wait for the last ack
|
||||
begin
|
||||
sdc_ready <= 1'b1;
|
||||
if (wr_cmd)
|
||||
state <= state_write;
|
||||
else
|
||||
state <= state_r4;
|
||||
end
|
||||
end
|
||||
state_r4:
|
||||
begin
|
||||
if ((transfer_address == 8'hff) & CLK_EN & SDC_RD & (ADDRESS[3:1] == 3'b101)) // wait for the last read
|
||||
begin
|
||||
sdc_fail <= 1'b0;
|
||||
cmd_done <= 1'b1;
|
||||
sdc_ready <= 1'b0;
|
||||
sdc_busy <= 1'b0;
|
||||
state <= state_idle;
|
||||
end
|
||||
end
|
||||
|
||||
|
||||
state_write:
|
||||
begin
|
||||
if ((transfer_address == 8'hff) & SDC_WR & (ADDRESS[3:1] == 3'b101)) // wait for the last write
|
||||
begin
|
||||
state <= state_w1;
|
||||
end
|
||||
end
|
||||
state_w1:
|
||||
begin
|
||||
sd_wr[command[0]] <= 1'b1;
|
||||
state <= state_w1a;
|
||||
end
|
||||
state_w1a:
|
||||
if (sd_ack[command[0]])
|
||||
begin
|
||||
sd_wr[command[0]] <= 1'b0;
|
||||
state <= state_w3;
|
||||
end
|
||||
// state_w2:
|
||||
// begin
|
||||
// sd_wr[command[0]] <= 1'b0;
|
||||
// state <= state_w3;
|
||||
// end
|
||||
state_w3:
|
||||
begin
|
||||
if (end_ack) // wait for the last ack of the write cycle
|
||||
begin
|
||||
sdc_fail <= 1'b0;
|
||||
wr_cmd <= 1'b0;
|
||||
cmd_done <= 1'b1;
|
||||
sdc_ready <= 1'b0;
|
||||
sdc_busy <= 1'b0;
|
||||
state <= state_idle;
|
||||
end
|
||||
end
|
||||
|
||||
state_ext:
|
||||
begin
|
||||
if (LSN[23:16] == 8'H51) // This is q [Query]
|
||||
begin
|
||||
sdc_busy <= 1'b1;
|
||||
state <= state_e1;
|
||||
end
|
||||
else if (LSN[23:16] == 8'H67) // This is g [Disable FDC emulation]
|
||||
begin
|
||||
cmd_done <= 1'b1;
|
||||
sdc_always <= 1'b1; // Disable floppy
|
||||
state <= state_idle;
|
||||
end
|
||||
else
|
||||
begin
|
||||
cmd_done <= 1'b1; // All other ext commands...
|
||||
state <= state_idle;
|
||||
end
|
||||
end
|
||||
|
||||
state_e1:
|
||||
begin
|
||||
sdc_busy <= 1'b0;
|
||||
ext_response <= 1'b1;
|
||||
response_reg <= {8'h00, drive_size[command[0]]};
|
||||
state <= state_e2;
|
||||
end
|
||||
|
||||
state_e2:
|
||||
begin
|
||||
cmd_done <= 1'b1;
|
||||
state <= state_idle;
|
||||
end
|
||||
|
||||
endcase
|
||||
end
|
||||
end
|
||||
|
||||
wire [7:0] hd_buff_data;
|
||||
|
||||
wire [7:0] sd_buf_out;
|
||||
|
||||
assign sd_buff_din[0] = (~command[0]) ? sd_buf_out:
|
||||
8'h00;
|
||||
|
||||
assign sd_buff_din[1] = (command[0]) ? sd_buf_out:
|
||||
8'h00;
|
||||
|
||||
|
||||
sdc_dpram hd_buff
|
||||
(
|
||||
.clock(CLK),
|
||||
.address_a(sd_buff_addr),
|
||||
.data_a(sd_buff_dout),
|
||||
.wren_a(sd_buff_wr & sd_ack[command[0]]),
|
||||
.q_a(sd_buf_out),
|
||||
|
||||
.address_b({LSN[0], transfer_address}),
|
||||
.data_b(SDC_DATA_IN),
|
||||
.wren_b((SDC_EN | sdc_always) & SDC_WR & (ADDRESS[1] == 1'b1)),
|
||||
.q_b(hd_buff_data)
|
||||
);
|
||||
|
||||
wire [1:0] drive_wp;
|
||||
reg [1:0] drive_ready = 2'b00;
|
||||
wire [7:0] sdc_status;
|
||||
|
||||
assign sdc_status = {sdc_fail, drive_wp[command[0]], 1'b0, drive_ready[command[0]], 2'b00, sdc_ready, sdc_busy};
|
||||
|
||||
assign SDC_READ_DATA = (ADDRESS == ADRS_FF42) ? {sdc_data_reg, 4'h0}:
|
||||
(ADDRESS == ADRS_FF43) ? sdc_status_reg:
|
||||
((ADDRESS == ADRS_FF48) & ~ext_response) ? sdc_status:
|
||||
((ADDRESS == ADRS_FF48) & ext_response) ? response_reg[23:16]:
|
||||
((ADDRESS == ADRS_FF4A) & ~ext_response) ? hd_buff_data:
|
||||
((ADDRESS == ADRS_FF4A) & ext_response) ? response_reg[15:8]:
|
||||
((ADDRESS == ADRS_FF4B) & ~ext_response) ? hd_buff_data:
|
||||
((ADDRESS == ADRS_FF4B) & ext_response) ? response_reg[7:0]:
|
||||
8'h00;
|
||||
|
||||
// SD Drive 0
|
||||
|
||||
always @(negedge img_mounted[0])
|
||||
begin
|
||||
drive_wp[0] <= img_readonly;
|
||||
drive_ready[0] <= 1'b1;
|
||||
drive_size[0] <= {4'h0, img_size[19:8]}; //Size / 256
|
||||
end
|
||||
|
||||
// SD Drive 1
|
||||
|
||||
always @(negedge img_mounted[1])
|
||||
begin
|
||||
drive_wp[1] <= img_readonly;
|
||||
drive_ready[1] <= 1'b1;
|
||||
drive_size[1] <= {4'h0, img_size[19:8]}; //Size / 256
|
||||
end
|
||||
|
||||
endmodule
|
||||
|
||||
|
||||
module sdc_dpram
|
||||
(
|
||||
input clock,
|
||||
|
||||
input [8:0] address_a,
|
||||
input [7:0] data_a,
|
||||
input wren_a,
|
||||
output reg [7:0] q_a,
|
||||
|
||||
input [8:0] address_b,
|
||||
input [7:0] data_b,
|
||||
input wren_b,
|
||||
output reg [7:0] q_b
|
||||
);
|
||||
|
||||
logic [7:0] ram[0:511];
|
||||
|
||||
always_ff@(posedge clock) begin
|
||||
if(wren_a) begin
|
||||
ram[address_a] <= data_a;
|
||||
q_a <= data_a;
|
||||
end else begin
|
||||
q_a <= ram[address_a];
|
||||
end
|
||||
end
|
||||
|
||||
always_ff@(posedge clock) begin
|
||||
if(wren_b) begin
|
||||
ram[address_b] <= data_b;
|
||||
q_b <= data_b;
|
||||
end else begin
|
||||
q_b <= ram[address_b];
|
||||
end
|
||||
end
|
||||
|
||||
endmodule
|
||||
+4
-2
@@ -48,7 +48,8 @@ module wd1793 #(parameter RWMODE=0, EDSK=1)
|
||||
|
||||
// SD access (RWMODE == 1)
|
||||
input img_mounted, // signaling that new image has been mounted
|
||||
input [19:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
// input [19:0] img_size, // size of image in bytes. 1MB MAX!
|
||||
input [63:0] img_size, // size of image in bytes.
|
||||
output prepare,
|
||||
output[31:0] sd_lba,
|
||||
output reg sd_rd,
|
||||
@@ -349,7 +350,8 @@ always @(posedge clk_sys) begin
|
||||
if(ack[5:4] == 'b10) sd_busy <= 0;
|
||||
|
||||
if(RWMODE & scan_active) begin
|
||||
if(scan_addr >= img_size) scan_active <= 0;
|
||||
// if(scan_addr >= img_size) scan_active <= 0;
|
||||
if(scan_addr >= img_size[19:0]) scan_active <= 0;
|
||||
else begin
|
||||
case(scan_state)
|
||||
0: begin
|
||||
|
||||
Reference in new issue
Block a user