static void cwiid_callback(cwiid_wiimote_t *wiimote, int mesg_count,
union cwiid_mesg mesg_array[], struct timespec *timestamp)
{
int i;
t_wiimote *x=NULL;
double pd_timestamp=0;
// print_timestamp(timestamp, NULL);
if(g_wiimoteList==NULL||wiimote==NULL) {
post("no wii's known");
return;
}
x=getWiimoteObject(cwiid_get_id(wiimote));
if(NULL==x) {
post("no wiimote loaded: %d%",cwiid_get_id(wiimote));
return;
}
pd_timestamp=wiimote_timestamp2logicaltime(x, timestamp);
sys_lock();
for (i=0; i < mesg_count; i++) {
#if 1
wiimote_queue(x, mesg_array+i, pd_timestamp);
#else
wiimote_cwiid_message(x, mesg_array+i);
#endif
}
sys_unlock();
}
void err(cwiid_wiimote_t *wiimote, const char *s, va_list ap)
{
if (wiimote) printf("%d:", cwiid_get_id(wiimote));
else printf("-1:");
vprintf(s, ap);
printf("\n");
}
void cwiid_err_callback(cwiid_wiimote_t *wiimote, const char *s, va_list ap) {
int id = -1;
if (wiimote) id = cwiid_get_id(wiimote);
char foo[256];
vsnprintf(foo,256,s,ap);
qCritical("ERRRRRR %d: %s",id,foo);
}
static PyObject *Wiimote_get_id(Wiimote* self)
{
if (!self->wiimote) {
SET_CLOSED_ERROR;
return NULL;
}
return PyInt_FromLong(cwiid_get_id(self->wiimote));
}
// Funcion que recupera un puntero al dev wiimote dada su id
TPFC_device_wiimote* TPFC_device_wiimote::getwiimotedev(cwiid_wiimote_t *wiimote){
TPFC_device_wiimote* dev=NULL;
// recorremos la lista por orden (esta operación es poco eficiente, pero
// teniendo en cuenta que el numero de wiimotes será normalmente bajo (<4)
// la eficiencia en la busqueda no es un problema
for (int i = 0; i<wiimotes.size() && dev==NULL;i++){
// comparamos los ids registrados con el actual
if (wiimotes[i].id==cwiid_get_id(wiimote))
// cuando encontramos la coincidencia, guardamos el puntero
dev= wiimotes[i].dev;
}
// y lo devolvemos
return dev;
}
static void cwiid_error_callback(cwiid_wiimote_t *wiimote, const char*err, va_list ap) {
t_wiimote *x=NULL;
if(g_wiimoteList==NULL||wiimote==NULL) {
post("no wii's known");
return;
}
x=getWiimoteObject(cwiid_get_id(wiimote));
if(NULL==x) {
if(err) {
error("wiimote: %s", err);
} else {
error("wiimote: unknown error");
}
} else {
if(err) {
pd_error(x, "wiimote: %s", err);
} else {
pd_error(x, "wiimote: unknown error");
}
}
}
// Función que registra los wiimotes por su id,
void TPFC_device_wiimote::registerwiimote(cwiid_wiimote_t *wiimote, TPFC_device_wiimote* dev){
wiimotes.push_back(wiimoteinfo(cwiid_get_id(wiimote),dev));
}
// The following function attempts to connect to a wiimote at a
// specific address, provided as an argument. eg, 00:19:1D:70:CE:72
// This address can be discovered by running the following command
// in a console:
// hcitool scan | grep Nintendo
static void wiimote_doConnect(t_wiimote *x, t_symbol *addr, t_symbol *dongaddr)
{
bdaddr_t bdaddr;
unsigned int flags = CWIID_FLAG_MESG_IFC;
bdaddr_t dong_bdaddr;
bdaddr_t* dong_bdaddr_ptr=&dong_bdaddr;
if(x->connected) {
wiimote_doDisconnect(x);
}
// determine address:
if (NULL==addr || addr==gensym("")) {
verbose(1, "searching for wii...");
bdaddr = *BDADDR_ANY;
} else {
str2ba(addr->s_name, &bdaddr);
verbose(1, "Connecting to Wii '%s'", addr->s_name);
}
post("Press buttons 1 and 2 simultaneously.");
// determine dongleaddress:
if (NULL==dongaddr || dongaddr==gensym("")) {
verbose(1, "using default dongle");
dong_bdaddr_ptr = NULL;
} else {
verbose(1, "using dongle '%s'", dongaddr->s_name);
str2ba(dongaddr->s_name, &dong_bdaddr);
}
// connect:
#ifdef CWIID_OPEN_WITH_DONGLE
verbose(1,"wiimote: opening multidongle");
x->wiimote = cwiid_open(&bdaddr, dong_bdaddr_ptr, flags);
#else
verbose(1,"wiimote: opening");
x->wiimote = cwiid_open(&bdaddr, flags);
#endif
if(NULL==x->wiimote) {
pd_error(x, "wiimote: unable to connect");
wiimote_out_status(x, x->connected);
return;
}
if(!addWiimoteObject(x, cwiid_get_id(x->wiimote))) {
cwiid_close(x->wiimote);
x->wiimote=NULL;
wiimote_out_status(x, x->connected);
return;
}
x->wiimoteID= cwiid_get_id(x->wiimote);
post("wiimote %i is successfully connected", x->wiimoteID);
if(cwiid_get_acc_cal(x->wiimote, CWIID_EXT_NONE, &x->acc_cal)) {
post("Unable to retrieve accelerometer calibration");
} else {
post("Retrieved wiimote calibration: zero=(%02d,%02d,%02d) one=(%02d,%02d,%02d)",
x->acc_cal.zero[CWIID_X],
x->acc_cal.zero[CWIID_Y],
x->acc_cal.zero[CWIID_Z],
x->acc_cal.one [CWIID_X],
x->acc_cal.one [CWIID_Y],
x->acc_cal.one [CWIID_Z]);
}
x->connected = 1;
wiimote_out_status(x, x->connected);
x->reportMode |= CWIID_RPT_STATUS;
x->reportMode |= CWIID_RPT_BTN;
wiimote_resetReportMode(x);
if (cwiid_set_mesg_callback(x->wiimote, &cwiid_callback)) {
pd_error(x, "Unable to set message callback");
}
wiimote_setbasetime(x);
}
