equal
deleted
inserted
replaced
167 #ifdef SDO_ACCESS |
167 #ifdef SDO_ACCESS |
168 void read_sdo(void) |
168 void read_sdo(void) |
169 { |
169 { |
170 switch (ecrt_sdo_request_state(sdo)) { |
170 switch (ecrt_sdo_request_state(sdo)) { |
171 case EC_SDO_REQUEST_UNUSED: // request was not used yet |
171 case EC_SDO_REQUEST_UNUSED: // request was not used yet |
172 ecrt_sdo_request_read(sdo); |
172 ecrt_sdo_request_read(sdo); // trigger first read |
173 break; |
173 break; |
174 case EC_SDO_REQUEST_BUSY: |
174 case EC_SDO_REQUEST_BUSY: |
175 printk(KERN_INFO PFX "Still busy...\n"); |
175 printk(KERN_INFO PFX "Still busy...\n"); |
176 break; |
176 break; |
177 case EC_SDO_REQUEST_SUCCESS: |
177 case EC_SDO_REQUEST_SUCCESS: |
178 printk(KERN_INFO PFX "Sdo value: 0x%04X\n", |
178 printk(KERN_INFO PFX "Sdo value: 0x%04X\n", |
179 EC_READ_U16(ecrt_sdo_request_data(sdo))); |
179 EC_READ_U16(ecrt_sdo_request_data(sdo))); |
180 ecrt_sdo_request_read(sdo); |
180 ecrt_sdo_request_read(sdo); // trigger next read |
181 break; |
181 break; |
182 case EC_SDO_REQUEST_ERROR: |
182 case EC_SDO_REQUEST_ERROR: |
183 printk(KERN_INFO PFX "Failed to read Sdo!\n"); |
183 printk(KERN_INFO PFX "Failed to read Sdo!\n"); |
184 ecrt_sdo_request_read(sdo); |
184 ecrt_sdo_request_read(sdo); // retry reading |
185 break; |
185 break; |
186 } |
186 } |
187 } |
187 } |
188 #endif |
188 #endif |
189 |
189 |