Changeset 694
- Timestamp:
- 12/04/09 23:51:27 (14 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
branches/smartreader/csctapi/io_serial.c
r683 r694 915 915 srConfig->T=0; 916 916 srConfig->inv=0; 917 918 # ifdef DEBUG_IO 919 printf("IO: Smartreader+ default parameter set to F=%d D=%f fs=%dKHz N=%d T=%d inv=%d\n", 920 srConfig->F, 921 srConfig->D, 922 srConfig->fs, 923 srConfig->N, 924 srConfig->T, 925 srConfig->inv); 926 # endif 917 927 } 918 928 … … 965 975 static bool IO_Serial_Set_Smartreader_Config(IO_Serial * io) 966 976 { 967 SR_Config *sr _config;977 SR_Config *srConfig; 968 978 struct termios term; 969 979 BYTE cmd[16]; 970 980 int fs; 971 981 972 sr _config=io->SmartReaderConf;973 if(sr _config==NULL)974 return FALSE; 975 976 fs=(sr _config->fs)/1000; // convert to kHz.982 srConfig=io->SmartReaderConf; 983 if(srConfig==NULL) 984 return FALSE; 985 986 fs=(srConfig->fs)/1000; // convert to kHz. 977 987 978 988 # ifdef DEBUG_IO 979 989 printf("IO: Smartreader+ on %s: F=%d D=%f fs=%dKHz N=%d T=%d inv=%d\n", 980 990 io->filename, 981 sr _config->F,982 sr _config->D,991 srConfig->F, 992 srConfig->D, 983 993 fs, 984 sr _config->N,985 sr _config->T,986 sr _config->inv);994 srConfig->N, 995 srConfig->T, 996 srConfig->inv); 987 997 # endif 988 998 … … 1009 1019 // how is (BYTE)D supposed to work for fractional values e.g. 0.125 ?? 1010 1020 cmd[0]=1; 1011 cmd[1]=(BYTE)(((sr _config->F)>>8) & 0xFF);1012 cmd[2]=(BYTE)(sr _config->F & 0xFF);1013 cmd[3]=(BYTE)((int)(sr _config->D) & 0xFF);1021 cmd[1]=(BYTE)(((srConfig->F)>>8) & 0xFF); 1022 cmd[2]=(BYTE)(srConfig->F & 0xFF); 1023 cmd[3]=(BYTE)((int)(srConfig->D) & 0xFF); 1014 1024 if(!IO_Serial_Write(io, 0, 4, cmd)) 1015 1025 return FALSE; … … 1022 1032 1023 1033 cmd[0]=3; 1024 cmd[1]=(BYTE)(sr _config->N & 0xFF);1034 cmd[1]=(BYTE)(srConfig->N & 0xFF); 1025 1035 if(!IO_Serial_Write(io, 0, 2, cmd)) 1026 1036 return FALSE; 1027 1037 1028 1038 cmd[0]=4; 1029 cmd[1]=(BYTE)(sr _config->T & 0xFF);1039 cmd[1]=(BYTE)(srConfig->T & 0xFF); 1030 1040 if(!IO_Serial_Write(io, 0, 2, cmd)) 1031 1041 return FALSE; 1032 1042 1033 1043 cmd[0]=5; 1034 cmd[1]=(BYTE)(sr _config->inv & 0xFF);1044 cmd[1]=(BYTE)(srConfig->inv & 0xFF); 1035 1045 if(!IO_Serial_Write(io, 0, 2, cmd)) 1036 1046 return FALSE;
Note:
See TracChangeset
for help on using the changeset viewer.