You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
34 lines
965 B
34 lines
965 B
7 months ago
|
#include "cdm.h"
|
||
|
|
|
||
|
|
int write_cont(uint8_t *dst, uint32_t reg, std::vector<uint32_t> vals) {
|
||
|
|
struct cdm_regcontinuous_cmd *cmd = (struct cdm_regcontinuous_cmd*)dst;
|
||
|
|
cmd->cmd = CAM_CDM_CMD_REG_CONT;
|
||
|
|
cmd->count = vals.size();
|
||
|
|
cmd->offset = reg;
|
||
|
|
cmd->reserved0 = 0;
|
||
|
|
cmd->reserved1 = 0;
|
||
|
|
|
||
|
|
uint32_t *vd = (uint32_t*)(dst + sizeof(struct cdm_regcontinuous_cmd));
|
||
|
|
for (int i = 0; i < vals.size(); i++) {
|
||
|
|
*vd = vals[i];
|
||
|
|
vd++;
|
||
|
|
}
|
||
|
|
|
||
|
|
return sizeof(struct cdm_regcontinuous_cmd) + vals.size()*sizeof(uint32_t);
|
||
|
|
}
|
||
|
|
|
||
|
|
int write_random(uint8_t *dst, std::vector<uint32_t> vals) {
|
||
|
|
struct cdm_regrandom_cmd *cmd = (struct cdm_regrandom_cmd*)dst;
|
||
|
|
cmd->cmd = CAM_CDM_CMD_REG_RANDOM;
|
||
|
|
cmd->count = vals.size() / 2;
|
||
|
|
cmd->reserved = 0;
|
||
|
|
|
||
|
|
uint32_t *vd = (uint32_t*)(dst + sizeof(struct cdm_regrandom_cmd));
|
||
|
|
for (int i = 0; i < vals.size(); i++) {
|
||
|
|
*vd = vals[i];
|
||
|
|
vd++;
|
||
|
|
}
|
||
|
|
|
||
|
|
return sizeof(struct cdm_regrandom_cmd) + vals.size()*sizeof(uint32_t);
|
||
|
|
}
|