15a04522aSIan Romanick /*
25a04522aSIan Romanick * (C) Copyright IBM Corporation 2006
35a04522aSIan Romanick * All Rights Reserved.
45a04522aSIan Romanick *
55a04522aSIan Romanick * Permission is hereby granted, free of charge, to any person obtaining a
65a04522aSIan Romanick * copy of this software and associated documentation files (the "Software"),
75a04522aSIan Romanick * to deal in the Software without restriction, including without limitation
85a04522aSIan Romanick * on the rights to use, copy, modify, merge, publish, distribute, sub
95a04522aSIan Romanick * license, and/or sell copies of the Software, and to permit persons to whom
105a04522aSIan Romanick * the Software is furnished to do so, subject to the following conditions:
115a04522aSIan Romanick *
125a04522aSIan Romanick * The above copyright notice and this permission notice (including the next
135a04522aSIan Romanick * paragraph) shall be included in all copies or substantial portions of the
145a04522aSIan Romanick * Software.
155a04522aSIan Romanick *
165a04522aSIan Romanick * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
175a04522aSIan Romanick * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
185a04522aSIan Romanick * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
195a04522aSIan Romanick * IBM AND/OR THEIR SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
205a04522aSIan Romanick * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
215a04522aSIan Romanick * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
225a04522aSIan Romanick * DEALINGS IN THE SOFTWARE.
235a04522aSIan Romanick */
245a04522aSIan Romanick
255a04522aSIan Romanick /**
265a04522aSIan Romanick * \file common_iterator.c
275a04522aSIan Romanick * Platform independent iterator support routines.
285a04522aSIan Romanick *
295a04522aSIan Romanick * \author Ian Romanick <[email protected]>
305a04522aSIan Romanick */
315a04522aSIan Romanick
325a04522aSIan Romanick #include <stdlib.h>
335a04522aSIan Romanick #include <string.h>
345a04522aSIan Romanick
355a04522aSIan Romanick #include "pciaccess.h"
365a04522aSIan Romanick #include "pciaccess_private.h"
375a04522aSIan Romanick
385a04522aSIan Romanick /**
395a04522aSIan Romanick * Track device iteration state
405a04522aSIan Romanick *
415a04522aSIan Romanick * \private
425a04522aSIan Romanick */
435a04522aSIan Romanick struct pci_device_iterator {
445a04522aSIan Romanick unsigned next_index;
455a04522aSIan Romanick
4664af050cSIan Romanick enum {
4764af050cSIan Romanick match_any,
4864af050cSIan Romanick match_slot,
4964af050cSIan Romanick match_id
5064af050cSIan Romanick } mode;
5164af050cSIan Romanick
5264af050cSIan Romanick union {
5364af050cSIan Romanick struct pci_slot_match slot;
5464af050cSIan Romanick struct pci_id_match id;
5564af050cSIan Romanick } match;
5664af050cSIan Romanick };
575a04522aSIan Romanick
585a04522aSIan Romanick
595a04522aSIan Romanick /**
605a04522aSIan Romanick * Create an iterator based on a regular expression.
615a04522aSIan Romanick *
625a04522aSIan Romanick * \return
635a04522aSIan Romanick * A pointer to a fully initialized \c pci_device_iterator structure on
645a04522aSIan Romanick * success, or \c NULL on failure.
655a04522aSIan Romanick *
6664af050cSIan Romanick * \sa pci_id_match_iterator_create, pci_device_next, pci_iterator_destroy
675a04522aSIan Romanick */
685a04522aSIan Romanick struct pci_device_iterator *
pci_slot_match_iterator_create(const struct pci_slot_match * match)6964af050cSIan Romanick pci_slot_match_iterator_create( const struct pci_slot_match * match )
705a04522aSIan Romanick {
715a04522aSIan Romanick struct pci_device_iterator * iter;
725a04522aSIan Romanick
735a04522aSIan Romanick if ( pci_sys == NULL ) {
745a04522aSIan Romanick return NULL;
755a04522aSIan Romanick }
765a04522aSIan Romanick
775a04522aSIan Romanick iter = malloc( sizeof( *iter ) );
785a04522aSIan Romanick if ( iter != NULL ) {
795a04522aSIan Romanick iter->next_index = 0;
805a04522aSIan Romanick
8164af050cSIan Romanick if ( match != NULL ) {
8264af050cSIan Romanick iter->mode = match_slot;
835a04522aSIan Romanick
8464af050cSIan Romanick (void) memcpy( & iter->match.slot, match, sizeof( *match ) );
855a04522aSIan Romanick }
865a04522aSIan Romanick else {
8764af050cSIan Romanick iter->mode = match_any;
8864af050cSIan Romanick }
8964af050cSIan Romanick }
9064af050cSIan Romanick
9164af050cSIan Romanick return iter;
9264af050cSIan Romanick }
9364af050cSIan Romanick
9464af050cSIan Romanick
9564af050cSIan Romanick /**
9664af050cSIan Romanick * Create an iterator based on a regular expression.
9764af050cSIan Romanick *
9864af050cSIan Romanick * \return
9964af050cSIan Romanick * A pointer to a fully initialized \c pci_device_iterator structure on
10064af050cSIan Romanick * success, or \c NULL on failure.
10164af050cSIan Romanick *
10264af050cSIan Romanick * \sa pci_slot_match_iterator_create, pci_device_next, pci_iterator_destroy
10364af050cSIan Romanick */
10464af050cSIan Romanick struct pci_device_iterator *
pci_id_match_iterator_create(const struct pci_id_match * match)10564af050cSIan Romanick pci_id_match_iterator_create( const struct pci_id_match * match )
10664af050cSIan Romanick {
10764af050cSIan Romanick struct pci_device_iterator * iter;
10864af050cSIan Romanick
10964af050cSIan Romanick if ( pci_sys == NULL ) {
11064af050cSIan Romanick return NULL;
11164af050cSIan Romanick }
11264af050cSIan Romanick
11364af050cSIan Romanick iter = malloc( sizeof( *iter ) );
11464af050cSIan Romanick if ( iter != NULL ) {
11564af050cSIan Romanick iter->next_index = 0;
11664af050cSIan Romanick
11764af050cSIan Romanick if ( match != NULL ) {
11864af050cSIan Romanick iter->mode = match_id;
11964af050cSIan Romanick
12064af050cSIan Romanick (void) memcpy( & iter->match.id, match, sizeof( *match ) );
12164af050cSIan Romanick }
12264af050cSIan Romanick else {
12364af050cSIan Romanick iter->mode = match_any;
1245a04522aSIan Romanick }
1255a04522aSIan Romanick }
1265a04522aSIan Romanick
1275a04522aSIan Romanick return iter;
1285a04522aSIan Romanick }
1295a04522aSIan Romanick
1305a04522aSIan Romanick
1315a04522aSIan Romanick /**
1325a04522aSIan Romanick * Destroy an iterator previously created with \c pci_iterator_create.
1335a04522aSIan Romanick *
1345a04522aSIan Romanick * \param iter Iterator to be destroyed.
1355a04522aSIan Romanick *
1365a04522aSIan Romanick * \sa pci_device_next, pci_iterator_create
1375a04522aSIan Romanick */
1385a04522aSIan Romanick void
pci_iterator_destroy(struct pci_device_iterator * iter)1395a04522aSIan Romanick pci_iterator_destroy( struct pci_device_iterator * iter )
1405a04522aSIan Romanick {
1415a04522aSIan Romanick if ( iter != NULL ) {
1425a04522aSIan Romanick free( iter );
1435a04522aSIan Romanick }
1445a04522aSIan Romanick }
1455a04522aSIan Romanick
1465a04522aSIan Romanick
1475a04522aSIan Romanick /**
1485a04522aSIan Romanick * Iterate to the next PCI device.
1495a04522aSIan Romanick *
1505a04522aSIan Romanick * \param iter Device iterator returned by \c pci_device_iterate.
1515a04522aSIan Romanick *
1525a04522aSIan Romanick * \return
1535a04522aSIan Romanick * A pointer to a \c pci_device, or \c NULL when all devices have been
1545a04522aSIan Romanick * iterated.
1555a04522aSIan Romanick */
1565a04522aSIan Romanick struct pci_device *
pci_device_next(struct pci_device_iterator * iter)1575a04522aSIan Romanick pci_device_next( struct pci_device_iterator * iter )
1585a04522aSIan Romanick {
1595a04522aSIan Romanick struct pci_device_private * d = NULL;
1605a04522aSIan Romanick
161*4586bb67SAdam Jackson if (!iter)
162*4586bb67SAdam Jackson return NULL;
163*4586bb67SAdam Jackson
16464af050cSIan Romanick switch( iter->mode ) {
16564af050cSIan Romanick case match_any:
1665a04522aSIan Romanick if ( iter->next_index < pci_sys->num_devices ) {
1675a04522aSIan Romanick d = & pci_sys->devices[ iter->next_index ];
1685a04522aSIan Romanick iter->next_index++;
1695a04522aSIan Romanick }
17064af050cSIan Romanick
17164af050cSIan Romanick break;
17264af050cSIan Romanick
17364af050cSIan Romanick case match_slot: {
1745a04522aSIan Romanick while ( iter->next_index < pci_sys->num_devices ) {
1755a04522aSIan Romanick struct pci_device_private * const temp =
1765a04522aSIan Romanick & pci_sys->devices[ iter->next_index ];
1775a04522aSIan Romanick
1785a04522aSIan Romanick iter->next_index++;
17964af050cSIan Romanick if ( PCI_ID_COMPARE( iter->match.slot.domain, temp->base.domain )
18064af050cSIan Romanick && PCI_ID_COMPARE( iter->match.slot.bus, temp->base.bus )
18164af050cSIan Romanick && PCI_ID_COMPARE( iter->match.slot.dev, temp->base.dev )
18264af050cSIan Romanick && PCI_ID_COMPARE( iter->match.slot.func, temp->base.func ) ) {
1835a04522aSIan Romanick d = temp;
1845a04522aSIan Romanick break;
1855a04522aSIan Romanick }
1865a04522aSIan Romanick }
18764af050cSIan Romanick
18864af050cSIan Romanick break;
18964af050cSIan Romanick }
19064af050cSIan Romanick
19164af050cSIan Romanick case match_id: {
19264af050cSIan Romanick while ( iter->next_index < pci_sys->num_devices ) {
19364af050cSIan Romanick struct pci_device_private * const temp =
19464af050cSIan Romanick & pci_sys->devices[ iter->next_index ];
19564af050cSIan Romanick
19664af050cSIan Romanick iter->next_index++;
19764af050cSIan Romanick if ( PCI_ID_COMPARE( iter->match.id.vendor_id, temp->base.vendor_id )
19864af050cSIan Romanick && PCI_ID_COMPARE( iter->match.id.device_id, temp->base.device_id )
19964af050cSIan Romanick && PCI_ID_COMPARE( iter->match.id.subvendor_id, temp->base.subvendor_id )
20064af050cSIan Romanick && PCI_ID_COMPARE( iter->match.id.subdevice_id, temp->base.subdevice_id )
20164af050cSIan Romanick && ((temp->base.device_class & iter->match.id.device_class_mask)
20264af050cSIan Romanick == iter->match.id.device_class) ) {
20364af050cSIan Romanick d = temp;
20464af050cSIan Romanick break;
20564af050cSIan Romanick }
20664af050cSIan Romanick }
20764af050cSIan Romanick
20864af050cSIan Romanick break;
20964af050cSIan Romanick }
2105a04522aSIan Romanick }
2115a04522aSIan Romanick
2125a04522aSIan Romanick return (struct pci_device *) d;
2135a04522aSIan Romanick }
21464af050cSIan Romanick
21564af050cSIan Romanick
21664af050cSIan Romanick struct pci_device *
pci_device_find_by_slot(uint32_t domain,uint32_t bus,uint32_t dev,uint32_t func)21764af050cSIan Romanick pci_device_find_by_slot( uint32_t domain, uint32_t bus, uint32_t dev,
21864af050cSIan Romanick uint32_t func )
21964af050cSIan Romanick {
22064af050cSIan Romanick struct pci_device_iterator iter;
22164af050cSIan Romanick
22264af050cSIan Romanick
22364af050cSIan Romanick iter.next_index = 0;
22464af050cSIan Romanick iter.mode = match_slot;
22564af050cSIan Romanick iter.match.slot.domain = domain;
22664af050cSIan Romanick iter.match.slot.bus = bus;
22764af050cSIan Romanick iter.match.slot.dev = dev;
22864af050cSIan Romanick iter.match.slot.func = func;
22964af050cSIan Romanick
23064af050cSIan Romanick return pci_device_next( & iter );
23164af050cSIan Romanick }
232