Changeset 192e299 in thomson for elec/CrO2/software/device.cpp

Timestamp:

Feb 3, 2012, 7:37:06 PM (12 years ago)

Author:

Adrien Destugues <pulkomandy@…>

Branches:

main

Children:

c2a9854

Parents:

f9263dd

Message:

Cleanup.

git-svn-id: ​svn://localhost/thomson@15 85ae3b6b-dc8f-4344-a89d-598714f2e4e5

File:

• elec/CrO2/software/device.cpp (modified) (2 diffs)

elec/CrO2/software/device.cpp

@@ -8 +8 @@
 
 #include "device.h"
+#include "k5.h"
 
 bool Device::initOnce = false;
@@ -141 +142 @@
 }
 
+
+void Device::write(K5& file)
+{
+        for (int k = 0; k < file.getBlockCount(); k++)
+        {
+                // wait for motor on
+                while (getStatus() & 8)
+                        Sleep(1000);
+
+                K5::Block block = file.getBlock(k);
+
+                int nBytes = write(block.data, block.length - 1, block.type);
+                        // TODO error handling
+
+                // TODO wait for correct time (read status from usb OR compute from size+type)
+                Sleep(1400);
+        }
+}
+
 uint8_t Device::getStatus()
 {
         uint8_t status;
         usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_IN,
-                PSCMD_STATUS, 0,0, (char*)&status, 1, 5000);
+                        PSCMD_STATUS, 0,0, (char*)&status, 1, 5000);
                 // TODO handle errors (return value)
         return status;