xref: /illumos-gate/usr/src/uts/common/io/1394/targets/dcam1394/dcam_reg.c (revision 581cede61ac9c14d8d4ea452562a567189eead78)
1 /*
2  * CDDL HEADER START
3  *
4  * The contents of this file are subject to the terms of the
5  * Common Development and Distribution License, Version 1.0 only
6  * (the "License").  You may not use this file except in compliance
7  * with the License.
8  *
9  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10  * or http://www.opensolaris.org/os/licensing.
11  * See the License for the specific language governing permissions
12  * and limitations under the License.
13  *
14  * When distributing Covered Code, include this CDDL HEADER in each
15  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16  * If applicable, add the following below this CDDL HEADER, with the
17  * fields enclosed by brackets "[]" replaced with your own identifying
18  * information: Portions Copyright [yyyy] [name of copyright owner]
19  *
20  * CDDL HEADER END
21  */
22 /*
23  * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
24  * Use is subject to license terms.
25  */
26 
27 #pragma ident	"%Z%%M%	%I%	%E% SMI"
28 
29 /*
30  * dcam_reg.c
31  *
32  * dcam1394 driver.  Control register access support.
33  */
34 
35 #include <sys/tnf_probe.h>
36 #include <sys/1394/targets/dcam1394/dcam_reg.h>
37 
38 
39 /*
40  * dcam_reg_read
41  */
42 int
43 dcam_reg_read(dcam_state_t *soft_state, dcam1394_reg_io_t *arg)
44 {
45 	cmd1394_cmd_t	*cmdp;
46 
47 	if (t1394_alloc_cmd(soft_state->sl_handle, 1, &cmdp) != DDI_SUCCESS) {
48 		return (-1);
49 	}
50 
51 	cmdp->cmd_type = CMD1394_ASYNCH_RD_QUAD;
52 	cmdp->cmd_addr = 0x0000FFFFF0F00000 |
53 	    (uint64_t)(arg->offs & 0x00000FFC);
54 	cmdp->cmd_options = CMD1394_BLOCKING;
55 
56 #ifdef GRAPHICS_DELAY
57 	/*
58 	 * This delay should not be necessary, but was added for some
59 	 * unknown reason.  Should it ever be determined that it
60 	 * is necessary, this delay should be reenabled.
61 	 */
62 	delay(drv_usectohz(500));
63 #endif
64 
65 	if (t1394_read(soft_state->sl_handle, cmdp) != DDI_SUCCESS) {
66 		(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
67 		return (-1);
68 	}
69 
70 	if (cmdp->cmd_result != DDI_SUCCESS) {
71 		(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
72 		return (-1);
73 	}
74 
75 	/* perform endian adjustment */
76 	cmdp->cmd_u.q.quadlet_data = T1394_DATA32(cmdp->cmd_u.q.quadlet_data);
77 	arg->val = cmdp->cmd_u.q.quadlet_data;
78 
79 	(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
80 
81 	return (0);
82 }
83 
84 
85 /*
86  * dcam_reg_write
87  */
88 int
89 dcam_reg_write(dcam_state_t *soft_state, dcam1394_reg_io_t *arg)
90 {
91 	cmd1394_cmd_t	*cmdp;
92 
93 	if (t1394_alloc_cmd(soft_state->sl_handle, 0, &cmdp) != DDI_SUCCESS) {
94 		return (-1);
95 	}
96 
97 	cmdp->cmd_type = CMD1394_ASYNCH_WR_QUAD;
98 	cmdp->cmd_addr = 0x0000FFFFF0F00000 |
99 	    (uint64_t)(arg->offs & 0x00000FFC);
100 	cmdp->cmd_options = CMD1394_BLOCKING;
101 
102 	/* perform endian adjustment */
103 	cmdp->cmd_u.q.quadlet_data = T1394_DATA32(arg->val);
104 
105 #ifdef GRAPHICS_DELAY
106 	/*
107 	 * See the description in dcam_reg_read() above.
108 	 */
109 	delay(drv_usectohz(500));
110 #endif
111 
112 	if (t1394_write(soft_state->sl_handle, cmdp) != DDI_SUCCESS) {
113 		(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
114 		return (-1);
115 	}
116 
117 	if (cmdp->cmd_result != DDI_SUCCESS) {
118 		(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
119 		return (-1);
120 	}
121 
122 	(void) t1394_free_cmd(soft_state->sl_handle, 0, &cmdp);
123 
124 	return (0);
125 }
126