4673606d9906b4de904181387ede89015c8504d9
[gpxe.git] / src / drivers / nvs / threewire.c
1 /*
2  * Copyright (C) 2006 Michael Brown <mbrown@fensystems.co.uk>.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License as
6  * published by the Free Software Foundation; either version 2 of the
7  * License, or any later version.
8  *
9  * This program is distributed in the hope that it will be useful, but
10  * WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17  */
18
19 #include <timer.h>
20 #include <gpxe/nvs/threewire.h>
21
22 /** @file
23  *
24  * Three-wire serial interface
25  *
26  */
27
28 /**
29  * Read from a three-wire device
30  *
31  * @v three     Three-wire interface
32  * @v address   Address
33  * @ret data    Data
34  */
35 unsigned long threewire_read ( struct threewire *three,
36                                unsigned long address ) {
37         struct threewire_operations *ops = three->ops;
38         unsigned long command;
39         unsigned long data;
40         int i;
41
42         ops->setcs ( three, 1 );
43         
44         /* Send command and address */
45         command = threewire_cmd_read ( three, address );
46         for ( i = ( threewire_cmd_len ( three ) - 1 ) ; i >= 0 ; i-- ) {
47                 ops->setdi ( three, ( command >> i ) & 0x1 );
48                 udelay ( three->udelay );
49                 ops->setsk ( three, 1 );
50                 udelay ( three->udelay );
51                 ops->setsk ( three, 0 );
52         }
53
54         /* Read back data */
55         data = 0;
56         for ( i = three->datasize ; i ; i-- ) {
57                 udelay ( three->udelay );
58                 ops->setsk ( three, 1 );
59                 udelay ( three->udelay );
60                 data <<= 1;
61                 data |= ops->getdo ( three );
62                 ops->setsk ( three, 0 );
63         }
64
65         ops->setcs ( three, 0 );
66
67         return data;
68 }