USB IO module

Dependencies:   USBDevice mbed

Committer:
BPPearson
Date:
Tue Jan 05 16:45:45 2016 +0000
Revision:
0:08e9f3bccfda
USB IO module

Who changed what in which revision?

UserRevisionLine numberNew contents of line
BPPearson 0:08e9f3bccfda 1 #include "ByteOperations.h"
BPPearson 0:08e9f3bccfda 2 #include <stdint.h>
BPPearson 0:08e9f3bccfda 3
BPPearson 0:08e9f3bccfda 4
BPPearson 0:08e9f3bccfda 5 /* low index equals low nibble */
BPPearson 0:08e9f3bccfda 6 /* Write 32 bit var to 4 bytes */
BPPearson 0:08e9f3bccfda 7 void write_32_to_8(int *i, uint8_t dst[], uint32_t src){
BPPearson 0:08e9f3bccfda 8 dst[(*i)++] = (src >> 0)&0xFF ;
BPPearson 0:08e9f3bccfda 9 dst[(*i)++] = (src >> 8)&0xFF ;
BPPearson 0:08e9f3bccfda 10 dst[(*i)++] = (src >> 16)&0xFF;
BPPearson 0:08e9f3bccfda 11 dst[(*i)++] = (src >> 24)&0xFF;
BPPearson 0:08e9f3bccfda 12 }
BPPearson 0:08e9f3bccfda 13
BPPearson 0:08e9f3bccfda 14 /* Write 16 bit var to 2 bytes */
BPPearson 0:08e9f3bccfda 15 void write_16_to_8(int *i, uint8_t dst[], uint16_t src){
BPPearson 0:08e9f3bccfda 16 dst[(*i)++] = (src >> 0)&0xFF ;
BPPearson 0:08e9f3bccfda 17 dst[(*i)++] = (src >> 8)&0xFF ;
BPPearson 0:08e9f3bccfda 18 }
BPPearson 0:08e9f3bccfda 19
BPPearson 0:08e9f3bccfda 20 /* Write 4 bytes to 32 bit var*/
BPPearson 0:08e9f3bccfda 21 uint32_t read_8_to_32(int *i, uint8_t *src){
BPPearson 0:08e9f3bccfda 22 uint32_t data = 0;
BPPearson 0:08e9f3bccfda 23 data |= (src[(*i)++] << 0) ;
BPPearson 0:08e9f3bccfda 24 data |= (src[(*i)++] << 8) ;
BPPearson 0:08e9f3bccfda 25 data |= (src[(*i)++] << 16);
BPPearson 0:08e9f3bccfda 26 data |= (src[(*i)++] << 24);
BPPearson 0:08e9f3bccfda 27 return data;
BPPearson 0:08e9f3bccfda 28 }
BPPearson 0:08e9f3bccfda 29
BPPearson 0:08e9f3bccfda 30 /* Write 2 bytes to 16 bit var*/
BPPearson 0:08e9f3bccfda 31 uint16_t read_8_to_16(int *i, uint8_t *src){
BPPearson 0:08e9f3bccfda 32 uint16_t data = 0;
BPPearson 0:08e9f3bccfda 33 data |= (src[(*i)++] << 0) ;
BPPearson 0:08e9f3bccfda 34 data |= (src[(*i)++] << 8) ;
BPPearson 0:08e9f3bccfda 35 return data;
BPPearson 0:08e9f3bccfda 36 }
BPPearson 0:08e9f3bccfda 37