void UCAM529::init() {
if (attempt_sync())
{
if (wait_for_sync())
{
cam_sync = true;
}
}
}
int protocol_init() {
/* wiringPiSetup();
wiringPiSPISetup(0, 8000000);
sleep(1);
radiolink_init(26);*/
open_serial("/dev/ttyUSB0");
wait_for_sync();
return 0;
}
/*! Load or eject medium
load = true - load medium
*/
static bool
ata_load_eject(ide_device_info *device, ide_qrequest *qrequest, bool load)
{
if (load) {
// ATA doesn't support loading
set_sense(device, SCSIS_KEY_ILLEGAL_REQUEST, SCSIS_ASC_PARAM_NOT_SUPPORTED);
return false;
}
device->tf_param_mask = 0;
device->tf.lba.command = IDE_CMD_MEDIA_EJECT;
if (!send_command(device, qrequest, true, 15, ide_state_sync_waiting))
return false;
wait_for_sync(device->bus);
return check_output(device, true, ide_error_abrt | ide_error_nm, false);
}
/*! Flush internal device cache */
static bool
ata_flush_cache(ide_device_info *device, ide_qrequest *qrequest)
{
// we should also ask for FLUSH CACHE support, but everyone denies it
// (looks like they cheat to gain some performance advantage, but
// that's pretty useless: everyone does it...)
if (!device->infoblock.write_cache_supported)
return true;
device->tf_param_mask = 0;
device->tf.lba.command = device->use_48bits ? IDE_CMD_FLUSH_CACHE_EXT
: IDE_CMD_FLUSH_CACHE;
// spec says that this may take more then 30s, how much more?
if (!send_command(device, qrequest, true, 60, ide_state_sync_waiting))
return false;
wait_for_sync(device->bus);
return check_output(device, true, ide_error_abrt, false);
}
int cros_ec_lpc_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
const uint8_t *dout, int dout_len,
uint8_t **dinp, int din_len)
{
const int cmd_addr = EC_LPC_ADDR_HOST_CMD;
const int data_addr = EC_LPC_ADDR_HOST_DATA;
const int args_addr = EC_LPC_ADDR_HOST_ARGS;
const int param_addr = EC_LPC_ADDR_HOST_PARAM;
struct ec_lpc_host_args args;
uint8_t *d;
int csum;
int i;
if (dout_len > EC_HOST_PARAM_SIZE) {
debug("%s: Cannot send %d bytes\n", __func__, dout_len);
return -1;
}
/* Fill in args */
args.flags = EC_HOST_ARGS_FLAG_FROM_HOST;
args.command_version = cmd_version;
args.data_size = dout_len;
/* Calculate checksum */
csum = cmd + args.flags + args.command_version + args.data_size;
for (i = 0, d = (uint8_t *)dout; i < dout_len; i++, d++)
csum += *d;
args.checksum = (uint8_t)csum;
if (wait_for_sync(dev)) {
debug("%s: Timeout waiting ready\n", __func__);
return -1;
}
/* Write args */
for (i = 0, d = (uint8_t *)&args; i < sizeof(args); i++, d++)
outb(*d, args_addr + i);
/* Write data, if any */
debug_trace("cmd: %02x, ver: %02x", cmd, cmd_version);
for (i = 0, d = (uint8_t *)dout; i < dout_len; i++, d++) {
outb(*d, param_addr + i);
debug_trace("%02x ", *d);
}
outb(cmd, cmd_addr);
debug_trace("\n");
if (wait_for_sync(dev)) {
debug("%s: Timeout waiting for response\n", __func__);
return -1;
}
/* Check result */
i = inb(data_addr);
if (i) {
debug("%s: CROS_EC result code %d\n", __func__, i);
return -i;
}
/* Read back args */
for (i = 0, d = (uint8_t *)&args; i < sizeof(args); i++, d++)
*d = inb(args_addr + i);
/*
* If EC didn't modify args flags, then somehow we sent a new-style
* command to an old EC, which means it would have read its params
* from the wrong place.
*/
if (!(args.flags & EC_HOST_ARGS_FLAG_TO_HOST)) {
debug("%s: CROS_EC protocol mismatch\n", __func__);
return -EC_RES_INVALID_RESPONSE;
}
if (args.data_size > din_len) {
debug("%s: CROS_EC returned too much data %d > %d\n",
__func__, args.data_size, din_len);
return -EC_RES_INVALID_RESPONSE;
}
/* Read data, if any */
for (i = 0, d = (uint8_t *)dev->din; i < args.data_size; i++, d++) {
*d = inb(param_addr + i);
debug_trace("%02x ", *d);
}
debug_trace("\n");
/* Verify checksum */
csum = cmd + args.flags + args.command_version + args.data_size;
for (i = 0, d = (uint8_t *)dev->din; i < args.data_size; i++, d++)
csum += *d;
if (args.checksum != (uint8_t)csum) {
debug("%s: CROS_EC response has invalid checksum\n", __func__);
return -EC_RES_INVALID_CHECKSUM;
}
*dinp = dev->din;
/* Return actual amount of data received */
return args.data_size;
}
