00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022 #include <cds_digitalio.h>
00023
00024 #include <C8051F340_defs.h>
00025
00026
00027
00028
00029
00030
00031
00032 cd_Error cds_DAQWriteDigitalLine(uint8_t subdevice, uint8_t line, uint8_t value) {
00033
00034 cd_Error result = CD_Error_NoError;
00035
00036 switch(subdevice) {
00037
00038 case 0x00:
00039 if (value) {
00040 P0 |= (1 << line);
00041 } else {
00042 P0 &= ~(1 << line);
00043 }
00044 break;
00045 case 0x01:
00046 if (value) {
00047 P1 |= (1 << line);
00048 } else {
00049 P1 &= ~(1 << line);
00050 }
00051 break;
00052 case 0x02:
00053 if (value) {
00054 P2 |= (1 << line);
00055 } else {
00056 P2 &= ~(1 << line);
00057 }
00058 break;
00059 case 0x03:
00060 if (value) {
00061 P3 |= (1 << line);
00062 } else {
00063 P3 &= ~(1 << line);
00064 }
00065 break;
00066 default:
00067 result = CD_Error_DAQBadSubdevice;
00068 break;
00069 }
00070
00071 return(result);
00072 }
00073
00074
00075
00076
00077 cd_Error cds_DAQReadDigitalLine(uint8_t subdevice, uint8_t line, uint8_t *value) {
00078
00079 uint8_t dat;
00080
00081 switch(subdevice) {
00082
00083 case 0x00:
00084 dat = P0;
00085 break;
00086 case 0x01:
00087 dat = P1;
00088 break;
00089 case 0x02:
00090 dat = P2;
00091 break;
00092 case 0x03:
00093 dat = P3;
00094 break;
00095 default:
00096 return(CD_Error_DAQBadSubdevice);
00097 }
00098
00099
00100 if (dat & (1<<line)) {
00101 *value = 1;
00102 } else {
00103 *value = 0;
00104 }
00105
00106
00107 return(CD_Error_NoError);
00108 }
00109
00110
00111
00112
00113 cd_Error cds_DAQWriteDigitalPort(uint8_t subdevice, uint8_t value) {
00114
00115 cd_Error result = CD_Error_NoError;
00116
00117 switch(subdevice) {
00118
00119 case 0x00:
00120 P0= value;
00121 break;
00122 case 0x01:
00123 P1= value;
00124 break;
00125 case 0x02:
00126 P2= value;
00127 break;
00128 case 0x03:
00129 P3= value;
00130 break;
00131 default:
00132 result = CD_Error_DAQBadSubdevice;
00133 break;
00134 }
00135
00136 return(result);
00137 }
00138
00139
00140
00141 cd_Error cds_DAQWriteDigitalPortMask(uint8_t subdevice, uint8_t value, uint8_t mask) {
00142
00143 cd_Error result = CD_Error_NoError;
00144
00145 data uint8_t val_and;
00146 data uint8_t val_or;
00147
00148
00149 val_and = ~mask | value;
00150 val_or = mask & value;
00151
00152
00153
00154 switch(subdevice) {
00155
00156 case 0x00:
00157 P0 &= val_and;
00158 P0 |= val_or;
00159 break;
00160 case 0x01:
00161 P1 &= val_and;
00162 P1 |= val_or;
00163 break;
00164 case 0x02:
00165 P2 &= val_and;
00166 P2 |= val_or;
00167 break;
00168 case 0x03:
00169 P3 &= val_and;
00170 P3 |= val_or;
00171 break;
00172 default:
00173 result = CD_Error_DAQBadSubdevice;
00174 break;
00175 }
00176
00177 return(result);
00178 }
00179
00180
00181
00182
00183 cd_Error cds_DAQReadDigitalPort(uint8_t subdevice, uint8_t *value) {
00184
00185
00186 switch(subdevice) {
00187
00188 case 0x00:
00189 *value = P0;
00190 break;
00191 case 0x01:
00192 *value = P1;
00193 break;
00194 case 0x02:
00195 *value = P2;
00196 break;
00197 case 0x03:
00198 *value = P3;
00199 break;
00200 default:
00201 return(CD_Error_DAQBadSubdevice);
00202 }
00203
00204 return(CD_Error_NoError);
00205 }
00206
00207
00208