Subversion Repositories s6soc

////////////////////////////////////////////////////////////////////////////////
//
// Filename: 	pipesetup.c
//
// Project:	CMod S6 System on a Chip, ZipCPU demonstration project
//
// Purpose:	The routines in this file were split from syspipe.c for the
//		purposes of limiting the amount of RAM memory a process would
//	use.  Specifically, these routines are not time critical and hence can
//	run from FLASH, whereas the other set must run from block RAM.
//
// Creator:	Dan Gisselquist, Ph.D.
//		Gisselquist Technology, LLC
//
////////////////////////////////////////////////////////////////////////////////
//
// Copyright (C) 2015-2016, Gisselquist Technology, LLC
//
// This program is free software (firmware): you can redistribute it and/or
// modify it under the terms of  the GNU General Public License as published
// by the Free Software Foundation, either version 3 of the License, or (at
// your option) any later version.
//
// This program is distributed in the hope that it will be useful, but WITHOUT
// ANY WARRANTY; without even the implied warranty of MERCHANTIBILITY 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.  (It's in the $(ROOT)/doc directory, run make with no
// target there if the PDF file isn't present.)  If not, see
// <http://www.gnu.org/licenses/> for a copy.
//
// License:	GPL, v3, as defined and found on www.gnu.org,
//		http://www.gnu.org/licenses/gpl.html
//
//
////////////////////////////////////////////////////////////////////////////////
//
//
#include "errno.h"
#include "board.h"
#include "taskp.h"
#include "syspipe.h"
#include "zipsys.h"
#include "ktraps.h"
 
#ifndef	NULL
#define	NULL	(void *)0
#endif
 
// Since this is only called with new_syspipe, we're good here
static	void	clear_syspipe(SYSPIPE *p) {
	p->m_head  = 0;
	p->m_tail  = 0;
	p->m_error = 0;
 
	for(int i=0; i<=(int)p->m_mask; i++)
		p->m_buf[i] = 0;
 
	if ((p->m_rdtask)&&(p->m_rdtask != INTERRUPT_READ_TASK)) {
		p->m_rdtask->context[1] = p->m_nread;
		if (p->m_nread == 0)
			p->m_rdtask->errno = -EFAULT;
		p->m_rdtask->state = SCHED_READY;
	} else if (p->m_wrtask) {
		p->m_wrtask->context[1] = p->m_nwritten;
		if (p->m_nwritten == 0)
			p->m_wrtask->errno = -EFAULT;
		p->m_wrtask->state = SCHED_READY;
	}
 
	if (p->m_rdtask != INTERRUPT_READ_TASK)
		p->m_rdtask   = 0;
	p->m_wrtask   = 0;
	p->m_nread    = 0;
	p->m_nwritten = 0;
}
 
// These routines really belong elsewhere in a uartdump.c file or some such.
// However, until placed there, they'll stay put here for a bit longer.
void	txchr(char v) {
	volatile IOSPACE	*sys = (IOSPACE *)IOADDR;
	if (v < 10)
		return;
	v &= 0x0ff;
	sys->io_pic = INT_UARTTX;
	while((sys->io_pic&INT_UARTTX)==0)
		;
	sys->io_uart = v;
}
 
void	txstr(const char *str) {
	const char *ptr = str;
	while(*ptr) {
		txchr(*ptr++);
	}
}
 
void	txhex(int num) {
	for(int ds=28; ds>=0; ds-=4) {
		int	ch;
		ch = (num>>ds)&0x0f;
		if (ch >= 10)
			ch = 'A'+ch-10;
		else
			ch += '0';
		txchr(ch);
	} txstr("\r\n");
}
 
void	pipe_panic(SYSPIPE *pipe) {
	extern void	kpanic(void);
	volatile IOSPACE	*sys = (IOSPACE *)IOADDR;
 
	sys->io_spio = 0x0fa;
 
	txstr("SYSPIPE PANIC!\r\n");
	txstr("ADDR: "); txhex((int)pipe);
	txstr("MASK: "); txhex(pipe->m_mask);
	txstr("HEAD: "); txhex(pipe->m_head);
	txstr("TAIL: "); txhex(pipe->m_tail);
	kpanic();
}
 
SYSPIPE *new_syspipe(const unsigned int len) {
	unsigned	msk;
 
	for(msk=2; msk<len; msk<<=1)
		;
	SYSPIPE *pipe = sys_malloc(sizeof(SYSPIPE)-1+msk);
	pipe->m_mask = msk-1;
	pipe->m_rdtask = pipe->m_wrtask = 0;
	clear_syspipe(pipe);
	return pipe;
}