NJU-ProjectN/nemu ics2023 initialized
NJU-ProjectN/nemu eb63cf3568dbf4e0c3c6ef462e6ec685550fabbc Merge pull request #76 from rijuyuezhu/master
This commit is contained in:
parent
1efe03efb9
commit
2824efad33
141 changed files with 19573 additions and 0 deletions
172
nemu/resource/debian/README.md
Normal file
172
nemu/resource/debian/README.md
Normal file
|
|
@ -0,0 +1,172 @@
|
|||
|
||||
# riscv64 debian镜像制作
|
||||
|
||||
制作需要`qemu-riscv64-static`, 建议在debian 10或ubuntu 19.04的系统(可尝试使用docker)中进行操作.
|
||||
|
||||
* 创建空镜像和分区
|
||||
```
|
||||
dd if=/dev/zero of=debian.img bs=1G count=16 # 此处镜像大小为16GB
|
||||
sudo cfdisk debian.img # 可创建两个分区, 第一个分区12GB作为rootfs, 第二个分区4GB作为swap
|
||||
sudo losetup --partscan --show --find debian.img # 将debian.img作为loop设备
|
||||
ls /dev/loop0* # 此时应该能看到/dev/loop0p1和/dev/loop0p2两个分区
|
||||
```
|
||||
|
||||
* 创建ext4和swap文件系统
|
||||
```
|
||||
sudo mkfs.ext4 /dev/loop0p1
|
||||
sudo mkswap /dev/loop0p2
|
||||
```
|
||||
|
||||
* 挂载ext4分区
|
||||
```
|
||||
sudo mount /dev/loop0p1 /mnt
|
||||
```
|
||||
|
||||
* 安装debian base system.
|
||||
下面两条命令的操作来自[debian社区的安装指南](https://wiki.debian.org/RISC-V#debootstrap).
|
||||
```
|
||||
sudo apt-get install debootstrap qemu-user-static binfmt-support debian-ports-archive-keyring
|
||||
sudo debootstrap --arch=riscv64 --keyring /usr/share/keyrings/debian-ports-archive-keyring.gpg --include=debian-ports-archive-keyring unstable /mnt http://deb.debian.org/debian-ports
|
||||
```
|
||||
若要安装x86系统, 则输入
|
||||
```
|
||||
sudo debootstrap --arch=i386 --keyring /usr/share/keyrings/debian-archive-keyring.gpg --include=debian-archive-keyring stable /mnt http://deb.debian.org/debian
|
||||
```
|
||||
|
||||
* 进入镜像
|
||||
```
|
||||
sudo chroot /mnt /bin/bash
|
||||
```
|
||||
此时实际上是通过`qemu-riscv64-static`来执行镜像中的riscv64可执行文件.
|
||||
|
||||
* 安装所需工具(根据实际情况选择)
|
||||
```
|
||||
apt-get update
|
||||
apt-get install systemd
|
||||
apt-get install gcc build-essential
|
||||
apt-get install tmux libreadline-dev
|
||||
apt-get install net-tools openssh-server
|
||||
# fix long delay of openssh server
|
||||
apt-get install haveged
|
||||
apt-get install sbt
|
||||
```
|
||||
|
||||
* 修复`NO_PUBKEY E852514F5DF312F6`错误, 见[这里](https://www.reddit.com/r/RISCV/comments/sn0cph/sipeed_debian_the_following_signatures_couldnt_be/)
|
||||
```
|
||||
curl https://www.ports.debian.org/archive_2022.key | apt-key add -
|
||||
```
|
||||
|
||||
* 同步时间
|
||||
```
|
||||
apt-get install ntpdate
|
||||
ntpdate 0.asia.pool.ntp.org
|
||||
```
|
||||
|
||||
* 在`/etc/fstab`中添加swap分区
|
||||
```
|
||||
/dev/mmcblk0p2 none swap sw 0 0
|
||||
```
|
||||
|
||||
* 添加/root/目录的写和执行权限, 使得host上的普通用户可以访问
|
||||
```
|
||||
chmod a+w,a+x /root
|
||||
```
|
||||
|
||||
* 在/root/目录下提前写入所需的测试文件, 如hello.c等.
|
||||
|
||||
* 在/root/.bashrc中添加如下内容, 可以实现登录后自动运行命令(根据实际情况修改测试的命令):
|
||||
```
|
||||
TMP_DIR=/run/mytest
|
||||
|
||||
cmd=(
|
||||
# enbale swap
|
||||
"swapon -a"
|
||||
|
||||
# show system information
|
||||
"uname -a"
|
||||
"cat /etc/issue"
|
||||
"cat /proc/cpuinfo"
|
||||
"df -ah"
|
||||
"free -h"
|
||||
|
||||
# show time
|
||||
"date"
|
||||
"uptime"
|
||||
|
||||
# create and switch to tmp directory
|
||||
"mkdir $TMP_DIR"
|
||||
"cd $TMP_DIR"
|
||||
|
||||
# compile and run hello
|
||||
"ls /root"
|
||||
"ls /root/hello"
|
||||
"cat /root/hello/hello.c"
|
||||
"gcc -time /root/hello/hello.c -o $TMP_DIR/hello"
|
||||
"ls -lh $TMP_DIR"
|
||||
"$TMP_DIR/hello"
|
||||
|
||||
# compile and run x86-nemu
|
||||
"ls /root/nemu"
|
||||
"cp -r /root/nemu $TMP_DIR"
|
||||
"export NEMU_HOME=$TMP_DIR/nemu"
|
||||
"make -C $TMP_DIR/nemu ISA=x86"
|
||||
"ls -lh /root/nemu-prog"
|
||||
"file /root/nemu-prog/amtest-x86-nemu.elf"
|
||||
"$TMP_DIR/nemu/build/x86-nemu --batch --mainargs=h /root/nemu-prog/amtest-x86-nemu.bin"
|
||||
"file /root/nemu-prog/microbench-x86-nemu.elf"
|
||||
"$TMP_DIR/nemu/build/x86-nemu --batch --mainargs=test /root/nemu-prog/microbench-x86-nemu.bin"
|
||||
|
||||
# compile and run riscv64-nemu
|
||||
"make -C $TMP_DIR/nemu clean"
|
||||
"make -C $TMP_DIR/nemu ISA=riscv64"
|
||||
"$TMP_DIR/nemu/build/riscv64-nemu --batch /root/nemu-prog/linux-hello-riscv64-nemu.bin"
|
||||
)
|
||||
|
||||
prompt="`whoami`@`hostname`:`pwd`#"
|
||||
|
||||
echo -e "\n============ Now running preset commands =============\n"
|
||||
|
||||
for ((i = 0; i < ${#cmd[@]}; i++)); do
|
||||
c=${cmd[$i]}
|
||||
echo "$prompt $c"
|
||||
$c
|
||||
echo ""
|
||||
done
|
||||
|
||||
echo -e "\n============ End of preset commands =============\n"
|
||||
|
||||
/root/nemutrap/good-trap
|
||||
```
|
||||
|
||||
* 若在不方便输入的环境(如NEMU, verilator仿真等)中测试, 可采用如下两种方式的其中一种, 避免登录时输入
|
||||
* 通过紧急模式登录
|
||||
```
|
||||
cd /lib/systemd/system
|
||||
# 通过紧急模式登录, 不启动非必须的服务, 节省将近一半的登录时间
|
||||
ln -sf emergency.target default.target
|
||||
# 跳过登录提示符, 直接运行bash
|
||||
vim emergency.service
|
||||
-ExecStart=-/lib/systemd/systemd-sulogin-shell emergency
|
||||
+ExecStart=-/bin/bash
|
||||
```
|
||||
* 免密码登录, 见[这里](https://superuser.com/questions/969923/automatic-root-login-in-debian-8-0-console-only)
|
||||
```
|
||||
cd /lib/systemd/system
|
||||
vim serial-getty@.service
|
||||
-ExecStart=-/sbin/agetty -o '-p -- \\u' --keep-baud 115200,57600,38400,9600 %I $TERM
|
||||
+ExecStart=-/sbin/agetty -a root --keep-baud 115200,57600,38400,9600 %I $TERM
|
||||
```
|
||||
|
||||
* 退出并卸载镜像
|
||||
```
|
||||
exit # 之前通过`chroot`方式进入
|
||||
sudo umount /mnt # 记得卸载! 在未卸载镜像的情况下通过可写方式再次打开`debian.img`(如作为qemu的文件系统), 镜像将会损坏!
|
||||
sudo losetup -d /dev/loop0 # 删除loop设备
|
||||
```
|
||||
|
||||
* 修改`nemu/src/device/sdcard.c`中`init_sdcard()`中打开的镜像文件路径, 即可使用制作的镜像.
|
||||
在i9-9900k上测试, 约90s后看到debian的登录提示符.
|
||||
|
||||
* 当以可写方式启动镜像时, NEMU遇到错误或通过Ctrl+C直接退出NEMU时, 可能会损坏镜像的崩溃一致性, 此时可以通过fsck命令修复分区.
|
||||
|
||||
* 更多命令可参考[这里](https://github.com/carlosedp/riscv-bringup/blob/master/Debian-Rootfs-Guide.md).
|
||||
1
nemu/resource/mips-elf/README.md
Normal file
1
nemu/resource/mips-elf/README.md
Normal file
|
|
@ -0,0 +1 @@
|
|||
This is a dummy ELF file used by qemu-system-mips32 to start.
|
||||
58
nemu/resource/sdcard/README.md
Normal file
58
nemu/resource/sdcard/README.md
Normal file
|
|
@ -0,0 +1,58 @@
|
|||
|
||||
# NEMU sdhost驱动
|
||||
|
||||
本驱动裁剪自`linux/drivers/mmc/host/bcm2835.c`, 去除了DMA和中断, 改成直接轮询, 处理器无需支持DMA和中断即可运行.
|
||||
|
||||
## 使用方法
|
||||
|
||||
* 将本目录下的`nemu.c`复制到`linux/drivers/mmc/host/`目录下
|
||||
* 在`linux/drivers/mmc/host/Makefile`中添加一行`obj-y += nemu.o`
|
||||
* 在menuconfig中取消`General setup -> Initial RAM filesystem and RAM disk (initramfs/initrd) support`
|
||||
* 在menuconfig中选中`Device Drivers -> MMC/SD/SDIO card support`
|
||||
* 在dts中加入以下节点
|
||||
```
|
||||
/ {
|
||||
soc {
|
||||
sdhci: mmc {
|
||||
compatible = "nemu-sdhost";
|
||||
reg = <0x0 0xa3000000 0x0 0x1000>;
|
||||
};
|
||||
};
|
||||
|
||||
chosen {
|
||||
bootargs = "root=/dev/mmcblk0p1 rootfstype=ext4 ro rootwait earlycon";
|
||||
};
|
||||
};
|
||||
```
|
||||
|
||||
## 在没有中断的处理器上访问SD卡
|
||||
|
||||
访问真实的SD卡需要等待一定的延迟, 这需要处理器的中断机制对内核支持计时的功能.
|
||||
在没有中断机制的处理器上, 我们可以修改内核的部分代码, 使得无需等待这些延迟,
|
||||
来达到确定性可重复的仿真效果.
|
||||
|
||||
具体只需修改以下文件:
|
||||
```diff
|
||||
--- linux/drivers/mmc/core/block.c
|
||||
+++ linux/drivers/mmc/core/block.c
|
||||
@@ -983,6 +983,7 @@ static int card_busy_detect(struct mmc_card *card, unsigned int timeout_ms,
|
||||
int err = 0;
|
||||
u32 status;
|
||||
|
||||
+ return err;
|
||||
do {
|
||||
bool done = time_after(jiffies, timeout);
|
||||
|
||||
--- linux/drivers/mmc/core/core.h
|
||||
+++ linux/drivers/mmc/core/core.h
|
||||
@@ -64,6 +64,7 @@ void mmc_set_initial_state(struct mmc_host *host);
|
||||
|
||||
static inline void mmc_delay(unsigned int ms)
|
||||
{
|
||||
+ return;
|
||||
if (ms <= 20)
|
||||
usleep_range(ms * 1000, ms * 1250);
|
||||
else
|
||||
```
|
||||
|
||||
注意: 上述修改仅能用于模拟和仿真, 修改后将不能在真实的SD卡上运行!!!
|
||||
542
nemu/resource/sdcard/nemu.c
Normal file
542
nemu/resource/sdcard/nemu.c
Normal file
|
|
@ -0,0 +1,542 @@
|
|||
/*
|
||||
* NEMU (NJU Emulator) sdhost driver.
|
||||
*
|
||||
* Author: Zihao Yu <yuzihao@ict.ac.cn>
|
||||
*
|
||||
* Based on
|
||||
* bcm2835.c by Phil Elwell
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope it will be useful, but WITHOUT
|
||||
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||||
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||||
* more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
#include <linux/clk.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/dmaengine.h>
|
||||
#include <linux/dma-mapping.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/highmem.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/iopoll.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of_address.h>
|
||||
#include <linux/of_irq.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/scatterlist.h>
|
||||
#include <linux/time.h>
|
||||
#include <linux/workqueue.h>
|
||||
|
||||
#include <linux/mmc/host.h>
|
||||
#include <linux/mmc/mmc.h>
|
||||
#include <linux/mmc/sd.h>
|
||||
|
||||
#define SDCMD 0x00 /* Command to SD card - 16 R/W */
|
||||
#define SDARG 0x04 /* Argument to SD card - 32 R/W */
|
||||
#define SDTOUT 0x08 /* Start value for timeout counter - 32 R/W */
|
||||
#define SDCDIV 0x0c /* Start value for clock divider - 11 R/W */
|
||||
#define SDRSP0 0x10 /* SD card response (31:0) - 32 R */
|
||||
#define SDRSP1 0x14 /* SD card response (63:32) - 32 R */
|
||||
#define SDRSP2 0x18 /* SD card response (95:64) - 32 R */
|
||||
#define SDRSP3 0x1c /* SD card response (127:96) - 32 R */
|
||||
#define SDHSTS 0x20 /* SD host status - 11 R/W */
|
||||
#define SDVDD 0x30 /* SD card power control - 1 R/W */
|
||||
#define SDEDM 0x34 /* Emergency Debug Mode - 13 R/W */
|
||||
#define SDHCFG 0x38 /* Host configuration - 2 R/W */
|
||||
#define SDHBCT 0x3c /* Host byte count (debug) - 32 R/W */
|
||||
#define SDDATA 0x40 /* Data to/from SD card - 32 R/W */
|
||||
#define SDHBLC 0x50 /* Host block count (SDIO/SDHC) - 9 R/W */
|
||||
|
||||
#define SDCMD_NEW_FLAG 0x8000
|
||||
#define SDCMD_FAIL_FLAG 0x4000
|
||||
#define SDCMD_BUSYWAIT 0x800
|
||||
#define SDCMD_NO_RESPONSE 0x400
|
||||
#define SDCMD_LONG_RESPONSE 0x200
|
||||
#define SDCMD_WRITE_CMD 0x80
|
||||
#define SDCMD_READ_CMD 0x40
|
||||
#define SDCMD_CMD_MASK 0x3f
|
||||
|
||||
#define SDCDIV_MAX_CDIV 0x7ff
|
||||
|
||||
#define SDDATA_FIFO_WORDS 16
|
||||
|
||||
#define FIFO_READ_THRESHOLD 4
|
||||
#define FIFO_WRITE_THRESHOLD 4
|
||||
#define SDDATA_FIFO_PIO_BURST 8
|
||||
|
||||
#define PIO_THRESHOLD 1 /* Maximum block count for PIO (0 = always DMA) */
|
||||
|
||||
struct nemu_host {
|
||||
spinlock_t lock;
|
||||
struct mutex mutex;
|
||||
|
||||
void __iomem *ioaddr;
|
||||
u32 phys_addr;
|
||||
|
||||
struct mmc_host *mmc;
|
||||
struct platform_device *pdev;
|
||||
|
||||
int clock; /* Current clock speed */
|
||||
unsigned int max_clk; /* Max possible freq */
|
||||
struct sg_mapping_iter sg_miter; /* SG state for PIO */
|
||||
unsigned int blocks; /* remaining PIO blocks */
|
||||
|
||||
struct mmc_request *mrq; /* Current request */
|
||||
struct mmc_command *cmd; /* Current command */
|
||||
struct mmc_data *data; /* Current data request */
|
||||
bool data_complete:1;/* Data finished before cmd */
|
||||
bool use_sbc:1; /* Send CMD23 */
|
||||
};
|
||||
|
||||
static void nemu_reset(struct mmc_host *mmc)
|
||||
{
|
||||
}
|
||||
|
||||
static void nemu_finish_command(struct nemu_host *host);
|
||||
|
||||
static void nemu_transfer_block_pio(struct nemu_host *host, bool is_read)
|
||||
{
|
||||
unsigned long flags;
|
||||
size_t blksize;
|
||||
|
||||
blksize = host->data->blksz;
|
||||
|
||||
local_irq_save(flags);
|
||||
|
||||
while (blksize) {
|
||||
int copy_words;
|
||||
size_t len;
|
||||
u32 *buf;
|
||||
|
||||
if (!sg_miter_next(&host->sg_miter)) {
|
||||
host->data->error = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
len = min(host->sg_miter.length, blksize);
|
||||
if (len % 4) {
|
||||
host->data->error = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
blksize -= len;
|
||||
host->sg_miter.consumed = len;
|
||||
|
||||
buf = (u32 *)host->sg_miter.addr;
|
||||
|
||||
copy_words = len / 4;
|
||||
|
||||
while (copy_words) {
|
||||
int burst_words, words;
|
||||
u32 edm;
|
||||
|
||||
burst_words = min(SDDATA_FIFO_PIO_BURST, copy_words);
|
||||
edm = (8 << 4);
|
||||
if (is_read)
|
||||
words = ((edm >> 4) & 0x1f);
|
||||
else
|
||||
words = SDDATA_FIFO_WORDS - ((edm >> 4) & 0x1f);
|
||||
|
||||
if (words < burst_words) {
|
||||
continue;
|
||||
} else if (words > copy_words) {
|
||||
words = copy_words;
|
||||
}
|
||||
|
||||
copy_words -= words;
|
||||
|
||||
while (words) {
|
||||
if (is_read)
|
||||
*(buf++) = readl(host->ioaddr + SDDATA);
|
||||
else
|
||||
writel(*(buf++), host->ioaddr + SDDATA);
|
||||
words--;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
sg_miter_stop(&host->sg_miter);
|
||||
|
||||
local_irq_restore(flags);
|
||||
}
|
||||
|
||||
static void nemu_transfer_pio(struct nemu_host *host)
|
||||
{
|
||||
bool is_read = (host->data->flags & MMC_DATA_READ) != 0;
|
||||
nemu_transfer_block_pio(host, is_read);
|
||||
}
|
||||
|
||||
static
|
||||
void nemu_prepare_data(struct nemu_host *host, struct mmc_command *cmd)
|
||||
{
|
||||
struct mmc_data *data = cmd->data;
|
||||
int flags = SG_MITER_ATOMIC;
|
||||
|
||||
WARN_ON(host->data);
|
||||
|
||||
host->data = data;
|
||||
if (!data)
|
||||
return;
|
||||
|
||||
host->data_complete = false;
|
||||
host->data->bytes_xfered = 0;
|
||||
|
||||
/* Use PIO */
|
||||
if (data->flags & MMC_DATA_READ)
|
||||
flags |= SG_MITER_TO_SG;
|
||||
else
|
||||
flags |= SG_MITER_FROM_SG;
|
||||
sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
|
||||
host->blocks = data->blocks;
|
||||
}
|
||||
|
||||
static void nemu_finish_request(struct nemu_host *host)
|
||||
{
|
||||
struct mmc_request *mrq;
|
||||
|
||||
mrq = host->mrq;
|
||||
|
||||
host->mrq = NULL;
|
||||
host->cmd = NULL;
|
||||
host->data = NULL;
|
||||
|
||||
mmc_request_done(host->mmc, mrq);
|
||||
}
|
||||
|
||||
static
|
||||
bool nemu_send_command(struct nemu_host *host, struct mmc_command *cmd)
|
||||
{
|
||||
u32 sdcmd;
|
||||
|
||||
WARN_ON(host->cmd);
|
||||
|
||||
host->cmd = cmd;
|
||||
|
||||
nemu_prepare_data(host, cmd);
|
||||
|
||||
writel(cmd->arg, host->ioaddr + SDARG);
|
||||
|
||||
sdcmd = cmd->opcode & SDCMD_CMD_MASK;
|
||||
|
||||
if (!(cmd->flags & MMC_RSP_PRESENT)) {
|
||||
sdcmd |= SDCMD_NO_RESPONSE;
|
||||
} else {
|
||||
if (cmd->flags & MMC_RSP_136)
|
||||
sdcmd |= SDCMD_LONG_RESPONSE;
|
||||
if (cmd->flags & MMC_RSP_BUSY) {
|
||||
sdcmd |= SDCMD_BUSYWAIT;
|
||||
}
|
||||
}
|
||||
|
||||
if (cmd->data) {
|
||||
if (cmd->data->flags & MMC_DATA_WRITE) {
|
||||
sdcmd |= SDCMD_WRITE_CMD;
|
||||
}
|
||||
if (cmd->data->flags & MMC_DATA_READ)
|
||||
sdcmd |= SDCMD_READ_CMD;
|
||||
}
|
||||
|
||||
writel(sdcmd | SDCMD_NEW_FLAG, host->ioaddr + SDCMD);
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static void nemu_transfer_complete(struct nemu_host *host)
|
||||
{
|
||||
struct mmc_data *data;
|
||||
|
||||
WARN_ON(!host->data_complete);
|
||||
|
||||
data = host->data;
|
||||
host->data = NULL;
|
||||
|
||||
/* Need to send CMD12 if -
|
||||
* a) open-ended multiblock transfer (no CMD23)
|
||||
* b) error in multiblock transfer
|
||||
*/
|
||||
if (host->mrq->stop && (data->error || !host->use_sbc)) {
|
||||
if (nemu_send_command(host, host->mrq->stop)) {
|
||||
nemu_finish_command(host);
|
||||
}
|
||||
} else {
|
||||
nemu_finish_request(host);
|
||||
}
|
||||
}
|
||||
|
||||
static void nemu_finish_data(struct nemu_host *host)
|
||||
{
|
||||
struct device *dev = &host->pdev->dev;
|
||||
struct mmc_data *data;
|
||||
|
||||
data = host->data;
|
||||
|
||||
data->bytes_xfered = data->error ? 0 : (data->blksz * data->blocks);
|
||||
|
||||
host->data_complete = true;
|
||||
|
||||
if (host->cmd) {
|
||||
/* Data managed to finish before the
|
||||
* command completed. Make sure we do
|
||||
* things in the proper order.
|
||||
*/
|
||||
dev_dbg(dev, "Finished early - HSTS %08x\n",
|
||||
readl(host->ioaddr + SDHSTS));
|
||||
} else {
|
||||
nemu_transfer_complete(host);
|
||||
}
|
||||
}
|
||||
|
||||
static void nemu_finish_command(struct nemu_host *host)
|
||||
{
|
||||
struct mmc_command *cmd = host->cmd;
|
||||
int i;
|
||||
|
||||
if (cmd->flags & MMC_RSP_PRESENT) {
|
||||
if (cmd->flags & MMC_RSP_136) {
|
||||
for (i = 0; i < 4; i++) {
|
||||
cmd->resp[3 - i] =
|
||||
readl(host->ioaddr + SDRSP0 + i * 4);
|
||||
}
|
||||
} else {
|
||||
cmd->resp[0] = readl(host->ioaddr + SDRSP0);
|
||||
}
|
||||
}
|
||||
|
||||
if (cmd == host->mrq->sbc) {
|
||||
/* Finished CMD23, now send actual command. */
|
||||
host->cmd = NULL;
|
||||
if (nemu_send_command(host, host->mrq->cmd)) {
|
||||
if (host->data) {
|
||||
// start PIO right now
|
||||
for (i = 0; i < host->data->blocks; i ++) {
|
||||
nemu_transfer_pio(host);
|
||||
}
|
||||
|
||||
nemu_finish_data(host);
|
||||
}
|
||||
|
||||
nemu_finish_command(host);
|
||||
}
|
||||
} else if (cmd == host->mrq->stop) {
|
||||
/* Finished CMD12 */
|
||||
nemu_finish_request(host);
|
||||
} else {
|
||||
/* Processed actual command. */
|
||||
host->cmd = NULL;
|
||||
if (!host->data) {
|
||||
nemu_finish_request(host);
|
||||
}
|
||||
else if (host->data_complete) {
|
||||
nemu_transfer_complete(host);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void nemu_request(struct mmc_host *mmc, struct mmc_request *mrq)
|
||||
{
|
||||
struct nemu_host *host = mmc_priv(mmc);
|
||||
struct device *dev = &host->pdev->dev;
|
||||
|
||||
/* Reset the error statuses in case this is a retry */
|
||||
if (mrq->sbc)
|
||||
mrq->sbc->error = 0;
|
||||
if (mrq->cmd)
|
||||
mrq->cmd->error = 0;
|
||||
if (mrq->data)
|
||||
mrq->data->error = 0;
|
||||
if (mrq->stop)
|
||||
mrq->stop->error = 0;
|
||||
|
||||
if (mrq->data && !is_power_of_2(mrq->data->blksz)) {
|
||||
dev_err(dev, "unsupported block size (%d bytes)\n",
|
||||
mrq->data->blksz);
|
||||
|
||||
if (mrq->cmd)
|
||||
mrq->cmd->error = -EINVAL;
|
||||
|
||||
mmc_request_done(mmc, mrq);
|
||||
return;
|
||||
}
|
||||
|
||||
mutex_lock(&host->mutex);
|
||||
|
||||
WARN_ON(host->mrq);
|
||||
host->mrq = mrq;
|
||||
|
||||
host->use_sbc = !!mrq->sbc && host->mrq->data &&
|
||||
(host->mrq->data->flags & MMC_DATA_READ);
|
||||
if (host->use_sbc) {
|
||||
if (nemu_send_command(host, mrq->sbc)) {
|
||||
nemu_finish_command(host);
|
||||
}
|
||||
} else if (mrq->cmd && nemu_send_command(host, mrq->cmd)) {
|
||||
if (host->data) {
|
||||
int i;
|
||||
// start PIO right now
|
||||
for (i = 0; i < host->data->blocks; i ++) {
|
||||
nemu_transfer_pio(host);
|
||||
}
|
||||
nemu_finish_data(host);
|
||||
}
|
||||
|
||||
nemu_finish_command(host);
|
||||
}
|
||||
|
||||
mutex_unlock(&host->mutex);
|
||||
}
|
||||
|
||||
static void nemu_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
|
||||
{
|
||||
}
|
||||
|
||||
static const struct mmc_host_ops nemu_ops = {
|
||||
.request = nemu_request,
|
||||
.set_ios = nemu_set_ios,
|
||||
.hw_reset = nemu_reset,
|
||||
};
|
||||
|
||||
static int nemu_add_host(struct nemu_host *host)
|
||||
{
|
||||
struct mmc_host *mmc = host->mmc;
|
||||
struct device *dev = &host->pdev->dev;
|
||||
int ret;
|
||||
|
||||
if (!mmc->f_max || mmc->f_max > host->max_clk)
|
||||
mmc->f_max = host->max_clk;
|
||||
mmc->f_min = host->max_clk / SDCDIV_MAX_CDIV;
|
||||
|
||||
mmc->max_busy_timeout = ~0 / (mmc->f_max / 1000);
|
||||
|
||||
dev_dbg(dev, "f_max %d, f_min %d, max_busy_timeout %d\n",
|
||||
mmc->f_max, mmc->f_min, mmc->max_busy_timeout);
|
||||
|
||||
/* host controller capabilities */
|
||||
mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED |
|
||||
MMC_CAP_NEEDS_POLL | MMC_CAP_HW_RESET | MMC_CAP_ERASE |
|
||||
MMC_CAP_CMD23;
|
||||
|
||||
spin_lock_init(&host->lock);
|
||||
mutex_init(&host->mutex);
|
||||
|
||||
mmc->max_segs = 128;
|
||||
mmc->max_req_size = 524288;
|
||||
mmc->max_seg_size = mmc->max_req_size;
|
||||
mmc->max_blk_size = 1024;
|
||||
mmc->max_blk_count = 65535;
|
||||
|
||||
/* report supported voltage ranges */
|
||||
mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
|
||||
|
||||
ret = mmc_add_host(mmc);
|
||||
if (ret) {
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_info(dev, "loaded - DMA %s\n", "disabled");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int nemu_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct device *dev = &pdev->dev;
|
||||
struct resource *iomem;
|
||||
struct nemu_host *host;
|
||||
struct mmc_host *mmc;
|
||||
const __be32 *regaddr_p;
|
||||
int ret;
|
||||
|
||||
dev_dbg(dev, "%s\n", __func__);
|
||||
mmc = mmc_alloc_host(sizeof(*host), dev);
|
||||
if (!mmc)
|
||||
return -ENOMEM;
|
||||
|
||||
mmc->ops = &nemu_ops;
|
||||
host = mmc_priv(mmc);
|
||||
host->mmc = mmc;
|
||||
host->pdev = pdev;
|
||||
spin_lock_init(&host->lock);
|
||||
|
||||
iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
host->ioaddr = devm_ioremap_resource(dev, iomem);
|
||||
if (IS_ERR(host->ioaddr)) {
|
||||
ret = PTR_ERR(host->ioaddr);
|
||||
goto err;
|
||||
}
|
||||
|
||||
/* Parse OF address directly to get the physical address for
|
||||
* DMA to our registers.
|
||||
*/
|
||||
regaddr_p = of_get_address(pdev->dev.of_node, 0, NULL, NULL);
|
||||
if (!regaddr_p) {
|
||||
dev_err(dev, "Can't get phys address\n");
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
|
||||
host->phys_addr = be32_to_cpup(regaddr_p);
|
||||
|
||||
host->max_clk = 1000000; //clk_get_rate(clk);
|
||||
|
||||
ret = mmc_of_parse(mmc);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
ret = nemu_add_host(host);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
platform_set_drvdata(pdev, host);
|
||||
|
||||
dev_dbg(dev, "%s -> OK\n", __func__);
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
dev_dbg(dev, "%s -> err %d\n", __func__, ret);
|
||||
mmc_free_host(mmc);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int nemu_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct nemu_host *host = platform_get_drvdata(pdev);
|
||||
|
||||
mmc_remove_host(host->mmc);
|
||||
|
||||
mmc_free_host(host->mmc);
|
||||
platform_set_drvdata(pdev, NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id nemu_match[] = {
|
||||
{ .compatible = "nemu-sdhost" },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, nemu_match);
|
||||
|
||||
static struct platform_driver nemu_driver = {
|
||||
.probe = nemu_probe,
|
||||
.remove = nemu_remove,
|
||||
.driver = {
|
||||
.name = "sdhost-nemu",
|
||||
.of_match_table = nemu_match,
|
||||
},
|
||||
};
|
||||
module_platform_driver(nemu_driver);
|
||||
|
||||
MODULE_ALIAS("platform:sdhost-nemu");
|
||||
MODULE_DESCRIPTION("NEMU SDHost driver");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_AUTHOR("Zihao Yu");
|
||||
Loading…
Add table
Add a link
Reference in a new issue