diff --git a/jtag/src/pxa250.c b/jtag/src/pxa250.c new file mode 100644 index 00000000..264d41fc --- /dev/null +++ b/jtag/src/pxa250.c @@ -0,0 +1,129 @@ +/* + * $Id$ + * + * Copyright (C) 2002 ETC s.r.o. + * + * This program is free software; 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 2 + * 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 + * 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, write to the Free Software + * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA + * 02111-1307, USA. + * + * Written by Marcel Telka , 2002. + * + */ + +#include + +#include "part.h" + +#include "pxa250.h" + +/* PXA250 must be in position 0 */ + +static void +setup_address( part *p, uint32_t a ) +{ + int i; + char buff[10]; + + for (i = 0; i < 26; i++) { + sprintf( buff, "MA[%d]", i ); + part_set_signal( p, buff, 1, (a >> i) & 1 ); + } +} + +static void +set_data_in( part *p ) +{ + int i; + char buff[10]; + + for (i = 0; i < 32; i++) { + sprintf( buff, "MD[%d]", i ); + part_set_signal( p, buff, 0, 0 ); + } +} + +static void +setup_data( part *p, uint32_t d ) +{ + int i; + char buff[10]; + + for (i = 0; i < 32; i++) { + sprintf( buff, "MD[%d]", i ); + part_set_signal( p, buff, 1, (d >> i) & 1 ); + } +} + +uint32_t +pxa250_bus_read( parts *ps, uint32_t adr ) +{ + part *p = ps->parts[0]; + + part_set_signal( p, "nCS[0]", 1, 0 ); + part_set_signal( p, "DQM[0]", 1, 0 ); + part_set_signal( p, "DQM[1]", 1, 0 ); + part_set_signal( p, "DQM[2]", 1, 0 ); + part_set_signal( p, "DQM[3]", 1, 0 ); + part_set_signal( p, "RDnWR", 1, 1 ); + part_set_signal( p, "nWE", 1, 1 ); + part_set_signal( p, "nOE", 1, 0 ); + part_set_signal( p, "nSDCAS", 1, 0 ); + + setup_address( p, adr ); + set_data_in( p ); + + parts_shift_data_registers( ps ); + parts_shift_data_registers( ps ); + + { + int i; + char buff[10]; + uint32_t d = 0; + + for (i = 0; i < 32; i++) { + sprintf( buff, "MD[%d]", i ); + d |= (uint32_t) (part_get_signal( p, buff ) << i); + } + + return d; + } +} + +void +pxa250_bus_write( parts *ps, uint32_t adr, uint32_t data ) +{ + /* see Figure 6-17 in PXA doc */ + part *p = ps->parts[0]; + + part_set_signal( p, "nCS[0]", 1, 0 ); + part_set_signal( p, "DQM[0]", 1, 0 ); + part_set_signal( p, "DQM[1]", 1, 0 ); + part_set_signal( p, "DQM[2]", 1, 0 ); + part_set_signal( p, "DQM[3]", 1, 0 ); + part_set_signal( p, "RDnWR", 1, 0 ); + part_set_signal( p, "nWE", 1, 1 ); + part_set_signal( p, "nOE", 1, 1 ); + part_set_signal( p, "nSDCAS", 1, 0 ); + + setup_address( p, adr ); + setup_data( p, data ); + + parts_shift_data_registers( ps ); + + part_set_signal( p, "nWE", 1, 0 ); + parts_shift_data_registers( ps ); + part_set_signal( p, "nWE", 1, 1 ); + parts_shift_data_registers( ps ); +}